It turns out that the code which enables specific LDN is somewhat buggy.
[coreboot.git] / src / superio / smsc / lpc47n217 / superio.c
index 362f257facdbd4a5894a523d895ed17f4afd6e69..b1455330d0210cd84b38a7b05e2514dcac1bf9de 100644 (file)
-/*\r
- * $Header: /home/cvs/BIR/ca-cpu/freebios/src/superio/smsc/lpc47n217/superio.c,v 1.1.1.1 2005/07/11 15:28:51 smagnani Exp $\r
- *\r
- * superio.c: RAM-based driver for SMSC LPC47N217 Super I/O chip\r
- *\r
- * Based on LinuxBIOS code for SMSC 47B397:\r
- * Copyright 2000  AG Electronics Ltd.\r
- * Copyright 2003-2004 Linux Networx\r
- * Copyright 2004 Tyan \r
- *\r
- * Copyright (C) 2005 Digital Design Corporation\r
- *\r
- * This program is free software; you can redistribute it and/or modify\r
- * it under the terms of the GNU General Public License as published by\r
- * the Free Software Foundation; either version 2 of the License, or\r
- * (at your option) any later version.\r
- *\r
- * This program is distributed in the hope that it will be useful,\r
- * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
- * GNU General Public License for more details.\r
- *\r
- * You should have received a copy of the GNU General Public License\r
- * along with this program; if not, write to the Free Software\r
- * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA\r
- *\r
- * $Log: superio.c,v $\r
- * Revision 1.1.1.1  2005/07/11 15:28:51  smagnani\r
- * Initial revision.\r
- *\r
- *\r
- */\r
-\r
-#include <arch/io.h>\r
-#include <device/device.h>\r
-#include <device/pnp.h>\r
-#include <console/console.h>\r
-#include <device/smbus.h>\r
-#include <string.h>\r
-#include <bitops.h>\r
-#include <uart8250.h>\r
-#include <assert.h>\r
-#include "chip.h"\r
-#include "lpc47n217.h"\r
-\r
-// Forward declarations\r
-static void enable_dev(device_t dev);\r
-void lpc47n217_pnp_set_resources(device_t dev);\r
-void lpc47n217_pnp_enable_resources(device_t dev);\r
-void lpc47n217_pnp_enable(device_t dev);\r
-static void lpc47n217_init(device_t dev);\r
-\r
-static void lpc47n217_pnp_set_resource(device_t dev, struct resource *resource);\r
-void lpc47n217_pnp_set_iobase(device_t dev, unsigned iobase);\r
-void lpc47n217_pnp_set_drq(device_t dev, unsigned drq);\r
-void lpc47n217_pnp_set_irq(device_t dev, unsigned irq);\r
-void lpc47n217_pnp_set_enable(device_t dev, int enable);\r
-\r
-static void pnp_enter_conf_state(device_t dev);\r
-static void pnp_exit_conf_state(device_t dev);\r
-\r
-\r
-struct chip_operations superio_smsc_lpc47n217_ops = {\r
-       CHIP_NAME("smsc lpc47n217")\r
-       .enable_dev = enable_dev,\r
-};\r
-\r
-static struct device_operations ops = {\r
-       .read_resources   = pnp_read_resources,\r
-       .set_resources    = lpc47n217_pnp_set_resources,\r
-       .enable_resources = lpc47n217_pnp_enable_resources,\r
-       .enable           = lpc47n217_pnp_enable,\r
-       .init             = lpc47n217_init,\r
-};\r
-\r
-static struct pnp_info pnp_dev_info[] = {\r
-        { &ops, LPC47N217_PP,   PNP_IO0 | PNP_IRQ0 | PNP_DRQ0, { 0x07f8, 0}, },\r
-        { &ops, LPC47N217_SP1,  PNP_IO0 | PNP_IRQ0, { 0x7f8, 0 }, },\r
-        { &ops, LPC47N217_SP2,  PNP_IO0 | PNP_IRQ0, { 0x7f8, 0 }, }\r
-};\r
-\r
-/**********************************************************************************/\r
-/*                                                             PUBLIC INTERFACE                                                                  */\r
-/**********************************************************************************/\r
-\r
-//----------------------------------------------------------------------------------\r
-// Function:           enable_dev\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Create device structures and allocate resources to devices \r
-//                                     specified in the pnp_dev_info array (above).\r
-//\r
-static void enable_dev(device_t dev)\r
-{\r
-       pnp_enable_devices(dev, &pnp_ops, \r
-                                          sizeof(pnp_dev_info)/sizeof(pnp_dev_info[0]), \r
-                                          pnp_dev_info);\r
-}\r
-\r
-//----------------------------------------------------------------------------------\r
-// Function:           lpc47n217_pnp_set_resources\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Configure the specified Super I/O device with the resources\r
-//                                     (I/O space, etc.) that have been allocate for it.\r
-//\r
-void lpc47n217_pnp_set_resources(device_t dev)\r
-{\r
-       int i;\r
-       \r
-       pnp_enter_conf_state(dev);  \r
-\r
-       // NOTE: Cannot use pnp_set_resources() here because it assumes chip\r
-       //               support for logical devices, which the LPC47N217 doesn't have\r
-       for(i = 0; i < dev->resources; i++)\r
-               lpc47n217_pnp_set_resource(dev, &dev->resource[i]);\r
-\r
-//     dump_pnp_device(dev);\r
-                \r
-       pnp_exit_conf_state(dev);  \r
-}       \r
-\r
-void lpc47n217_pnp_enable_resources(device_t dev)\r
-{       \r
-    pnp_enter_conf_state(dev);\r
-\r
-       // NOTE: Cannot use pnp_enable_resources() here because it assumes chip\r
-       //               support for logical devices, which the LPC47N217 doesn't have\r
-    lpc47n217_pnp_set_enable(dev, 1);\r
-\r
-    pnp_exit_conf_state(dev);\r
-}\r
-\r
-void lpc47n217_pnp_enable(device_t dev)\r
-{\r
-       pnp_enter_conf_state(dev);   \r
-\r
-       // NOTE: Cannot use pnp_set_enable() here because it assumes chip\r
-       //               support for logical devices, which the LPC47N217 doesn't have\r
-\r
-       if(dev->enabled) {\r
-               lpc47n217_pnp_set_enable(dev, 1);\r
-       }\r
-       else {\r
-               lpc47n217_pnp_set_enable(dev, 0);\r
-       }\r
-\r
-       pnp_exit_conf_state(dev);  \r
-}\r
-\r
-//----------------------------------------------------------------------------------\r
-// Function:           lpc47n217_init\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Initialize the specified Super I/O device.\r
-//                                     Devices other than COM ports are ignored.\r
-//                                     For COM ports, we configure the baud rate. \r
-//\r
-static void lpc47n217_init(device_t dev)\r
-{\r
-       struct superio_smsc_lpc47n217_config* conf = dev->chip_info;\r
-       struct resource *res0;\r
-\r
-       if (!dev->enabled)\r
-               return;\r
-\r
-       switch(dev->path.u.pnp.device) {\r
-       case LPC47N217_SP1: \r
-               res0 = find_resource(dev, PNP_IDX_IO0);\r
-               init_uart8250(res0->base, &conf->com1);\r
-               break;\r
-\r
-       case LPC47N217_SP2:\r
-               res0 = find_resource(dev, PNP_IDX_IO0);\r
-               init_uart8250(res0->base, &conf->com2);\r
-               break;\r
-       }\r
-}\r
-\r
-\r
-/**********************************************************************************/\r
-/*                                                             PRIVATE FUNCTIONS                                                             */\r
-/**********************************************************************************/\r
-\r
-static void lpc47n217_pnp_set_resource(device_t dev, struct resource *resource)\r
-{\r
-       if (!(resource->flags & IORESOURCE_ASSIGNED)) {\r
-               printk_err("ERROR: %s %02x not allocated\n",\r
-                       dev_path(dev), resource->index);\r
-               return;\r
-       }\r
-\r
-       /* Now store the resource */\r
-       // NOTE: Cannot use pnp_set_XXX() here because they assume chip\r
-       //               support for logical devices, which the LPC47N217 doesn't have\r
-\r
-       if (resource->flags & IORESOURCE_IO) {\r
-               lpc47n217_pnp_set_iobase(dev, resource->base);\r
-       }\r
-       else if (resource->flags & IORESOURCE_DRQ) {\r
-               lpc47n217_pnp_set_drq(dev, resource->base);\r
-       }\r
-       else if (resource->flags  & IORESOURCE_IRQ) {\r
-               lpc47n217_pnp_set_irq(dev, resource->base);\r
-       }\r
-       else {\r
-               printk_err("ERROR: %s %02x unknown resource type\n",\r
-                       dev_path(dev), resource->index);\r
-               return;\r
-       }\r
-       resource->flags |= IORESOURCE_STORED;\r
-\r
-       report_resource_stored(dev, resource, "");\r
-}\r
-\r
-void lpc47n217_pnp_set_iobase(device_t dev, unsigned iobase)\r
-{\r
-       ASSERT(!(iobase & 0x3));\r
-       \r
-       switch(dev->path.u.pnp.device) {\r
-       case LPC47N217_PP: \r
-               pnp_write_config(dev, 0x23, (iobase >> 2) & 0xff);\r
-               break;\r
-               \r
-       case LPC47N217_SP1: \r
-               pnp_write_config(dev, 0x24, (iobase >> 2) & 0xff);\r
-               break;\r
-               \r
-       case LPC47N217_SP2:\r
-               pnp_write_config(dev, 0x25, (iobase >> 2) & 0xff);\r
-               break;\r
-               \r
-       default:\r
-               BUG();\r
-               break;\r
-       }\r
-}\r
-\r
-void lpc47n217_pnp_set_drq(device_t dev, unsigned drq)\r
-{\r
-       if (dev->path.u.pnp.device == LPC47N217_PP) {\r
-               const uint8_t PP_DMA_MASK = 0x0F;\r
-               const uint8_t PP_DMA_SELECTION_REGISTER = 0x26;\r
-               uint8_t current_config = pnp_read_config(dev, PP_DMA_SELECTION_REGISTER);\r
-               uint8_t new_config;\r
-\r
-               ASSERT(!(drq & ~PP_DMA_MASK));          // DRQ out of range??           \r
-               new_config = (current_config & ~PP_DMA_MASK) | drq;\r
-               pnp_write_config(dev, PP_DMA_SELECTION_REGISTER, new_config);\r
-       } else {\r
-               BUG();\r
-       }\r
-}\r
-\r
-void lpc47n217_pnp_set_irq(device_t dev, unsigned irq)\r
-{\r
-       uint8_t irq_config_register = 0;\r
-       uint8_t irq_config_mask = 0;\r
-       uint8_t current_config;\r
-       uint8_t new_config;\r
-       \r
-       switch(dev->path.u.pnp.device) {\r
-       case LPC47N217_PP: \r
-               irq_config_register = 0x27;\r
-               irq_config_mask = 0x0F;\r
-               break;\r
-               \r
-       case LPC47N217_SP1: \r
-               irq_config_register = 0x28;\r
-               irq_config_mask = 0xF0;\r
-               irq <<= 4;\r
-               break;\r
-               \r
-       case LPC47N217_SP2:\r
-               irq_config_register = 0x28;\r
-               irq_config_mask = 0x0F;\r
-               break;\r
-               \r
-       default:\r
-               BUG();\r
-               return;\r
-       }\r
-\r
-       ASSERT(!(irq & ~irq_config_mask));              // IRQ out of range??\r
-       \r
-       current_config = pnp_read_config(dev, irq_config_register);\r
-       new_config = (current_config & ~irq_config_mask) | irq;\r
-       pnp_write_config(dev, irq_config_register, new_config);\r
-}\r
-\r
-void lpc47n217_pnp_set_enable(device_t dev, int enable)\r
-{\r
-       uint8_t power_register = 0;\r
-       uint8_t power_mask = 0;\r
-       uint8_t current_power;\r
-       uint8_t new_power;\r
-       \r
-       switch(dev->path.u.pnp.device) {\r
-       case LPC47N217_PP: \r
-               power_register = 0x01;\r
-               power_mask = 0x04;\r
-               break;\r
-               \r
-       case LPC47N217_SP1: \r
-               power_register = 0x02;\r
-               power_mask = 0x08;\r
-               break;\r
-               \r
-       case LPC47N217_SP2:\r
-               power_register = 0x02;\r
-               power_mask = 0x80;\r
-               break;\r
-               \r
-       default:\r
-               BUG();\r
-               return;\r
-       }\r
-\r
-       current_power = pnp_read_config(dev, power_register);\r
-       new_power = current_power & ~power_mask;                // disable by default\r
-\r
-       if (enable) {\r
-               struct resource* ioport_resource = find_resource(dev, PNP_IDX_IO0);\r
-               lpc47n217_pnp_set_iobase(dev, ioport_resource->base);\r
-               \r
-               new_power |= power_mask;                // Enable\r
-               \r
-    } else {\r
-               lpc47n217_pnp_set_iobase(dev, 0);\r
-       }\r
-       pnp_write_config(dev, power_register, new_power);\r
-}\r
-\r
-\r
-//----------------------------------------------------------------------------------\r
-// Function:           pnp_enter_conf_state\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Enable access to the LPC47N217's configuration registers.\r
-//\r
-static void pnp_enter_conf_state(device_t dev) \r
-{\r
-       outb(0x55, dev->path.u.pnp.port);\r
-}\r
-\r
-//----------------------------------------------------------------------------------\r
-// Function:           pnp_exit_conf_state\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Disable access to the LPC47N217's configuration registers.\r
-//\r
-static void pnp_exit_conf_state(device_t dev) \r
-{\r
-    outb(0xaa, dev->path.u.pnp.port);\r
-}\r
-\r
-#if 0\r
-//----------------------------------------------------------------------------------\r
-// Function:           dump_pnp_device\r
-// Parameters:         dev - pointer to structure describing a Super I/O device \r
-// Return Value:       None\r
-// Description:        Print the values of all of the LPC47N217's configuration registers.\r
-//                                     NOTE: The LPC47N217 must be in configuration mode when this\r
-//                                               function is called.\r
-//\r
-static void dump_pnp_device(device_t dev)\r
-{\r
-    int register_index;\r
-    print_debug("\r\n");\r
-\r
-    for(register_index = 0; register_index <= LPC47N217_MAX_CONFIG_REGISTER; register_index++) {\r
-        uint8_t register_value;\r
-\r
-        if ((register_index & 0x0f) == 0) {\r
-                print_debug_hex8(register_index);\r
-                print_debug_char(':');\r
-        }\r
-\r
-               // Skip over 'register' that would cause exit from configuration mode\r
-           if (register_index == 0xaa)\r
-                       register_value = 0xaa;\r
-               else\r
-               register_value = pnp_read_config(dev, register_index);\r
-\r
-        print_debug_char(' ');\r
-        print_debug_hex8(register_value);\r
-        if ((register_index & 0x0f) == 0x0f) {\r
-               print_debug("\r\n");\r
-        }\r
-    }\r
-\r
-       print_debug("\r\n");\r
-}\r
-#endif\r
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2000 AG Electronics Ltd.
+ * Copyright (C) 2003-2004 Linux Networx
+ * Copyright (C) 2004 Tyan
+ * Copyright (C) 2005 Digital Design Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
+ */
+
+/* RAM-based driver for SMSC LPC47N217 Super I/O chip. */
+
+#include <arch/io.h>
+#include <device/device.h>
+#include <device/pnp.h>
+#include <console/console.h>
+#include <device/smbus.h>
+#include <string.h>
+#include <bitops.h>
+#include <uart8250.h>
+#include <assert.h>
+#include <stdlib.h>
+#include "chip.h"
+#include "lpc47n217.h"
+
+/* Forward declarations */
+static void enable_dev(device_t dev);
+static void lpc47n217_pnp_set_resources(device_t dev);
+static void lpc47n217_pnp_enable_resources(device_t dev);
+static void lpc47n217_pnp_enable(device_t dev);
+static void lpc47n217_init(device_t dev);
+static void lpc47n217_pnp_set_resource(device_t dev, struct resource *resource);
+static void lpc47n217_pnp_set_iobase(device_t dev, u16 iobase);
+static void lpc47n217_pnp_set_drq(device_t dev, u8 drq);
+static void lpc47n217_pnp_set_irq(device_t dev, u8 irq);
+static void lpc47n217_pnp_set_enable(device_t dev, int enable);
+static void pnp_enter_conf_state(device_t dev);
+static void pnp_exit_conf_state(device_t dev);
+
+struct chip_operations superio_smsc_lpc47n217_ops = {
+       CHIP_NAME("SMSC LPC47N217 Super I/O")
+       .enable_dev = enable_dev,
+};
+
+static struct device_operations ops = {
+       .read_resources   = pnp_read_resources,
+       .set_resources    = lpc47n217_pnp_set_resources,
+       .enable_resources = lpc47n217_pnp_enable_resources,
+       .enable           = lpc47n217_pnp_enable,
+       .init             = lpc47n217_init,
+};
+
+static struct pnp_info pnp_dev_info[] = {
+       { &ops, LPC47N217_PP,   PNP_IO0 | PNP_IRQ0 | PNP_DRQ0, {0x07f8, 0}, },
+       { &ops, LPC47N217_SP1,  PNP_IO0 | PNP_IRQ0, {0x07f8, 0}, },
+       { &ops, LPC47N217_SP2,  PNP_IO0 | PNP_IRQ0, {0x07f8, 0}, }
+};
+
+/**
+ * Create device structures and allocate resources to devices specified in the
+ * pnp_dev_info array (above).
+ *
+ * @param dev Pointer to structure describing a Super I/O device.
+ */
+static void enable_dev(device_t dev)
+{
+       pnp_enable_devices(dev, &pnp_ops, ARRAY_SIZE(pnp_dev_info),
+                          pnp_dev_info);
+}
+
+/**
+ * Configure the specified Super I/O device with the resources (I/O space,
+ * etc.) that have been allocate for it.
+ *
+ * NOTE: Cannot use pnp_set_resources() here because it assumes chip
+ * support for logical devices, which the LPC47N217 doesn't have.
+ *
+ * @param dev Pointer to structure describing a Super I/O device.
+ */
+static void lpc47n217_pnp_set_resources(device_t dev)
+{
+       struct resource *res;
+
+       pnp_enter_conf_state(dev);
+       for (res = dev->resource_list; res; res = res->next)
+               lpc47n217_pnp_set_resource(dev, res);
+       /* dump_pnp_device(dev); */
+       pnp_exit_conf_state(dev);
+}
+
+/*
+ * NOTE: Cannot use pnp_enable_resources() here because it assumes chip
+ * support for logical devices, which the LPC47N217 doesn't have.
+ */
+static void lpc47n217_pnp_enable_resources(device_t dev)
+{
+       pnp_enter_conf_state(dev);
+       lpc47n217_pnp_set_enable(dev, 1);
+       pnp_exit_conf_state(dev);
+}
+
+/*
+ * NOTE: Cannot use pnp_set_enable() here because it assumes chip
+ * support for logical devices, which the LPC47N217 doesn't have.
+ */
+static void lpc47n217_pnp_enable(device_t dev)
+{
+       pnp_enter_conf_state(dev);
+       lpc47n217_pnp_set_enable(dev, !!dev->enabled);
+       pnp_exit_conf_state(dev);
+}
+
+/**
+ * Initialize the specified Super I/O device.
+ *
+ * Devices other than COM ports are ignored. For COM ports, we configure the
+ * baud rate.
+ *
+ * @param dev Pointer to structure describing a Super I/O device.
+ */
+static void lpc47n217_init(device_t dev)
+{
+       struct superio_smsc_lpc47n217_config* conf = dev->chip_info;
+       struct resource *res0;
+
+       if (!dev->enabled)
+               return;
+
+       switch(dev->path.pnp.device) {
+       case LPC47N217_SP1:
+               res0 = find_resource(dev, PNP_IDX_IO0);
+               init_uart8250(res0->base, &conf->com1);
+               break;
+       case LPC47N217_SP2:
+               res0 = find_resource(dev, PNP_IDX_IO0);
+               init_uart8250(res0->base, &conf->com2);
+               break;
+       }
+}
+
+static void lpc47n217_pnp_set_resource(device_t dev, struct resource *resource)
+{
+       if (!(resource->flags & IORESOURCE_ASSIGNED)) {
+               printk(BIOS_ERR, "ERROR: %s %02x not allocated\n",
+                      dev_path(dev), resource->index);
+               return;
+       }
+
+       /* Now store the resource. */
+
+       /*
+        * NOTE: Cannot use pnp_set_XXX() here because they assume chip
+        * support for logical devices, which the LPC47N217 doesn't have.
+        */
+       if (resource->flags & IORESOURCE_IO) {
+               lpc47n217_pnp_set_iobase(dev, resource->base);
+       } else if (resource->flags & IORESOURCE_DRQ) {
+               lpc47n217_pnp_set_drq(dev, resource->base);
+       } else if (resource->flags & IORESOURCE_IRQ) {
+               lpc47n217_pnp_set_irq(dev, resource->base);
+       } else {
+               printk(BIOS_ERR, "ERROR: %s %02x unknown resource type\n",
+                      dev_path(dev), resource->index);
+               return;
+       }
+       resource->flags |= IORESOURCE_STORED;
+
+       report_resource_stored(dev, resource, "");
+}
+
+static void lpc47n217_pnp_set_iobase(device_t dev, u16 iobase)
+{
+       ASSERT(!(iobase & 0x3));
+
+       switch(dev->path.pnp.device) {
+       case LPC47N217_PP:
+               pnp_write_config(dev, 0x23, (iobase >> 2) & 0xff);
+               break;
+       case LPC47N217_SP1:
+               pnp_write_config(dev, 0x24, (iobase >> 2) & 0xff);
+               break;
+       case LPC47N217_SP2:
+               pnp_write_config(dev, 0x25, (iobase >> 2) & 0xff);
+               break;
+       default:
+               BUG();
+               break;
+       }
+}
+
+static void lpc47n217_pnp_set_drq(device_t dev, u8 drq)
+{
+       const u8 PP_DMA_MASK = 0x0F;
+       const u8 PP_DMA_SELECTION_REGISTER = 0x26;
+       u8 current_config, new_config;
+
+       if (dev->path.pnp.device == LPC47N217_PP) {
+               current_config = pnp_read_config(dev,
+                                                PP_DMA_SELECTION_REGISTER);
+               ASSERT(!(drq & ~PP_DMA_MASK)); /* DRQ out of range? */
+               new_config = (current_config & ~PP_DMA_MASK) | drq;
+               pnp_write_config(dev, PP_DMA_SELECTION_REGISTER, new_config);
+       } else {
+               BUG();
+       }
+}
+
+static void lpc47n217_pnp_set_irq(device_t dev, u8 irq)
+{
+       u8 irq_config_register = 0, irq_config_mask = 0;
+       u8 current_config, new_config;
+
+       switch(dev->path.pnp.device) {
+       case LPC47N217_PP:
+               irq_config_register = 0x27;
+               irq_config_mask = 0x0F;
+               break;
+       case LPC47N217_SP1:
+               irq_config_register = 0x28;
+               irq_config_mask = 0xF0;
+               irq <<= 4;
+               break;
+       case LPC47N217_SP2:
+               irq_config_register = 0x28;
+               irq_config_mask = 0x0F;
+               break;
+       default:
+               BUG();
+               return;
+       }
+
+       ASSERT(!(irq & ~irq_config_mask)); /* IRQ out of range? */
+
+       current_config = pnp_read_config(dev, irq_config_register);
+       new_config = (current_config & ~irq_config_mask) | irq;
+       pnp_write_config(dev, irq_config_register, new_config);
+}
+
+static void lpc47n217_pnp_set_enable(device_t dev, int enable)
+{
+       u8 power_register = 0, power_mask = 0, current_power, new_power;
+
+       switch(dev->path.pnp.device) {
+       case LPC47N217_PP:
+               power_register = 0x01;
+               power_mask = 0x04;
+               break;
+       case LPC47N217_SP1:
+               power_register = 0x02;
+               power_mask = 0x08;
+               break;
+       case LPC47N217_SP2:
+               power_register = 0x02;
+               power_mask = 0x80;
+               break;
+       default:
+               BUG();
+               return;
+       }
+
+       current_power = pnp_read_config(dev, power_register);
+       new_power = current_power & ~power_mask; /* Disable by default. */
+       if (enable) {
+               struct resource* ioport_resource;
+               ioport_resource = find_resource(dev, PNP_IDX_IO0);
+               lpc47n217_pnp_set_iobase(dev, ioport_resource->base);
+               new_power |= power_mask; /* Enable. */
+       } else {
+               lpc47n217_pnp_set_iobase(dev, 0);
+       }
+       pnp_write_config(dev, power_register, new_power);
+}
+
+static void pnp_enter_conf_state(device_t dev)
+{
+       outb(0x55, dev->path.pnp.port);
+}
+
+static void pnp_exit_conf_state(device_t dev)
+{
+       outb(0xaa, dev->path.pnp.port);
+}
+
+#if 0
+/**
+ * Print the values of all of the LPC47N217's configuration registers.
+ *
+ * NOTE: The LPC47N217 must be in config mode when this function is called.
+ *
+ * @param dev Pointer to structure describing a Super I/O device.
+ */
+static void dump_pnp_device(device_t dev)
+{
+       int i;
+       print_debug("\n");
+
+       for (i = 0; i <= LPC47N217_MAX_CONFIG_REGISTER; i++) {
+               u8 register_value;
+
+               if ((i & 0x0f) == 0) {
+                       print_debug_hex8(i);
+                       print_debug_char(':');
+               }
+
+               /*
+                * Skip over 'register' that would cause exit from
+                * configuration mode.
+                */
+               if (i == 0xaa)
+                       register_value = 0xaa;
+               else
+                       register_value = pnp_read_config(dev, i);
+
+               print_debug_char(' ');
+               print_debug_hex8(register_value);
+               if ((i & 0x0f) == 0x0f)
+                       print_debug("\n");
+       }
+
+       print_debug("\n");
+}
+#endif