[LinuxBIOS] r2645 - trunk/LinuxBIOSv2/src/superio/winbond/w83977tf

Author: uwe
Date: 2007-05-09 19:54:25 +0200 (Wed, 09 May 2007)
New Revision: 2645

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

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

Modified: trunk/LinuxBIOSv2/src/superio/winbond/w83977tf/w83977tf_early_serial.c
===================================================================
--- trunk/LinuxBIOSv2/src/superio/winbond/w83977tf/w83977tf_early_serial.c	2007-05-09 15:11:03 UTC (rev 2644)
+++ trunk/LinuxBIOSv2/src/superio/winbond/w83977tf/w83977tf_early_serial.c	2007-05-09 17:54:25 UTC (rev 2645)
@@ -1,11 +1,25 @@
 #include <arch/romcc_io.h>
 #include "w83977tf.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 w83977tf_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 w83977tf_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);
 }