Florian Zumbiehl just uploaded a new patch set to gerrit, which you can find at 
http://review.coreboot.org/384

-gerrit

commit ddf36efd1d7dcf7173b3d1758821fe5775c27ae2
Author: Florian Zumbiehl <[email protected]>
Date:   Tue Nov 1 20:19:06 2011 +0100

    implement hwmon fan divisor setting for w83697hf
    
    Change-Id: I887ac1142875ca1dc1a1eb8eebec402fbe7512c3
    Signed-off-by: Florian Zumbiehl <[email protected]>
---
 src/superio/winbond/w83697hf/chip.h    |    3 +-
 src/superio/winbond/w83697hf/superio.c |   33 ++++++++++++++++++++++++++++++++
 2 files changed, 35 insertions(+), 1 deletions(-)

diff --git a/src/superio/winbond/w83697hf/chip.h 
b/src/superio/winbond/w83697hf/chip.h
index 1a1cbcc..2359b66 100644
--- a/src/superio/winbond/w83697hf/chip.h
+++ b/src/superio/winbond/w83697hf/chip.h
@@ -26,7 +26,8 @@
 extern struct chip_operations superio_winbond_w83697hf_ops;
 
 struct superio_winbond_w83697hf_config {
-
+       unsigned int hwmon_fan1_divisor;
+       unsigned int hwmon_fan2_divisor;
 };
 
 #endif
diff --git a/src/superio/winbond/w83697hf/superio.c 
b/src/superio/winbond/w83697hf/superio.c
index d2cbcbd..a7f4f67 100644
--- a/src/superio/winbond/w83697hf/superio.c
+++ b/src/superio/winbond/w83697hf/superio.c
@@ -41,10 +41,43 @@ static void pnp_exit_ext_func_mode(device_t dev)
        outb(0xaa, dev->path.pnp.port);
 }
 
+static void hwmon_set_fan_divisor(unsigned int base, int num, unsigned int 
divisor) {
+       unsigned char enc, buf;
+
+       if (divisor) {
+               enc = log2(divisor);
+               if (1 << enc != divisor || enc > 7)
+                       die("invalid fan divisor");
+               outb(0x4e, base + 5);
+               outb(0x00, base + 6);
+               outb(0x47, base + 5);
+               outb((inb(base + 6) & ~(0x30 << (num * 2))) | ((enc & 3) << (4 
+ num * 2)), base + 6);
+               outb(0x5d, base + 5);
+               buf = inb(base + 6);
+               outb(0x5d, base + 5); // the above inb() auto-increments the 
address pointer ...
+               outb((buf & ~(0x20 << num)) | ((enc & 4) << (3 + num)), base + 
6);
+       }
+}
+
 static void w83697hf_init(device_t dev)
 {
+       struct resource *res0;
+       struct superio_winbond_w83697hf_config *cfg;
+
        if (!dev->enabled)
                return;
+
+       cfg = dev->chip_info;
+
+       switch (dev->path.pnp.device) {
+       case W83697HF_HWM:
+               if (cfg) {
+                       res0 = find_resource(dev, PNP_IDX_IO0);
+                       hwmon_set_fan_divisor(res0->base, 0, 
cfg->hwmon_fan1_divisor);
+                       hwmon_set_fan_divisor(res0->base, 1, 
cfg->hwmon_fan2_divisor);
+               }
+               break;
+       }
 }
 
 static void w83697hf_pnp_set_resources(device_t dev)

-- 
coreboot mailing list: [email protected]
http://www.coreboot.org/mailman/listinfo/coreboot

Reply via email to