T60: set dock LED's in mainboard.c

[coreboot.git] / src / mainboard / lenovo / t60 / mainboard.c

diff --git a/src/mainboard/lenovo/t60/mainboard.c b/src/mainboard/lenovo/t60/mainboard.c
index 775145314ef46933ecbab1dfeec40d5a44471028..371085bd49c4111483ad38d8e3b49d165ed827f5 100644 (file)
--- a/src/mainboard/lenovo/t60/mainboard.c
+++ b/src/mainboard/lenovo/t60/mainboard.c
@@ -34,17 +34,19 @@
 #include <ec/acpi/ec.h>
 #include <ec/lenovo/h8/h8.h>
 #include <northbridge/intel/i945/i945.h>
+#include <pc80/mc146818rtc.h>
 
 static void mainboard_enable(device_t dev)
 {
        device_t dev0, idedev;
+       u8 defaults_loaded = 0;
 
        /* enable Audio */
        h8_set_audio_mute(0);
 
        /* If we're resuming from suspend, blink suspend LED */
        dev0 = dev_find_slot(0, PCI_DEVFN(0,0));
-       if (dev0 && pci_read_config32(dev0, SKPAD) == 0xcafed00d)
+       if (dev0 && pci_read_config32(dev0, SKPAD) == SKPAD_ACPI_S3_MAGIC)
                ec_write(0x0c, 0xc7);
 
        idedev = dev_find_slot(0, PCI_DEVFN(0x1f,1));
@@ -57,6 +59,21 @@ static void mainboard_enable(device_t dev)
                pmh7_ultrabay_power_enable(0);
                ec_write(0x0c, 0x04);
        }
+
+       /* set dock status led */
+       ec_write(0x0c, inb(0x164c) & 8 ? 0x88 : 0x08);
+
+       if (get_option(&defaults_loaded, "cmos_defaults_loaded") < 0) {
+               printk(BIOS_INFO, "failed to get cmos_defaults_loaded");
+               defaults_loaded = 0;
+       }
+
+       if (!defaults_loaded) {
+               printk(BIOS_INFO, "Restoring CMOS defaults\n");
+               set_option("tft_brightness", &(u8[]){ 0xff });
+               set_option("volume", &(u8[]){ 0x03 });
+               set_option("cmos_defaults_loaded", &(u8[]){ 0x01 });
+       }
 }
 
 struct chip_operations mainboard_ops = {