Finally move the LEGKEY garbage into ich2/.

[netwatch.git] / ich2 / smi.c

diff --git a/ich2/smi.c b/ich2/smi.c
index 7f9642183812738f5a4edb83e61fb972cc9057dd..0e43185dd98cb15692da0a485293636fb6ce12c9 100644 (file)
--- 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>
@@ -22,6 +33,15 @@ void smi_disable()
 {
        unsigned short smi_en = _get_PMBASE() + ICH2_PMBASE_SMI_EN;
        outl(smi_en, inl(smi_en) & ~ICH2_SMI_EN_GBL_SMI_EN);
+       
+       /* Try really hard to shut up USB_LEGKEY. */
+       pci_write16(ICH2_USB0_BUS, ICH2_USB0_DEV, ICH2_USB0_FN, ICH2_USB_LEGKEY, 0x0);
+       pci_write16(ICH2_USB0_BUS, ICH2_USB0_DEV, ICH2_USB0_FN, ICH2_USB_LEGKEY,
+               pci_read16(ICH2_USB0_BUS, ICH2_USB0_DEV, ICH2_USB0_FN, ICH2_USB_LEGKEY));
+       pci_write16(ICH2_USB1_BUS, ICH2_USB1_DEV, ICH2_USB1_FN, ICH2_USB_LEGKEY, 0x0);
+       pci_write16(ICH2_USB1_BUS, ICH2_USB1_DEV, ICH2_USB1_FN, ICH2_USB_LEGKEY,
+               pci_read16(ICH2_USB1_BUS, ICH2_USB1_DEV, ICH2_USB1_FN, ICH2_USB_LEGKEY));
+       
 }
 
 void smi_enable()
@@ -90,7 +110,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);
                }
                
@@ -213,6 +236,11 @@ int smi_enable_event(smi_event_t ev)
                        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;
        }
@@ -237,6 +265,11 @@ int smi_disable_event(smi_event_t ev)
                        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;
        }