X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/90d089658f499e24ae10840352b548ddbb842a9e..7002eebadccfd584018ebb62fa13402cf0190b5d:/ich2/smm-open-ich2.c

diff --git a/ich2/smm-open-ich2.c b/ich2/smm-open-ich2.c
index 9c80dae..e76fcfc 100644
--- a/ich2/smm-open-ich2.c
+++ b/ich2/smm-open-ich2.c
@@ -1,4 +1,8 @@
 #include "reg-82815.h"
+#include <unistd.h>
+#include <getopt.h>
+#include <stdlib.h>
+#include <stdio.h>
 
 unsigned long memsz[] = {
 	0,			// 0
@@ -19,29 +23,19 @@ unsigned long memsz[] = {
 	512*1024*1024		// F
 };
 
-int main()
-{
-	unsigned char smramc, drp, drp2;
+void dump(unsigned char smramc, unsigned char drp, unsigned char drp2) {
+
 	unsigned int tom = 0;
 	int usmm, lsmm;
-	
-	smramc = pci_read8(0, 0, 0, SMRAMC);
-	drp = pci_read8(0, 0, 0, DRP);
-	drp2 = pci_read8(0, 0, 0, DRP2);
-	
+
+	printf("SMRAMC: %02x\n", smramc);
+
 	tom += memsz[drp & 0xF];
 	tom += memsz[drp >> 4];
 	tom += memsz[drp2 & 0xF];
 	
 	printf("Top of DRAM: %08x\n", tom);
 	
-	printf("SMRAMC: %02x\n", smramc);
-	if (smramc & SMRAMC_LOCK)
-	{
-		printf("SMRAM is locked, cannot load anything :-(\n");
-		return 1;
-	}
-	
 	usmm = (smramc >> 4) & 0x3;
 	lsmm = (smramc >> 2) & 0x3;
 	
@@ -54,10 +48,12 @@ int main()
 		printf("TSEG off, HSEG %s\n", lsmm ? "off" : "on");
 		break;
 	case 2:
-		printf("TSEG 512KB (%08x - %08x), HSEG %s\n", tom - 512 * 1024, tom - 1, lsmm ? "off" : "on");
+		printf("TSEG 512KB (%08x - %08x), HSEG %s\n",
+			tom - 512 * 1024, tom - 1, lsmm ? "off" : "on");
 		break;
 	case 3:
-		printf("TSEG 1MB (%08x - %08x), HSEG %s\n", tom - 1 * 1024 * 1024, tom - 1, lsmm ? "off" : "on");
+		printf("TSEG 1MB (%08x - %08x), HSEG %s\n",
+			tom - 1 * 1024 * 1024, tom - 1, lsmm ? "off" : "on");
 		break;
 	}
 	
@@ -76,5 +72,94 @@ int main()
 		printf("ABSEG enabled for both SMM code and data\n");
 		break;
 	}
+}
+
+static struct option longopts[] = {
+	{ "open",	no_argument,	NULL,	'o'	},
+	{ "close",	no_argument,	NULL,	'c'	},
+	{ "smram",	no_argument,	NULL,	's'	},
+	{ "dump",	no_argument,	NULL,	'd'	},
+	{ NULL,		0,		NULL,	0	}
+};
+
+#define OP_DUMP 1
+#define OP_SET 2
+
+void usage(int argc, char **argv)
+{
+	printf("Usage: %s [ --dump ] [ --open | --close | --smram=value ]\n",
+		argv[0]);
+	exit(1);
+}
+
+int main(int argc, char **argv)
+{
+	unsigned char smramc, drp, drp2;
+
+	if (geteuid() != 0)
+	{
+		printf("This program must be run as root, dumbass.\n");
+		return 1;
+	}
+	
+	smramc = pci_read8(0, 0, 0, SMRAMC);
+	drp = pci_read8(0, 0, 0, DRP);
+	drp2 = pci_read8(0, 0, 0, DRP2);
+	
+	if (smramc & SMRAMC_LOCK)
+	{
+		printf("SMRAM is locked, cannot load anything :-(\n");
+		return 1;
+	}
+
+	int ch;
+	int op = 0;
+	int new_smramc = smramc;
+
+	while ((ch = getopt_long(argc, argv, "ocsd:", longopts, NULL)) != -1)
+	{
+		switch (ch)
+		{
+		case 's':
+			if (op & OP_SET) usage(argc, argv);
+			op |= OP_SET;
+			new_smramc = strtoul(optarg, 0, 0);
+			break;
+		case 'o':
+			if (op & OP_SET) usage(argc, argv);
+			op |= OP_SET;
+			/* Set LSMM to 01 (ABseg = system RAM) */
+			new_smramc = (smramc & 0xF0) | 0x04;
+			break;
+		case 'c':
+			if (op & OP_SET) usage(argc, argv);
+			op |= OP_SET;
+			/* Set LSMM to 11 (ABseg = SMM RAM) */
+			new_smramc = (smramc & 0xF0) | 0x0C;
+			break;
+		case 'd':
+			op |= OP_DUMP;
+			break;
+		default:
+			usage(argc, argv);
+		}
+	}
+
+	if (!op) usage(argc, argv);
+
+	if (op & OP_DUMP)
+	{
+		dump(smramc, drp, drp2);
+	}
+
+	if (op & OP_SET)
+	{
+		pci_write8(0, 0, 0, SMRAMC, new_smramc);
+		if (op & OP_DUMP)
+		{
+			printf("SMRAM set to 0x%02x\n", new_smramc);
+		}
+	}
+	
 	return 0;
 }