[LinuxBIOS] r2662 - trunk/LinuxBIOSv2/src/superio/winbond/w83627thf

Author: uwe
Date: 2007-05-11 13:17:58 +0200 (Fri, 11 May 2007)
New Revision: 2662

Modified:
   trunk/LinuxBIOSv2/src/superio/winbond/w83627thf/w83627thf_early_serial.c
Log:
The Super I/O needs 0x87 sent twice to 0x2e (or 0x4e) to enable extended
function (power-on strapping). Although this is already done in superio.c,
it's not being done when w83627thf_early_serial.c is executed.
As such, no console_init() without it.

Signed-off-by: Roger Zauner 
Signed-off-by: Uwe Hermann 
Acked-by: Uwe Hermann

Modified: trunk/LinuxBIOSv2/src/superio/winbond/w83627thf/w83627thf_early_serial.c
===================================================================
--- trunk/LinuxBIOSv2/src/superio/winbond/w83627thf/w83627thf_early_serial.c	2007-05-10 23:59:20 UTC (rev 2661)
+++ trunk/LinuxBIOSv2/src/superio/winbond/w83627thf/w83627thf_early_serial.c	2007-05-11 11:17:58 UTC (rev 2662)
@@ -1,11 +1,25 @@
 #include <arch/romcc_io.h>
 #include "w83627thf.h"

+static inline void pnp_enter_ext_func_mode(device_t dev)
+{
+	unsigned int port = dev >> 8;
+	outb(0x87, port);
+	outb(0x87, port);
+}

-static void w83627thf_enable_serial(device_t dev, unsigned iobase)
+static void pnp_exit_ext_func_mode(device_t dev)
 {
+	unsigned int port = dev >> 8;
+	outb(0xaa, port);
+}
+
+static void w83627thf_enable_serial(device_t dev, unsigned int iobase)
+{
+	pnp_enter_ext_func_mode(dev);
    pnp_set_logical_device(dev);
    pnp_set_enable(dev, 0);
    pnp_set_iobase(dev, PNP_IDX_IO0, iobase);
    pnp_set_enable(dev, 1);
+	pnp_exit_ext_func_mode(dev);
 }