X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/199c2b1bedd78a06dae62d736115273bd0127af1..6b91f09cf683c29989ab259f4a433fb7d1427b36:/ich2/smi.c

diff --git a/ich2/smi.c b/ich2/smi.c
index 41bc4a1..7f96421 100644
--- a/ich2/smi.c
+++ b/ich2/smi.c
@@ -4,6 +4,9 @@
 #include <stdint.h>
 #include <vga-overlay.h>
 #include <reg-82801b.h>
+#include <output.h>
+
+static smi_handler_t _handlers[SMI_EVENT_MAX] = {0};
 
 static uint16_t _get_PMBASE()
 {
@@ -39,35 +42,38 @@ void smi_poll()
 	
 	if (sts & ICH2_SMI_STS_BIOS_STS)
 	{
-		dolog("Unhandled: BIOS_STS");
+		if (_handlers[SMI_EVENT_GBL_RLS] == SMI_HANDLER_NONE)
+			output("Unhandled: BIOS_STS");
+		else if (_handlers[SMI_EVENT_GBL_RLS] != SMI_HANDLER_IGNORE)
+			_handlers[SMI_EVENT_GBL_RLS](SMI_EVENT_GBL_RLS);
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_BIOS_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_LEGACY_USB_STS)
 	{
-		dolog("Unhandled: LEGACY_USB_STS");
+		output("Unhandled: LEGACY_USB_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_LEGACY_USB_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_SLP_SMI_STS)
 	{
-		dolog("Unhandled: SLP_SMI_STS");
+		output("Unhandled: SLP_SMI_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SLP_SMI_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_APM_STS)
 	{
-		dolog("Unhandled: APM_STS");
+		output("Unhandled: APM_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_APM_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_SWSMI_TMR_STS)	// Ack it, then request another.
 	{
+		if (_handlers[SMI_EVENT_FAST_TIMER] == SMI_HANDLER_NONE)
+			output("Unhandled: SWSMI_TMR_STS");
+		else if (_handlers[SMI_EVENT_FAST_TIMER] != SMI_HANDLER_IGNORE)
+			_handlers[SMI_EVENT_FAST_TIMER](SMI_EVENT_FAST_TIMER);
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SWSMI_TMR_STS);
-		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
-			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) & ~ICH2_SMI_EN_SWSMI_TMR_EN);
-		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
-			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) | ICH2_SMI_EN_SWSMI_TMR_EN);
 	}
 	
 	if (sts & ICH2_SMI_STS_PM1_STS_REG)
@@ -78,25 +84,25 @@ void smi_poll()
 		pm1_sts &= pm1_en;
 		if (pm1_sts & ICH2_PM1_STS_RTC_STS)
 		{
-			dolog("Unhandled: PM1_STS: RTC_STS");
+			output("Unhandled: PM1_STS: RTC_STS");
 			outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_RTC_STS);
 		}
 		
 		if (pm1_sts & ICH2_PM1_STS_PWRBTN_STS)
 		{
-			dolog("Unhandled: PM1_STS: PWRBTN_STS");
+			output("Unhandled: PM1_STS: PWRBTN_STS");
 			outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_PWRBTN_STS);
 		}
 		
 		if (pm1_sts & ICH2_PM1_STS_GBL_STS)
 		{
-			dolog("Unhandled: PM1_STS: GBL_STS");
+			output("Unhandled: PM1_STS: GBL_STS");
 			outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_GBL_STS);
 		}
 		
 		if (pm1_sts & ICH2_PM1_STS_TMROF_STS)
 		{
-			dolog("Unhandled: PM1_STS: TMROF_STS");
+			output("Unhandled: PM1_STS: TMROF_STS");
 			outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_TMROF_STS);
 		}
 		
@@ -106,18 +112,18 @@ void smi_poll()
 	if (sts & ICH2_SMI_STS_GPE0_STS)
 	{
 		/* XXX -- trawl through GPE0_STS to see what happened */
-		dolog("XXX Unhandled: GPE0_STS (expect lockup)");
+		output("XXX Unhandled: GPE0_STS (expect lockup)");
 	}
 	
 	if (sts & ICH2_SMI_STS_GPE1_STS)
 	{
 		/* XXX -- trawl through GPE1_STS to see what happened */
-		dolog("XXX Unhandled: GPE1_STS (expect lockup)");
+		output("XXX Unhandled: GPE1_STS (expect lockup)");
 	}
 	
 	if (sts & ICH2_SMI_STS_MCSMI_STS)
 	{
-		dolog("Unhandled: MCSMI_STS");
+		output("Unhandled: MCSMI_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_MCSMI_STS);
 	}
 	
@@ -126,41 +132,112 @@ void smi_poll()
 		unsigned short mon_smi = inw(_get_PMBASE() + ICH2_PMBASE_MON_SMI);
 		unsigned long devact_sts = inl(_get_PMBASE() + ICH2_PMBASE_DEVACT_STS);
 		unsigned long devtrap_en = inl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN);
