X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/d88bb1f4479b42f9078674c33e6618c27c2c98ce..b83b409494b6aedcbcb0548665b8edebba19b43e:/ich2/smi.c

diff --git a/ich2/smi.c b/ich2/smi.c
index 0a0ddf4..8865eab 100644
--- a/ich2/smi.c
+++ b/ich2/smi.c
@@ -1,3 +1,14 @@
+/* smi.c
+ * System management interrupt dispatch routines for ICH2 southbridge
+ * NetWatch system management mode administration console
+ *
+ * Copyright (c) 2008 Jacob Potter and Joshua Wise.  All rights reserved.
+ * This program is free software; you can redistribute and/or modify it under
+ * the terms found in the file LICENSE in the root of this source tree. 
+ *
+ */
+
+
 #include <smi.h>
 #include <pci.h>
 #include <io.h>
@@ -42,7 +53,10 @@ void smi_poll()
 	
 	if (sts & ICH2_SMI_STS_BIOS_STS)
 	{
-		output("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);
 	}
 	
@@ -87,7 +101,10 @@ void smi_poll()
 		
 		if (pm1_sts & ICH2_PM1_STS_PWRBTN_STS)
 		{
-			output("Unhandled: PM1_STS: PWRBTN_STS");
+			if (_handlers[SMI_EVENT_PWRBTN] == SMI_HANDLER_NONE)
+				output("Unhandled: PM1_STS: PWRBTN_STS");
+			else if (_handlers[SMI_EVENT_FAST_TIMER] != SMI_HANDLER_IGNORE)
+				_handlers[SMI_EVENT_PWRBTN](SMI_EVENT_PWRBTN);
 			outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_PWRBTN_STS);
 		}
 		
@@ -205,6 +222,16 @@ int smi_enable_event(smi_event_t ev)
 			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;
+	case SMI_EVENT_PWRBTN:
+		outl(_get_PMBASE() + ICH2_PMBASE_PM1_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_PM1_EN) |
+				ICH2_PM1_EN_PWRBTN_EN);
+		return 0;
 	default:
 		return -1;
 	}
@@ -224,6 +251,16 @@ int smi_disable_event(smi_event_t ev)
 			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;
+	case SMI_EVENT_PWRBTN:
+		outl(_get_PMBASE() + ICH2_PMBASE_PM1_EN,
+			inl(_get_PMBASE() + ICH2_PMBASE_PM1_EN) &
+				~ICH2_PM1_EN_PWRBTN_EN);
+		return 0;
 	default:
 		return -1;
 	}