+		
+		if (devact_sts & ICH2_DEVACT_STS_KBC_ACT_STS)
+		{
+			if (_handlers[SMI_EVENT_DEVTRAP_KBC] == SMI_HANDLER_NONE)
+				output("Unhandled: DEVACT_KBC_ACT_STS");
+			else if (_handlers[SMI_EVENT_DEVTRAP_KBC] != SMI_HANDLER_IGNORE)
+				_handlers[SMI_EVENT_DEVTRAP_KBC](SMI_EVENT_DEVTRAP_KBC);
+			outl(_get_PMBASE() + ICH2_PMBASE_DEVACT_STS, ICH2_DEVACT_STS_KBC_ACT_STS);
+		}
+		
+		/* Refresh register cache so that we can print unhandleds as needed. */
+		mon_smi = inw(_get_PMBASE() + ICH2_PMBASE_MON_SMI);
+		devact_sts = inl(_get_PMBASE() + ICH2_PMBASE_DEVACT_STS);
+		devtrap_en = inl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN);
+		
 		if (((mon_smi & 0x0F00) >> 8) & ((mon_smi & 0xF000) >> 12))
-			dologf("Unhandled: MON_SMI (%04x)", mon_smi);
+			outputf("Unhandled: MON_SMI (%04x)", mon_smi);
 		if (devact_sts & devtrap_en)
-			dologf("Unhandled: DEVTRAP (%08x)", devact_sts & devtrap_en);
+			outputf("Unhandled: DEVTRAP (%08x)", devact_sts & devtrap_en);
 	}
 	
 	if (sts & ICH2_SMI_STS_TCO_STS)
 	{
-		dolog("Unhandled: TCO_STS");
+		output("Unhandled: TCO_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_TCO_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_PERIODIC_STS)
 	{
-		dolog("Unhandled: PERIODIC_STS");
+		output("Unhandled: PERIODIC_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_PERIODIC_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_SERIRQ_SMI_STS)
 	{
-		dolog("Unhandled: SERIRQ_SMI_STS");
+		output("Unhandled: SERIRQ_SMI_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SERIRQ_SMI_STS);
 	}
 	
 	if (sts & ICH2_SMI_STS_SMBUS_SMI_STS)
 	{
-		dolog("Unhandled: SMBUS_SMI_STS");
+		output("Unhandled: SMBUS_SMI_STS");
 		outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SMBUS_SMI_STS);
 	}
 	
 	if (smi_status() & ~ICH2_SMI_STS_PM1_STS_REG)	/* Either the chipset is buggy, or we are. */
-		dologf("WARN: couldn't clear SMI_STS! (%08x)", smi_status());
+		outputf("WARN: couldn't clear SMI_STS! (%08x)", smi_status());
 	
 	outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
 		inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) |
 			ICH2_SMI_EN_EOS |
 			ICH2_SMI_EN_GBL_SMI_EN);
 }
+
+int smi_register_handler(smi_event_t ev, smi_handler_t hnd)
+{
+	if (ev >= SMI_EVENT_MAX)
+		return -1;
+	_handlers[ev] = hnd;
+	return 0;
+}
+
+int smi_enable_event(smi_event_t ev)
+{
+	switch(ev)
+	{
+	case SMI_EVENT_FAST_TIMER:
+		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) |
+				ICH2_SMI_EN_SWSMI_TMR_EN);
+		return 0;
+	case SMI_EVENT_DEVTRAP_KBC:
+		outl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN) |
+				ICH2_DEVTRAP_EN_KBC_TRP_EN);
+		return 0;
+	case SMI_EVENT_GBL_RLS:
+		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) |
+				ICH2_SMI_EN_BIOS_EN);
+		return 0;
+	default:
+		return -1;
+	}
+}
+
+int smi_disable_event(smi_event_t ev)
+{
+	switch(ev)
+	{
+	case SMI_EVENT_FAST_TIMER:
+		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) &
+				~ICH2_SMI_EN_SWSMI_TMR_EN);
+		return 0;
+	case SMI_EVENT_DEVTRAP_KBC:
+		outl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN) &
+				~ICH2_DEVTRAP_EN_KBC_TRP_EN);
+		return 0;
+	case SMI_EVENT_GBL_RLS:
+		outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) &
+				~ICH2_SMI_EN_BIOS_EN);
+		return 0;
+	default:
+		return -1;
+	}
+}