# CONFIG_GENERIC_TIME_VSYSCALL is not set
# CONFIG_GEN_RTC is not set
CONFIG_GPIOLIB=y
+CONFIG_GPIO_RDC321X=y
CONFIG_GPIO_SYSFS=y
# CONFIG_HAMRADIO is not set
# CONFIG_HANGCHECK_TIMER is not set
# CONFIG_MCYRIXIII is not set
# CONFIG_MEFFICEON is not set
# CONFIG_MEMTEST is not set
+CONFIG_MFD_CORE=y
+CONFIG_MFD_RDC321X=y
# CONFIG_MGEODEGX1 is not set
# CONFIG_MGEODE_LX is not set
# CONFIG_MICROCODE is not set
# CONFIG_MTD_COMPLEX_MAPPINGS is not set
# CONFIG_MTD_NETSC520 is not set
CONFIG_MTD_PHYSMAP=y
-# CONFIG_MTD_R8610 is not set
-# CONFIG_MTD_RDC3210 is not set
# CONFIG_MTD_TS5500 is not set
# CONFIG_MTRR is not set
# CONFIG_MVIAC3_2 is not set
--- /dev/null
+This patch adds a new MFD driver for the RDC321x southbridge. This southbridge
+is always present in the RDC321x System-on-a-Chip and provides access to some
+GPIOs as well as a watchdog. Access to these two functions is done using the
+southbridge PCI device configuration space.
+
+Signed-off-by: Florian Fainelli <florian@openwrt.org>
+---
+Changes from v2:
+- pass the pci_dev pointer to MFD cell drivers as platform_data
+- remove the printk(KERN_ERR and use dev_err instead
+- removed pci_dev accessors
+- use DEFINE_PCI_DEVICE_TABLE
+
+Index: linux-2.6.32.10/drivers/mfd/Kconfig
+===================================================================
+--- linux-2.6.32.10.orig/drivers/mfd/Kconfig 2010-03-15 16:52:04.000000000 +0100
++++ linux-2.6.32.10/drivers/mfd/Kconfig 2010-04-28 11:38:27.000000000 +0200
+@@ -305,6 +305,15 @@
+ This enables the PCAP ASIC present on EZX Phones. This is
+ needed for MMC, TouchScreen, Sound, USB, etc..
+
++config MFD_RDC321X
++ tristate "Support for RDC-R321x southbridge"
++ select MFD_CORE
++ depends on PCI
++ help
++ Say yes here if you want to have support for the RDC R-321x SoC
++ southbridge which provides access to GPIOs and Watchdog using the
++ southbridge PCI device configuration space.
++
+ endmenu
+
+ menu "Multimedia Capabilities Port drivers"
+Index: linux-2.6.32.10/drivers/mfd/Makefile
+===================================================================
+--- linux-2.6.32.10.orig/drivers/mfd/Makefile 2010-03-15 16:52:04.000000000 +0100
++++ linux-2.6.32.10/drivers/mfd/Makefile 2010-04-28 11:38:53.000000000 +0200
+@@ -50,3 +50,5 @@
+ obj-$(CONFIG_PCF50633_GPIO) += pcf50633-gpio.o
+ obj-$(CONFIG_AB3100_CORE) += ab3100-core.o
+ obj-$(CONFIG_AB3100_OTP) += ab3100-otp.o
++
++obj-$(CONFIG_MFD_RDC321X) += rdc321x-southbridge.o
+Index: linux-2.6.32.10/drivers/mfd/rdc321x-southbridge.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/drivers/mfd/rdc321x-southbridge.c 2010-04-28 11:38:27.000000000 +0200
+@@ -0,0 +1,123 @@
++/*
++ * RDC321x MFD southbrige driver
++ *
++ * Copyright (C) 2007-2010 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2010 Bernhard Loos <bernhardloos@googlemail.com>
++ *
++ * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
++ *
++ */
++#include <linux/init.h>
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/platform_device.h>
++#include <linux/pci.h>
++#include <linux/mfd/core.h>
++#include <linux/mfd/rdc321x.h>
++
++static struct rdc321x_wdt_pdata rdc321x_wdt_pdata;
++
++static struct resource rdc321x_wdt_resource[] = {
++ {
++ .name = "wdt-reg",
++ .start = RDC321X_WDT_CTRL,
++ .end = RDC321X_WDT_CTRL + 0x3,
++ .flags = IORESOURCE_MEM,
++ }
++};
++
++static struct rdc321x_gpio_pdata rdc321x_gpio_pdata = {
++ .max_gpios = RDC321X_MAX_GPIO,
++};
++
++static struct resource rdc321x_gpio_resources[] = {
++ {
++ .name = "gpio-reg1",
++ .start = RDC321X_GPIO_CTRL_REG1,
++ .end = RDC321X_GPIO_CTRL_REG1 + 0x7,
++ .flags = IORESOURCE_MEM,
++ }, {
++ .name = "gpio-reg2",
++ .start = RDC321X_GPIO_CTRL_REG2,
++ .end = RDC321X_GPIO_CTRL_REG2 + 0x7,
++ .flags = IORESOURCE_MEM,
++ }
++};
++
++static struct mfd_cell rdc321x_sb_cells[] = {
++ {
++ .name = "rdc321x-wdt",
++ .resources = rdc321x_wdt_resource,
++ .num_resources = ARRAY_SIZE(rdc321x_wdt_resource),
++ .driver_data = &rdc321x_wdt_pdata,
++ }, {
++ .name = "rdc321x-gpio",
++ .resources = rdc321x_gpio_resources,
++ .num_resources = ARRAY_SIZE(rdc321x_gpio_resources),
++ .driver_data = &rdc321x_gpio_pdata,
++ },
++};
++
++static int __devinit rdc321x_sb_probe(struct pci_dev *pdev,
++ const struct pci_device_id *ent)
++{
++ int err;
++
++ err = pci_enable_device(pdev);
++ if (err) {
++ dev_err(&pdev->dev, "failed to enable device\n");
++ return err;
++ }
++
++ rdc321x_gpio_pdata.sb_pdev = pdev;
++ rdc321x_wdt_pdata.sb_pdev = pdev;
++
++ return mfd_add_devices(&pdev->dev, -1,
++ rdc321x_sb_cells, ARRAY_SIZE(rdc321x_sb_cells), NULL, 0);
++}
++
++static void __devexit rdc321x_sb_remove(struct pci_dev *pdev)
++{
++ mfd_remove_devices(&pdev->dev);
++}
++
++static DEFINE_PCI_DEVICE_TABLE(rdc321x_sb_table) = {
++ { PCI_DEVICE(PCI_VENDOR_ID_RDC, PCI_DEVICE_ID_RDC_R6030) },
++ {}
++};
++
++static struct pci_driver rdc321x_sb_driver = {
++ .name = "RDC321x Southbridge",
++ .id_table = rdc321x_sb_table,
++ .probe = rdc321x_sb_probe,
++ .remove = __devexit_p(rdc321x_sb_remove),
++};
++
++static int __init rdc321x_sb_init(void)
++{
++ return pci_register_driver(&rdc321x_sb_driver);
++}
++
++static void __exit rdc321x_sb_exit(void)
++{
++ pci_unregister_driver(&rdc321x_sb_driver);
++}
++
++module_init(rdc321x_sb_init);
++module_exit(rdc321x_sb_exit);
++
++MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
++MODULE_LICENSE("GPL");
++MODULE_DESCRIPTION("RDC R-321x MFD southbridge driver");
+Index: linux-2.6.32.10/include/linux/mfd/rdc321x.h
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/include/linux/mfd/rdc321x.h 2010-04-28 11:38:27.000000000 +0200
+@@ -0,0 +1,26 @@
++#ifndef __RDC321X_MFD_H
++#define __RDC321X_MFD_H
++
++#include <linux/types.h>
++#include <linux/pci.h>
++
++/* Offsets to be accessed in the southbridge PCI
++ * device configuration register */
++#define RDC321X_WDT_CTRL 0x44
++#define RDC321X_GPIO_CTRL_REG1 0x48
++#define RDC321X_GPIO_DATA_REG1 0x4c
++#define RDC321X_GPIO_CTRL_REG2 0x84
++#define RDC321X_GPIO_DATA_REG2 0x88
++
++#define RDC321X_MAX_GPIO 58
++
++struct rdc321x_gpio_pdata {
++ struct pci_dev *sb_pdev;
++ unsigned max_gpios;
++};
++
++struct rdc321x_wdt_pdata {
++ struct pci_dev *sb_pdev;
++};
++
++#endif /* __RDC321X_MFD_H */
+++ /dev/null
---- a/arch/x86/Makefile
-+++ b/arch/x86/Makefile
-@@ -125,6 +125,9 @@ libs-y += arch/x86/lib/
- # See arch/x86/Kbuild for content of core part of the kernel
- core-y += arch/x86/
-
-+# RDC R-321X support
-+core-$(CONFIG_X86_RDC321X) += arch/x86/mach-rdc321x/
-+
- # drivers-y are linked after core-y
- drivers-$(CONFIG_MATH_EMULATION) += arch/x86/math-emu/
- drivers-$(CONFIG_PCI) += arch/x86/pci/
--- /dev/null
+This patch adds a new GPIO driver for the RDC321x SoC GPIO controller.
+
+Signed-off-by: Florian Fainelli <florian@openwrt.org>
+---
+Changes from v2:
+- initialize spinlock earlier
+- do not declare and assign gpch variables on the same line
+- use the pci_dev pointer passed as platform data
+- replaced rdc321x_pci_{read,write}
+
+Index: linux-2.6.32.10/drivers/gpio/Kconfig
+===================================================================
+--- linux-2.6.32.10.orig/drivers/gpio/Kconfig 2010-03-15 16:52:04.000000000 +0100
++++ linux-2.6.32.10/drivers/gpio/Kconfig 2010-04-28 11:39:02.000000000 +0200
+@@ -196,6 +196,14 @@
+ help
+ Say Y here to support Intel Moorestown platform GPIO.
+
++config GPIO_RDC321X
++ tristate "RDC R-321x GPIO support"
++ depends on PCI && GPIOLIB
++ select MFD_RDC321X
++ help
++ Support for the RDC R321x SoC GPIOs over southbridge
++ PCI configuration space.
++
+ comment "SPI GPIO expanders:"
+
+ config GPIO_MAX7301
+Index: linux-2.6.32.10/drivers/gpio/Makefile
+===================================================================
+--- linux-2.6.32.10.orig/drivers/gpio/Makefile 2010-03-15 16:52:04.000000000 +0100
++++ linux-2.6.32.10/drivers/gpio/Makefile 2010-04-28 11:39:17.000000000 +0200
+@@ -19,3 +19,4 @@
+ obj-$(CONFIG_GPIO_BT8XX) += bt8xxgpio.o
+ obj-$(CONFIG_GPIO_VR41XX) += vr41xx_giu.o
+ obj-$(CONFIG_GPIO_WM831X) += wm831x-gpio.o
++obj-$(CONFIG_GPIO_RDC321X) += rdc321x-gpio.o
+Index: linux-2.6.32.10/drivers/gpio/rdc321x-gpio.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/drivers/gpio/rdc321x-gpio.c 2010-04-28 11:39:02.000000000 +0200
+@@ -0,0 +1,245 @@
++/*
++ * RDC321x GPIO driver
++ *
++ * Copyright (C) 2008, Volker Weiss <dev@tintuc.de>
++ * Copyright (C) 2007-2010 Florian Fainelli <florian@openwrt.org>
++ *
++ * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
++ *
++ */
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/spinlock.h>
++#include <linux/platform_device.h>
++#include <linux/pci.h>
++#include <linux/gpio.h>
++#include <linux/mfd/rdc321x.h>
++
++struct rdc321x_gpio {
++ spinlock_t lock;
++ struct pci_dev *sb_pdev;
++ u32 data_reg[2];
++ int reg1_ctrl_base;
++ int reg1_data_base;
++ int reg2_ctrl_base;
++ int reg2_data_base;
++ struct gpio_chip chip;
++};
++
++/* read GPIO pin */
++static int rdc_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
++{
++ struct rdc321x_gpio *gpch;
++ u32 value = 0;
++ int reg;
++
++ gpch = container_of(chip, struct rdc321x_gpio, chip);
++ reg = gpio < 32 ? gpch->reg1_data_base : gpch->reg2_data_base;
++
++ spin_lock(&gpch->lock);
++ pci_write_config_dword(gpch->sb_pdev, reg,
++ gpch->data_reg[gpio < 32 ? 0 : 1]);
++ pci_read_config_dword(gpch->sb_pdev, reg, &value);
++ spin_unlock(&gpch->lock);
++
++ return (1 << (gpio & 0x1f)) & value ? 1 : 0;
++}
++
++static void rdc_gpio_set_value_impl(struct gpio_chip *chip,
++ unsigned gpio, int value)
++{
++ struct rdc321x_gpio *gpch;
++ int reg = (gpio < 32) ? 0 : 1;
++
++ gpch = container_of(chip, struct rdc321x_gpio, chip);
++
++ if (value)
++ gpch->data_reg[reg] |= 1 << (gpio & 0x1f);
++ else
++ gpch->data_reg[reg] &= ~(1 << (gpio & 0x1f));
++
++ pci_write_config_dword(gpch->sb_pdev,
++ reg ? gpch->reg1_data_base : gpch->reg2_data_base,
++ gpch->data_reg[reg]);
++}
++
++/* set GPIO pin to value */
++static void rdc_gpio_set_value(struct gpio_chip *chip,
++ unsigned gpio, int value)
++{
++ struct rdc321x_gpio *gpch;
++
++ gpch = container_of(chip, struct rdc321x_gpio, chip);
++ spin_lock(&gpch->lock);
++ rdc_gpio_set_value_impl(chip, gpio, value);
++ spin_unlock(&gpch->lock);
++}
++
++static int rdc_gpio_config(struct gpio_chip *chip,
++ unsigned gpio, int value)
++{
++ struct rdc321x_gpio *gpch;
++ int err;
++ u32 reg;
++
++ gpch = container_of(chip, struct rdc321x_gpio, chip);
++
++ spin_lock(&gpch->lock);
++ err = pci_read_config_dword(gpch->sb_pdev, gpio < 32 ?
++ gpch->reg1_ctrl_base : gpch->reg2_ctrl_base, ®);
++ if (err)
++ goto unlock;
++
++ reg |= 1 << (gpio & 0x1f);
++
++ err = pci_write_config_dword(gpch->sb_pdev, gpio < 32 ?
++ gpch->reg1_ctrl_base : gpch->reg2_ctrl_base, reg);
++ if (err)
++ goto unlock;
++
++ rdc_gpio_set_value_impl(chip, gpio, value);
++
++unlock:
++ spin_unlock(&gpch->lock);
++
++ return err;
++}
++
++/* configure GPIO pin as input */
++static int rdc_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
++{
++ return rdc_gpio_config(chip, gpio, 1);
++}
++
++/*
++ * Cache the initial value of both GPIO data registers
++ */
++static int __devinit rdc321x_gpio_probe(struct platform_device *pdev)
++{
++ int err;
++ struct resource *r;
++ struct rdc321x_gpio *rdc321x_gpio_dev;
++ struct rdc321x_gpio_pdata *pdata;
++
++ pdata = pdev->dev.platform_data;
++ if (!pdata) {
++ dev_err(&pdev->dev, "no platform data supplied\n");
++ return -ENODEV;
++ }
++
++ rdc321x_gpio_dev = kzalloc(sizeof(struct rdc321x_gpio), GFP_KERNEL);
++ if (!rdc321x_gpio_dev) {
++ dev_err(&pdev->dev, "failed to allocate private data\n");
++ return -ENOMEM;
++ }
++
++ r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "gpio-reg1");
++ if (!r) {
++ dev_err(&pdev->dev, "failed to get gpio-reg1 resource\n");
++ err = -ENODEV;
++ goto out_free;
++ }
++
++ spin_lock_init(&rdc321x_gpio_dev->lock);
++ rdc321x_gpio_dev->sb_pdev = pdata->sb_pdev;
++ rdc321x_gpio_dev->reg1_ctrl_base = r->start;
++ rdc321x_gpio_dev->reg1_data_base = r->start + 0x4;
++
++ r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "gpio-reg2");
++ if (!r) {
++ dev_err(&pdev->dev, "failed to get gpio-reg2 resource\n");
++ err = -ENODEV;
++ goto out_free;
++ }
++
++ rdc321x_gpio_dev->reg2_ctrl_base = r->start;
++ rdc321x_gpio_dev->reg2_data_base = r->start + 0x4;
++
++ rdc321x_gpio_dev->chip.label = "rdc321x-gpio";
++ rdc321x_gpio_dev->chip.direction_input = rdc_gpio_direction_input;
++ rdc321x_gpio_dev->chip.direction_output = rdc_gpio_config;
++ rdc321x_gpio_dev->chip.get = rdc_gpio_get_value;
++ rdc321x_gpio_dev->chip.set = rdc_gpio_set_value;
++ rdc321x_gpio_dev->chip.base = 0;
++ rdc321x_gpio_dev->chip.ngpio = pdata->max_gpios;
++
++ platform_set_drvdata(pdev, rdc321x_gpio_dev);
++
++ /* This might not be, what others (BIOS, bootloader, etc.)
++ wrote to these registers before, but it's a good guess. Still
++ better than just using 0xffffffff. */
++ err = pci_read_config_dword(rdc321x_gpio_dev->sb_pdev,
++ rdc321x_gpio_dev->reg1_data_base,
++ &rdc321x_gpio_dev->data_reg[0]);
++ if (err)
++ goto out_drvdata;
++
++ err = pci_read_config_dword(rdc321x_gpio_dev->sb_pdev,
++ rdc321x_gpio_dev->reg2_data_base,
++ &rdc321x_gpio_dev->data_reg[1]);
++ if (err)
++ goto out_drvdata;
++
++ dev_info(&pdev->dev, "registering %d GPIOs\n",
++ rdc321x_gpio_dev->chip.ngpio);
++ return gpiochip_add(&rdc321x_gpio_dev->chip);
++
++out_drvdata:
++ platform_set_drvdata(pdev, NULL);
++out_free:
++ kfree(rdc321x_gpio_dev);
++ return err;
++}
++
++static int __devexit rdc321x_gpio_remove(struct platform_device *pdev)
++{
++ int ret;
++ struct rdc321x_gpio *rdc321x_gpio_dev = platform_get_drvdata(pdev);
++
++ ret = gpiochip_remove(&rdc321x_gpio_dev->chip);
++ if (ret)
++ dev_err(&pdev->dev, "failed to unregister chip\n");
++
++ kfree(rdc321x_gpio_dev);
++ platform_set_drvdata(pdev, NULL);
++
++ return ret;
++}
++
++static struct platform_driver rdc321x_gpio_driver = {
++ .driver.name = "rdc321x-gpio",
++ .driver.owner = THIS_MODULE,
++ .probe = rdc321x_gpio_probe,
++ .remove = __devexit_p(rdc321x_gpio_remove),
++};
++
++static int __init rdc321x_gpio_init(void)
++{
++ return platform_driver_register(&rdc321x_gpio_driver);
++}
++
++static void __exit rdc321x_gpio_exit(void)
++{
++ platform_driver_unregister(&rdc321x_gpio_driver);
++}
++
++module_init(rdc321x_gpio_init);
++module_exit(rdc321x_gpio_exit);
++
++MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
++MODULE_DESCRIPTION("RDC321x GPIO driver");
++MODULE_LICENSE("GPL");
++MODULE_ALIAS("platform:rdc321x-gpio");
--- /dev/null
+The RDC321x MFD southbridge driver will pass a reference to the southbridge
+PCI device which should be used by the watchdog driver for its operations.
+This patch converts the watchdog driver to use the pci_dev pointer and make use
+of the base register resource which is passed along with the platform device.
+
+Acked-by: Wim Van Sebroeck <wim@iguana.be>
+Signed-off-by: Florian Fainelli <florian@openwrt.org>
+---
+Changes from v2:
+- replaced rdc321x_pci_{read,write}
+- use the pci_dev pointer passed as platform_data
+
+Index: linux-2.6.30.10/drivers/watchdog/rdc321x_wdt.c
+===================================================================
+--- linux-2.6.30.10.orig/drivers/watchdog/rdc321x_wdt.c 2009-12-04 07:00:07.000000000 +0100
++++ linux-2.6.30.10/drivers/watchdog/rdc321x_wdt.c 2010-04-28 10:17:46.000000000 +0200
+@@ -1,7 +1,7 @@
+ /*
+ * RDC321x watchdog driver
+ *
+- * Copyright (C) 2007 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2007-2010 Florian Fainelli <florian@openwrt.org>
+ *
+ * This driver is highly inspired from the cpu5_wdt driver
+ *
+@@ -36,8 +36,7 @@
+ #include <linux/watchdog.h>
+ #include <linux/io.h>
+ #include <linux/uaccess.h>
+-
+-#include <asm/rdc321x_defs.h>
++#include <linux/mfd/rdc321x.h>
+
+ #define RDC_WDT_MASK 0x80000000 /* Mask */
+ #define RDC_WDT_EN 0x00800000 /* Enable bit */
+@@ -63,6 +62,8 @@
+ int default_ticks;
+ unsigned long inuse;
+ spinlock_t lock;
++ struct pci_dev *sb_pdev;
++ int base_reg;
+ } rdc321x_wdt_device;
+
+ /* generic helper functions */
+@@ -70,14 +71,18 @@
+ static void rdc321x_wdt_trigger(unsigned long unused)
+ {
+ unsigned long flags;
++ u32 val;
+
+ if (rdc321x_wdt_device.running)
+ ticks--;
+
+ /* keep watchdog alive */
+ spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- outl(RDC_WDT_EN | inl(RDC3210_CFGREG_DATA),
+- RDC3210_CFGREG_DATA);
++ pci_read_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, &val);
++ val |= RDC_WDT_EN;
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, val);
+ spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
+
+ /* requeue?? */
+@@ -105,10 +110,13 @@
+
+ /* Clear the timer */
+ spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- outl(RDC_CLS_TMR, RDC3210_CFGREG_ADDR);
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, RDC_CLS_TMR);
+
+ /* Enable watchdog and set the timeout to 81.92 us */
+- outl(RDC_WDT_EN | RDC_WDT_CNT, RDC3210_CFGREG_DATA);
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg,
++ RDC_WDT_EN | RDC_WDT_CNT);
+ spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
+
+ mod_timer(&rdc321x_wdt_device.timer,
+@@ -148,7 +156,7 @@
+ unsigned long arg)
+ {
+ void __user *argp = (void __user *)arg;
+- unsigned int value;
++ u32 value;
+ static struct watchdog_info ident = {
+ .options = WDIOF_CARDRESET,
+ .identity = "RDC321x WDT",
+@@ -162,9 +170,10 @@
+ case WDIOC_GETSTATUS:
+ /* Read the value from the DATA register */
+ spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- value = inl(RDC3210_CFGREG_DATA);
++ pci_read_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, &value);
+ spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
+- if (copy_to_user(argp, &value, sizeof(int)))
++ if (copy_to_user(argp, &value, sizeof(u32)))
+ return -EFAULT;
+ break;
+ case WDIOC_GETSUPPORT:
+@@ -219,17 +228,35 @@
+ static int __devinit rdc321x_wdt_probe(struct platform_device *pdev)
+ {
+ int err;
++ struct resource *r;
++ struct rdc321x_wdt_pdata *pdata;
++
++ pdata = pdev->dev.platform_data;
++ if (!pdata) {
++ dev_err(&pdev->dev, "no platform data supplied\n");
++ return -ENODEV;
++ }
++
++ r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "wdt-reg");
++ if (!r) {
++ dev_err(&pdev->dev, "failed to get wdt-reg resource\n");
++ return -ENODEV;
++ }
++
++ rdc321x_wdt_device.sb_pdev = pdata->sb_pdev;
++ rdc321x_wdt_device.base_reg = r->start;
+
+ err = misc_register(&rdc321x_wdt_misc);
+ if (err < 0) {
+- printk(KERN_ERR PFX "watchdog misc_register failed\n");
++ dev_err(&pdev->dev, "misc_register failed\n");
+ return err;
+ }
+
+ spin_lock_init(&rdc321x_wdt_device.lock);
+
+ /* Reset the watchdog */
+- outl(RDC_WDT_RST, RDC3210_CFGREG_DATA);
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, RDC_WDT_RST);
+
+ init_completion(&rdc321x_wdt_device.stop);
+ rdc321x_wdt_device.queue = 0;
+@@ -240,7 +267,7 @@
+
+ rdc321x_wdt_device.default_ticks = ticks;
+
+- printk(KERN_INFO PFX "watchdog init success\n");
++ dev_info(&pdev->dev, "watchdog init success\n");
+
+ return 0;
+ }
--- /dev/null
+This file is replaced by a cleaner version with the adding of a MFD driver for
+the southbridge.
+
+Signed-off-by: Florian Fainelli <florian@openwrt.org>
+---
+diff --git a/arch/x86/include/asm/rdc321x_defs.h b/arch/x86/include/asm/rdc321x_defs.h
+deleted file mode 100644
+index c8e9c8b..0000000
+--- a/arch/x86/include/asm/rdc321x_defs.h
++++ /dev/null
+@@ -1,12 +0,0 @@
+-#define PFX "rdc321x: "
+-
+-/* General purpose configuration and data registers */
+-#define RDC3210_CFGREG_ADDR 0x0CF8
+-#define RDC3210_CFGREG_DATA 0x0CFC
+-
+-#define RDC321X_GPIO_CTRL_REG1 0x48
+-#define RDC321X_GPIO_CTRL_REG2 0x84
+-#define RDC321X_GPIO_DATA_REG1 0x4c
+-#define RDC321X_GPIO_DATA_REG2 0x88
+-
+-#define RDC321X_MAX_GPIO 58
+
+
+
+++ /dev/null
---- a/drivers/pcmcia/yenta_socket.c
-+++ b/drivers/pcmcia/yenta_socket.c
-@@ -1174,6 +1174,17 @@ static int __devinit yenta_probe (struct
-
- /* We must finish initialization here */
-
-+#ifdef CONFIG_X86_RDC321X
-+/* #define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0044f044 */
-+#define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0844b060
-+/* #define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0044d044 */
-+
-+ config_writel(socket, 32*4, YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK);
-+ config_writel(socket, 35*4, 0x00000022);
-+ config_writel(socket, 36*4, 0x60200000);
-+ config_writel(socket, 40*4, 0x7e020000);
-+#endif
-+
- if (!socket->cb_irq || request_irq(socket->cb_irq, yenta_interrupt, IRQF_SHARED, "yenta", socket)) {
- /* No IRQ or request_irq failed. Poll */
- socket->cb_irq = 0; /* But zero is a valid IRQ number. */
--- /dev/null
+--- a/drivers/pcmcia/yenta_socket.c
++++ b/drivers/pcmcia/yenta_socket.c
+@@ -1174,6 +1174,17 @@ static int __devinit yenta_probe (struct
+
+ /* We must finish initialization here */
+
++#ifdef CONFIG_X86_RDC321X
++/* #define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0044f044 */
++#define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0844b060
++/* #define YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK 0x0044d044 */
++
++ config_writel(socket, 32*4, YO_TI1510_DATASHEET_GUY_EXPLAIN_THIS_JUNK);
++ config_writel(socket, 35*4, 0x00000022);
++ config_writel(socket, 36*4, 0x60200000);
++ config_writel(socket, 40*4, 0x7e020000);
++#endif
++
+ if (!socket->cb_irq || request_irq(socket->cb_irq, yenta_interrupt, IRQF_SHARED, "yenta", socket)) {
+ /* No IRQ or request_irq failed. Poll */
+ socket->cb_irq = 0; /* But zero is a valid IRQ number. */
--- /dev/null
+Index: linux-2.6.30.10/drivers/mtd/mtdblock.c
+===================================================================
+--- linux-2.6.30.10.orig/drivers/mtd/mtdblock.c 2010-03-19 00:17:37.000000000 +0100
++++ linux-2.6.30.10/drivers/mtd/mtdblock.c 2010-03-19 00:17:54.000000000 +0100
+@@ -45,7 +45,7 @@
+ wake_up(wait_q);
+ }
+
+-static int erase_write (struct mtd_info *mtd, unsigned long pos,
++int erase_write (struct mtd_info *mtd, unsigned long pos,
+ int len, const char *buf)
+ {
+ struct erase_info erase;
+Index: linux-2.6.30.10/include/linux/mtd/mtd.h
+===================================================================
+--- linux-2.6.30.10.orig/include/linux/mtd/mtd.h 2010-03-19 00:17:42.000000000 +0100
++++ linux-2.6.30.10/include/linux/mtd/mtd.h 2010-03-19 00:21:22.000000000 +0100
+@@ -319,6 +319,10 @@
+ int default_mtd_readv(struct mtd_info *mtd, struct kvec *vecs,
+ unsigned long count, loff_t from, size_t *retlen);
+
++int erase_write (struct mtd_info *mtd, unsigned long pos,
++ int len, const char *buf);
++
++
+ #ifdef CONFIG_MTD_PARTITIONS
+ void mtd_erase_callback(struct erase_info *instr);
+ #else
--- /dev/null
+--- a/arch/x86/Makefile
++++ b/arch/x86/Makefile
+@@ -125,6 +125,9 @@ libs-y += arch/x86/lib/
+ # See arch/x86/Kbuild for content of core part of the kernel
+ core-y += arch/x86/
+
++# RDC R-321X support
++core-$(CONFIG_X86_RDC321X) += arch/x86/mach-rdc321x/
++
+ # drivers-y are linked after core-y
+ drivers-$(CONFIG_MATH_EMULATION) += arch/x86/math-emu/
+ drivers-$(CONFIG_PCI) += arch/x86/pci/
--- /dev/null
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/Makefile
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/Makefile 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,5 @@
++#
++# Makefile for the RDC321x specific parts of the kernel
++#
++obj-$(CONFIG_X86_RDC321X) := platform.o reboot.o boards/sitecom.o boards/ar525w.o boards/bifferboard.o boards/r8610.o
++
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/platform.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/platform.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,115 @@
++/*
++ * Generic RDC321x platform devices
++ *
++ * Copyright (C) 2007-2009 OpenWrt.org
++ * Copyright (C) 2007 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2008-2009 Daniel Gimpelevich <daniel@gimpelevich.san-francisco.ca.us>
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/mtd/map.h>
++#include <linux/mtd/mtd.h>
++#include <linux/mtd/physmap.h>
++#include <linux/root_dev.h>
++
++#include <asm/rdc_boards.h>
++
++static struct rdc_platform_data rdcplat_data;
++
++/* LEDS */
++static struct platform_device rdc321x_leds = {
++ .name = "leds-gpio",
++ .id = -1,
++ .dev = {
++ .platform_data = &rdcplat_data.led_data,
++ }
++};
++
++/* Button */
++static struct platform_device rdc321x_buttons = {
++ .name = "gpio-buttons",
++ .id = -1,
++ .dev = {
++ .platform_data = &rdcplat_data.button_data,
++ }
++};
++
++static __initdata struct platform_device *rdc321x_devs[] = {
++ &rdc321x_leds,
++ &rdc321x_buttons,
++};
++
++const char *__initdata boards[] = {
++ "Sitecom",
++ "AR525W",
++ "Bifferboard",
++ "R8610",
++ 0
++};
++
++static struct map_info rdc_map_info = {
++ .name = "rdc_flash",
++ .size = 0x800000, /* 8MB */
++ .phys = 0xFF800000, /* (u32) -rdc_map_info.size */
++ .bankwidth = 2,
++};
++
++static int __init rdc_board_setup(void)
++{
++ struct mtd_partition *partitions;
++ int count, res;
++ struct mtd_info *mtdinfo;
++
++ simple_map_init(&rdc_map_info);
++
++ while (1) {
++ rdc_map_info.virt = ioremap(rdc_map_info.phys,
++ rdc_map_info.size);
++ if (rdc_map_info.virt == NULL)
++ continue;
++
++ mtdinfo = do_map_probe("cfi_probe", &rdc_map_info);
++ if (mtdinfo == NULL)
++ mtdinfo = do_map_probe("jedec_probe", &rdc_map_info);
++ if (mtdinfo != NULL)
++ break;
++
++ iounmap(rdc_map_info.virt);
++ if ((rdc_map_info.size >>= 1) < 0x100000) /* 1MB */
++ panic("RDC321x: Could not find start of flash!");
++ rdc_map_info.phys = (u32) -rdc_map_info.size;
++ }
++
++ count = parse_mtd_partitions(mtdinfo, boards, &partitions,
++ (unsigned long) &rdcplat_data);
++
++ if (count <= 0) {
++ panic("RDC321x: can't identify board type");
++ return -ENOSYS;
++ }
++
++ ROOT_DEV = 0;
++ res = add_mtd_partitions(mtdinfo, partitions, count);
++ if (res)
++ return res;
++
++ return platform_add_devices(rdc321x_devs, ARRAY_SIZE(rdc321x_devs));
++}
++late_initcall(rdc_board_setup);
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/boards/ar525w.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/boards/ar525w.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,243 @@
++/*
++ * ar525w RDC321x platform devices
++ *
++ * Copyright (C) 2007-2009 OpenWrt.org
++ * Copyright (C) 2007 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2008-2009 Daniel Gimpelevich <daniel@gimpelevich.san-francisco.ca.us>
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <linux/init.h>
++#include <linux/mtd/physmap.h>
++#include <linux/input.h>
++#include <linux/vmalloc.h>
++#include <linux/mtd/mtd.h>
++
++#include <asm/rdc_boards.h>
++
++struct image_header {
++ char magic[4]; /* ASICII: GMTK */
++ u32 checksum; /* CRC32 */
++ u32 version; /* x.x.x.x */
++ u32 kernelsz; /* The size of the kernel image */
++ u32 imagesz; /* The length of this image file ( kernel + romfs + this header) */
++ u32 pid; /* Product ID */
++ u32 fastcksum; /* Partial CRC32 on (First(256), medium(256), last(512)) */
++ u32 reserved;
++};
++
++static struct gpio_led ar525w_leds[] = {
++ { .name = "rdc321x:dmz", .gpio = 1, .active_low = 1},
++};
++static struct gpio_button ar525w_btns[] = {
++ {
++ .gpio = 6,
++ .code = BTN_0,
++ .desc = "Reset",
++ .active_low = 1,
++ }
++};
++
++static u32 __initdata crctab[257] = {
++ 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba,
++ 0x076dc419, 0x706af48f, 0xe963a535, 0x9e6495a3,
++ 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
++ 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91,
++ 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de,
++ 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
++ 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec,
++ 0x14015c4f, 0x63066cd9, 0xfa0f3d63, 0x8d080df5,
++ 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
++ 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b,
++ 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940,
++ 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
++ 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116,
++ 0x21b4f4b5, 0x56b3c423, 0xcfba9599, 0xb8bda50f,
++ 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
++ 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d,
++ 0x76dc4190, 0x01db7106, 0x98d220bc, 0xefd5102a,
++ 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
++ 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818,
++ 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01,
++ 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
++ 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457,
++ 0x65b0d9c6, 0x12b7e950, 0x8bbeb8ea, 0xfcb9887c,
++ 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
++ 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2,
++ 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb,
++ 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
++ 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9,
++ 0x5005713c, 0x270241aa, 0xbe0b1010, 0xc90c2086,
++ 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
++ 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4,
++ 0x59b33d17, 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad,
++ 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
++ 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683,
++ 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8,
++ 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
++ 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe,
++ 0xf762575d, 0x806567cb, 0x196c3671, 0x6e6b06e7,
++ 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
++ 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5,
++ 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252,
++ 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
++ 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60,
++ 0xdf60efc3, 0xa867df55, 0x316e8eef, 0x4669be79,
++ 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
++ 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f,
++ 0xc5ba3bbe, 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04,
++ 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
++ 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a,
++ 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713,
++ 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
++ 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21,
++ 0x86d3d2d4, 0xf1d4e242, 0x68ddb3f8, 0x1fda836e,
++ 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
++ 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c,
++ 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45,
++ 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
++ 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db,
++ 0xaed16a4a, 0xd9d65adc, 0x40df0b66, 0x37d83bf0,
++ 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
++ 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6,
++ 0xbad03605, 0xcdd70693, 0x54de5729, 0x23d967bf,
++ 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
++ 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d,
++ 0
++};
++
++static u32 __init crc32(u8 * buf, u32 len)
++{
++ register int i;
++ u32 sum;
++ register u32 s0;
++ s0 = ~0;
++ for (i = 0; i < len; i++) {
++ s0 = (s0 >> 8) ^ crctab[(u8) (s0 & 0xFF) ^ buf[i]];
++ }
++ sum = ~s0;
++ return sum;
++}
++
++static int __init fixup_ar525w_header(struct mtd_info *master, struct image_header *header)
++{
++ char *buffer;
++ int res;
++ u32 bufferlength = header->kernelsz + sizeof(struct image_header);
++ u32 len;
++ char crcbuf[0x400];
++
++ printk(KERN_INFO "Fixing up AR525W header, old image size: %u, new image size: %u\n",
++ header->imagesz, bufferlength);
++
++ buffer = vmalloc(bufferlength);
++ if (!buffer) {
++ printk(KERN_ERR "Can't allocate %u bytes\n", bufferlength);
++ return -ENOMEM;
++ }
++
++ res = master->read(master, 0x0, bufferlength, &len, buffer);
++ if (res || len != bufferlength)
++ goto out;
++
++ header = (struct image_header *) buffer;
++ header->imagesz = bufferlength;
++ header->checksum = 0;
++ header->fastcksum = 0;
++
++ memcpy(crcbuf, buffer, 0x100);
++ memcpy(crcbuf + 0x100, buffer + (bufferlength >> 1) - ((bufferlength & 0x6) >> 1), 0x100);
++ memcpy(crcbuf + 0x200, buffer + bufferlength - 0x200, 0x200);
++
++ header->fastcksum = crc32(crcbuf, sizeof(crcbuf));
++ header->checksum = crc32(buffer, bufferlength);
++
++ if (master->unlock)
++ master->unlock(master, 0, master->erasesize);
++ res = erase_write (master, 0, master->erasesize, buffer);
++ if (res)
++ printk(KERN_ERR "Can't rewrite image header\n");
++
++out:
++ vfree(buffer);
++ return res;
++}
++
++static int __init parse_ar525w_partitions(struct mtd_info *master, struct mtd_partition **pparts, unsigned long plat_data)
++{
++ struct image_header header;
++ int res;
++ size_t len;
++ struct mtd_partition *rdc_flash_parts;
++ struct rdc_platform_data *pdata = (struct rdc_platform_data *) plat_data;
++
++ if (master->size != 0x400000) //4MB
++ return -ENOSYS;
++
++ res = master->read(master, 0x0, sizeof(header), &len, (char *)&header);
++ if (res)
++ return res;
++
++ if (strncmp(header.magic, "GMTK", 4))
++ return -ENOSYS;
++
++ if (header.kernelsz > 0x400000 || header.kernelsz < master->erasesize) {
++ printk(KERN_ERR "AR525W image header found, but seems corrupt, kernel size %u\n", header.kernelsz);
++ return -EINVAL;
++ }
++
++ if (header.kernelsz + sizeof(header) != header.imagesz) {
++ res = fixup_ar525w_header(master, &header);
++ if (res)
++ return res;
++ }
++
++ rdc_flash_parts = kzalloc(sizeof(struct mtd_partition) * 3, GFP_KERNEL);
++
++ rdc_flash_parts[0].name = "firmware";
++ rdc_flash_parts[0].offset = 0x0;
++ rdc_flash_parts[0].size = 0x3E0000;
++ rdc_flash_parts[1].name = "rootfs";
++ rdc_flash_parts[1].offset = header.kernelsz + sizeof(header);
++ rdc_flash_parts[1].size = rdc_flash_parts[0].size - rdc_flash_parts[1].offset;
++ rdc_flash_parts[2].name = "bootloader";
++ rdc_flash_parts[2].offset = 0x3E0000;
++ rdc_flash_parts[2].size = 0x20000;
++
++ *pparts = rdc_flash_parts;
++
++ pdata->led_data.num_leds = ARRAY_SIZE(ar525w_leds);
++ pdata->led_data.leds = ar525w_leds;
++ pdata->button_data.nbuttons = ARRAY_SIZE(ar525w_btns);
++ pdata->button_data.buttons = ar525w_btns;
++
++ return 3;
++}
++
++static struct mtd_part_parser __initdata ar525w_parser = {
++ .owner = THIS_MODULE,
++ .parse_fn = parse_ar525w_partitions,
++ .name = "AR525W",
++};
++
++static int __init ar525w_setup(void)
++{
++ return register_mtd_parser(&ar525w_parser);
++}
++
++arch_initcall(ar525w_setup);
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/boards/bifferboard.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/boards/bifferboard.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,81 @@
++/*
++ * Bifferboard RDC321x platform devices
++ *
++ * Copyright (C) 2010 bifferos@yahoo.co.uk
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <linux/init.h>
++#include <linux/mtd/physmap.h>
++#include <linux/input.h>
++
++#include <asm/rdc_boards.h>
++
++static int __init parse_bifferboard_partitions(struct mtd_info *master, struct mtd_partition **pparts, unsigned long plat_data)
++{
++ int res;
++ size_t len;
++ struct mtd_partition *rdc_flash_parts;
++ u32 kernel_len;
++ u16 tmp;
++
++ if (master->size == 0x100000)
++ kernel_len = master->size - 0x10000;
++ else {
++ res = master->read(master, 0x4000 + 1036, 2, &len, (char *) &tmp);
++ if (res)
++ return res;
++ kernel_len = tmp * master->erasesize;
++ }
++
++ rdc_flash_parts = kzalloc(sizeof(struct mtd_partition) * 4, GFP_KERNEL);
++
++ *pparts = rdc_flash_parts;
++
++ rdc_flash_parts[0].name = "biffboot";
++ rdc_flash_parts[0].offset = master->size - 0x10000;
++ rdc_flash_parts[0].size = 0x10000;
++ rdc_flash_parts[0].mask_flags = MTD_WRITEABLE;
++ rdc_flash_parts[1].name = "firmware";
++ rdc_flash_parts[1].offset = 0;
++ rdc_flash_parts[1].size = rdc_flash_parts[0].offset;
++ rdc_flash_parts[2].name = "kernel";
++ rdc_flash_parts[2].offset = 0x00000000;
++ rdc_flash_parts[2].size = kernel_len;
++
++ if (master->size == 0x100000)
++ return 2;
++
++ rdc_flash_parts[3].name = "rootfs";
++ rdc_flash_parts[3].offset = MTDPART_OFS_APPEND;
++ rdc_flash_parts[3].size = rdc_flash_parts[1].size - rdc_flash_parts[2].size;
++
++ return 4;
++}
++
++struct mtd_part_parser __initdata bifferboard_parser = {
++ .owner = THIS_MODULE,
++ .parse_fn = parse_bifferboard_partitions,
++ .name = "Bifferboard",
++};
++
++static int __init bifferboard_setup(void)
++{
++ return register_mtd_parser(&bifferboard_parser);
++}
++arch_initcall(bifferboard_setup);
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/boards/r8610.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/boards/r8610.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,65 @@
++/*
++ * R8610 RDC321x platform devices
++ *
++ * Copyright (C) 2009, Florian Fainelli <florian@openwrt.org>
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <linux/init.h>
++#include <linux/mtd/physmap.h>
++#include <linux/input.h>
++
++#include <asm/rdc_boards.h>
++
++static int __init parse_r8610_partitions(struct mtd_info *master, struct mtd_partition **pparts, unsigned long plat_data)
++{
++ struct mtd_partition *rdc_flash_parts;
++
++ rdc_flash_parts = kzalloc(sizeof(struct mtd_partition) * 4, GFP_KERNEL);
++
++ *pparts = rdc_flash_parts;
++
++ rdc_flash_parts[0].name = "kernel";
++ rdc_flash_parts[0].size = 0x001f0000;
++ rdc_flash_parts[0].offset = 0;
++ rdc_flash_parts[1].name = "config";
++ rdc_flash_parts[1].size = 0x10000;
++ rdc_flash_parts[1].offset = MTDPART_OFS_APPEND;
++ rdc_flash_parts[2].name = "rootfs";
++ rdc_flash_parts[2].size = 0x1E0000;
++ rdc_flash_parts[2].offset = MTDPART_OFS_APPEND;
++ rdc_flash_parts[3].name = "redboot";
++ rdc_flash_parts[3].size = 0x20000;
++ rdc_flash_parts[3].offset = MTDPART_OFS_APPEND;
++ rdc_flash_parts[3].mask_flags = MTD_WRITEABLE;
++
++ return 4;
++}
++
++struct mtd_part_parser __initdata r8610_parser = {
++ .owner = THIS_MODULE,
++ .parse_fn = parse_r8610_partitions,
++ .name = "R8610",
++};
++
++static int __init r8610_setup(void)
++{
++ return register_mtd_parser(&r8610_parser);
++}
++
++arch_initcall(r8610_setup);
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/boards/sitecom.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/boards/sitecom.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,111 @@
++/*
++ * Sitecom RDC321x platform devices
++ *
++ * Copyright (C) 2007-2009 OpenWrt.org
++ * Copyright (C) 2007 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2008-2009 Daniel Gimpelevich <daniel@gimpelevich.san-francisco.ca.us>
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <linux/init.h>
++#include <linux/mtd/physmap.h>
++#include <linux/input.h>
++
++#include <asm/rdc_boards.h>
++
++struct image_header {
++ char magic[4];
++ u32 kernel_length;
++ u32 ramdisk_length;
++ char magic2[4];
++ u32 kernel_length2;
++};
++
++static struct gpio_led sitecom_leds[] = {
++ { .name = "rdc321x:power", .gpio = 15, .active_low = 1},
++ { .name = "rdc321x:usb0", .gpio = 0, .active_low = 1},
++ { .name = "rdc321x:usb1", .gpio = 1, .active_low = 1},
++};
++
++static struct gpio_button sitecom_btns[] = {
++ {
++ .gpio = 6,
++ .code = BTN_0,
++ .desc = "Reset",
++ .active_low = 1,
++ }
++};
++
++static int __init parse_sitecom_partitions(struct mtd_info *master, struct mtd_partition **pparts, unsigned long plat_data)
++{
++ struct image_header header;
++ int res;
++ size_t len;
++ struct mtd_partition *rdc_flash_parts;
++ struct rdc_platform_data *pdata = (struct rdc_platform_data *) plat_data;
++
++ if (master->size != 0x400000) /* 4MB */
++ return -ENOSYS;
++
++ res = master->read(master, 0x8000, sizeof(header), &len, (char *)&header);
++ if (res)
++ return res;
++
++ if (strncmp(header.magic, "CSYS", 4) || strncmp(header.magic2, "WRRM", 4))
++ return -ENOSYS;
++
++ rdc_flash_parts = kzalloc(sizeof(struct mtd_partition) * 5, GFP_KERNEL);
++
++ rdc_flash_parts[0].name = "firmware";
++ rdc_flash_parts[0].offset = 0x8000;
++ rdc_flash_parts[0].size = 0x3F0000;
++ rdc_flash_parts[1].name = "config";
++ rdc_flash_parts[1].offset = 0;
++ rdc_flash_parts[1].size = 0x8000;
++ rdc_flash_parts[2].name = "kernel";
++ rdc_flash_parts[2].offset = 0x8014;
++ rdc_flash_parts[2].size = header.kernel_length;
++ rdc_flash_parts[3].name = "rootfs";
++ rdc_flash_parts[3].offset = 0x8014 + header.kernel_length;
++ rdc_flash_parts[3].size = 0x3F0000 - rdc_flash_parts[3].offset;
++ rdc_flash_parts[4].name = "bootloader";
++ rdc_flash_parts[4].offset = 0x3F0000;
++ rdc_flash_parts[4].size = 0x10000;
++
++ *pparts = rdc_flash_parts;
++
++ pdata->led_data.num_leds = ARRAY_SIZE(sitecom_leds);
++ pdata->led_data.leds = sitecom_leds;
++ pdata->button_data.nbuttons = ARRAY_SIZE(sitecom_btns);
++ pdata->button_data.buttons = sitecom_btns;
++
++ return 5;
++}
++
++struct mtd_part_parser __initdata sitecom_parser = {
++ .owner = THIS_MODULE,
++ .parse_fn = parse_sitecom_partitions,
++ .name = "Sitecom",
++};
++
++static int __init sitecom_setup(void)
++{
++ return register_mtd_parser(&sitecom_parser);
++}
++
++arch_initcall(sitecom_setup);
+Index: linux-2.6.32.10/arch/x86/mach-rdc321x/reboot.c
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/mach-rdc321x/reboot.c 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,44 @@
++/*
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#include <asm/reboot.h>
++#include <asm/io.h>
++
++static void rdc321x_reset(void)
++{
++ unsigned i;
++
++ /* write to southbridge config register 0x41
++ enable pci reset on cpu reset, make internal port 0x92 writeable
++ and switch port 0x92 to internal */
++ outl(0x80003840, 0xCF8);
++ i = inl(0xCFC);
++ i |= 0x1600;
++ outl(i, 0xCFC);
++
++ /* soft reset */
++ outb(1, 0x92);
++}
++
++static int __init rdc_setup_reset(void)
++{
++ machine_ops.emergency_restart = rdc321x_reset;
++ return 0;
++}
++
++arch_initcall(rdc_setup_reset);
+Index: linux-2.6.32.10/arch/x86/include/asm/rdc_boards.h
+===================================================================
+--- /dev/null 1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.32.10/arch/x86/include/asm/rdc_boards.h 2010-04-28 11:39:32.000000000 +0200
+@@ -0,0 +1,36 @@
++/*
++ * RDC321x boards
++ *
++ * Copyright (C) 2007-2009 OpenWrt.org
++ * Copyright (C) 2007 Florian Fainelli <florian@openwrt.org>
++ * Copyright (C) 2008-2009 Daniel Gimpelevich <daniel@gimpelevich.san-francisco.ca.us>
++ *
++ * 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 Street, Fifth Floor,
++ * Boston, MA 02110-1301, USA.
++ *
++ */
++
++#ifndef _RDC_BOARDS_H__
++#define _RDC_BOARDS_H__
++
++#include <linux/leds.h>
++#include <linux/gpio_buttons.h>
++
++struct rdc_platform_data {
++ struct gpio_led_platform_data led_data;
++ struct gpio_buttons_platform_data button_data;
++};
++
++#endif
--- /dev/null
+Index: linux-2.6.32.10/drivers/watchdog/rdc321x_wdt.c
+===================================================================
+--- linux-2.6.32.10.orig/drivers/watchdog/rdc321x_wdt.c 2010-04-28 11:39:28.000000000 +0200
++++ linux-2.6.32.10/drivers/watchdog/rdc321x_wdt.c 2010-04-28 11:40:11.000000000 +0200
+@@ -36,111 +36,99 @@
+ #include <linux/watchdog.h>
+ #include <linux/io.h>
+ #include <linux/uaccess.h>
++#include <linux/pci.h>
++#include <linux/delay.h>
+ #include <linux/mfd/rdc321x.h>
+
+-#define RDC_WDT_MASK 0x80000000 /* Mask */
++#define RDC321X_WDT_REG 0x00000044
++
+ #define RDC_WDT_EN 0x00800000 /* Enable bit */
+-#define RDC_WDT_WTI 0x00200000 /* Generate CPU reset/NMI/WDT on timeout */
+-#define RDC_WDT_RST 0x00100000 /* Reset bit */
+-#define RDC_WDT_WIF 0x00040000 /* WDT IRQ Flag */
+-#define RDC_WDT_IRT 0x00000100 /* IRQ Routing table */
+-#define RDC_WDT_CNT 0x00000001 /* WDT count */
++#define RDC_WDT_WDTIRQ 0x00400000 /* Create WDT IRQ before CPU reset */
++#define RDC_WDT_NMIIRQ 0x00200000 /* Create NMI IRQ before CPU reset */
++#define RDC_WDT_RST 0x00100000 /* Reset wdt */
++#define RDC_WDT_NIF 0x00080000 /* NMI interrupt occured */
++#define RDC_WDT_WIF 0x00040000 /* WDT interrupt occured */
++#define RDC_WDT_IRT 0x00000700 /* IRQ Routing table */
++#define RDC_WDT_CNT 0x0000007F /* WDT count */
+
+-#define RDC_CLS_TMR 0x80003844 /* Clear timer */
++/* default counter value (2.34 s) */
++#define RDC_WDT_DFLT_CNT 0x00000040
+
+-#define RDC_WDT_INTERVAL (HZ/10+1)
++#define RDC_WDT_SETUP (RDC_WDT_EN | RDC_WDT_NMIIRQ | RDC_WDT_RST | RDC_WDT_DFLT_CNT)
+
+ static int ticks = 1000;
+
+ /* some device data */
+
+ static struct {
+- struct completion stop;
+- int running;
+ struct timer_list timer;
+- int queue;
+- int default_ticks;
+- unsigned long inuse;
+- spinlock_t lock;
++ int seconds_left;
++ int total_seconds;
++ bool inuse;
++ bool running;
++ bool close_expected;
++
+ struct pci_dev *sb_pdev;
+ int base_reg;
+ } rdc321x_wdt_device;
+
+-/* generic helper functions */
++static struct watchdog_info ident = {
++ .options = WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE,
++ .identity = "RDC321x WDT",
++};
++
+
+-static void rdc321x_wdt_trigger(unsigned long unused)
++/* generic helper functions */
++static void rdc321x_wdt_timer(unsigned long unused)
+ {
+- unsigned long flags;
+- u32 val;
++ if (!rdc321x_wdt_device.running) {
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, 0);
++ return;
++ }
+
+- if (rdc321x_wdt_device.running)
+- ticks--;
++ rdc321x_wdt_device.seconds_left--;
+
+- /* keep watchdog alive */
+- spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- pci_read_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg, &val);
+- val |= RDC_WDT_EN;
+- pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg, val);
+- spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
++ if (rdc321x_wdt_device.seconds_left < 1)
++ return;
+
+- /* requeue?? */
+- if (rdc321x_wdt_device.queue && ticks)
+- mod_timer(&rdc321x_wdt_device.timer,
+- jiffies + RDC_WDT_INTERVAL);
+- else {
+- /* ticks doesn't matter anyway */
+- complete(&rdc321x_wdt_device.stop);
+- }
++ pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
++ rdc321x_wdt_device.base_reg, RDC_WDT_SETUP);
+
++ mod_timer(&rdc321x_wdt_device.timer, HZ * 2 + jiffies);
+ }
+
+ static void rdc321x_wdt_reset(void)
+ {
+- ticks = rdc321x_wdt_device.default_ticks;
++ rdc321x_wdt_device.seconds_left = rdc321x_wdt_device.total_seconds;
+ }
+
+ static void rdc321x_wdt_start(void)
+ {
+- unsigned long flags;
+-
+- if (!rdc321x_wdt_device.queue) {
+- rdc321x_wdt_device.queue = 1;
+-
+- /* Clear the timer */
+- spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg, RDC_CLS_TMR);
+-
+- /* Enable watchdog and set the timeout to 81.92 us */
+- pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg,
+- RDC_WDT_EN | RDC_WDT_CNT);
+- spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
++ if (rdc321x_wdt_device.running)
++ return;
+
+- mod_timer(&rdc321x_wdt_device.timer,
+- jiffies + RDC_WDT_INTERVAL);
+- }
++ rdc321x_wdt_device.seconds_left = rdc321x_wdt_device.total_seconds;
++ rdc321x_wdt_device.running = true;
++ rdc321x_wdt_timer(0);
+
+- /* if process dies, counter is not decremented */
+- rdc321x_wdt_device.running++;
++ return;
+ }
+
+ static int rdc321x_wdt_stop(void)
+ {
+- if (rdc321x_wdt_device.running)
+- rdc321x_wdt_device.running = 0;
++ if (WATCHDOG_NOWAYOUT)
++ return -ENOSYS;
+
+- ticks = rdc321x_wdt_device.default_ticks;
++ rdc321x_wdt_device.running = false;
+
+- return -EIO;
++ return 0;
+ }
+
+ /* filesystem operations */
+ static int rdc321x_wdt_open(struct inode *inode, struct file *file)
+ {
+- if (test_and_set_bit(0, &rdc321x_wdt_device.inuse))
++ if (xchg(&rdc321x_wdt_device.inuse, true))
+ return -EBUSY;
+
+ return nonseekable_open(inode, file);
+@@ -148,7 +136,16 @@
+
+ static int rdc321x_wdt_release(struct inode *inode, struct file *file)
+ {
+- clear_bit(0, &rdc321x_wdt_device.inuse);
++ int ret;
++
++ if (rdc321x_wdt_device.close_expected) {
++ ret = rdc321x_wdt_stop();
++ if (ret)
++ return ret;
++ }
++
++ rdc321x_wdt_device.inuse = false;
++
+ return 0;
+ }
+
+@@ -156,30 +153,29 @@
+ unsigned long arg)
+ {
+ void __user *argp = (void __user *)arg;
+- u32 value;
+- static struct watchdog_info ident = {
+- .options = WDIOF_CARDRESET,
+- .identity = "RDC321x WDT",
+- };
+- unsigned long flags;
++ int value;
+
+ switch (cmd) {
+ case WDIOC_KEEPALIVE:
+ rdc321x_wdt_reset();
+ break;
+- case WDIOC_GETSTATUS:
+- /* Read the value from the DATA register */
+- spin_lock_irqsave(&rdc321x_wdt_device.lock, flags);
+- pci_read_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg, &value);
+- spin_unlock_irqrestore(&rdc321x_wdt_device.lock, flags);
+- if (copy_to_user(argp, &value, sizeof(u32)))
+- return -EFAULT;
+- break;
+ case WDIOC_GETSUPPORT:
+ if (copy_to_user(argp, &ident, sizeof(ident)))
+ return -EFAULT;
+ break;
++ case WDIOC_SETTIMEOUT:
++ if (copy_from_user(&rdc321x_wdt_device.total_seconds, argp, sizeof(int)))
++ return -EFAULT;
++ rdc321x_wdt_device.seconds_left = rdc321x_wdt_device.total_seconds;
++ break;
++ case WDIOC_GETTIMEOUT:
++ if (copy_to_user(argp, &rdc321x_wdt_device.total_seconds, sizeof(int)))
++ return -EFAULT;
++ break;
++ case WDIOC_GETTIMELEFT:
++ if (copy_to_user(argp, &rdc321x_wdt_device.seconds_left, sizeof(int)))
++ return -EFAULT;
++ break;
+ case WDIOC_SETOPTIONS:
+ if (copy_from_user(&value, argp, sizeof(int)))
+ return -EFAULT;
+@@ -194,17 +190,34 @@
+ }
+ break;
+ default:
+- return -ENOTTY;
++ return -EINVAL;
+ }
++
+ return 0;
+ }
+
+ static ssize_t rdc321x_wdt_write(struct file *file, const char __user *buf,
+ size_t count, loff_t *ppos)
+ {
++ size_t i;
++
+ if (!count)
+ return -EIO;
+
++ rdc321x_wdt_device.close_expected = false;
++
++ for (i = 0; i != count; i++) {
++ char c;
++
++ if (get_user(c, buf + i))
++ return -EFAULT;
++
++ if (c == 'V') {
++ rdc321x_wdt_device.close_expected = true;
++ break;
++ }
++ }
++
+ rdc321x_wdt_reset();
+
+ return count;
+@@ -246,27 +259,18 @@
+ rdc321x_wdt_device.sb_pdev = pdata->sb_pdev;
+ rdc321x_wdt_device.base_reg = r->start;
+
++ rdc321x_wdt_device.running = false;
++ rdc321x_wdt_device.close_expected = false;
++ rdc321x_wdt_device.inuse = 0;
++ setup_timer(&rdc321x_wdt_device.timer, rdc321x_wdt_timer, 0);
++ rdc321x_wdt_device.total_seconds = 100;
++
+ err = misc_register(&rdc321x_wdt_misc);
+ if (err < 0) {
+ dev_err(&pdev->dev, "misc_register failed\n");
+ return err;
+ }
+
+- spin_lock_init(&rdc321x_wdt_device.lock);
+-
+- /* Reset the watchdog */
+- pci_write_config_dword(rdc321x_wdt_device.sb_pdev,
+- rdc321x_wdt_device.base_reg, RDC_WDT_RST);
+-
+- init_completion(&rdc321x_wdt_device.stop);
+- rdc321x_wdt_device.queue = 0;
+-
+- clear_bit(0, &rdc321x_wdt_device.inuse);
+-
+- setup_timer(&rdc321x_wdt_device.timer, rdc321x_wdt_trigger, 0);
+-
+- rdc321x_wdt_device.default_ticks = ticks;
+-
+ dev_info(&pdev->dev, "watchdog init success\n");
+
+ return 0;
+@@ -274,10 +278,11 @@
+
+ static int __devexit rdc321x_wdt_remove(struct platform_device *pdev)
+ {
+- if (rdc321x_wdt_device.queue) {
+- rdc321x_wdt_device.queue = 0;
+- wait_for_completion(&rdc321x_wdt_device.stop);
+- }
++ if (rdc321x_wdt_device.inuse)
++ rdc321x_wdt_device.inuse = 0;
++
++ while (timer_pending(&rdc321x_wdt_device.timer))
++ msleep(100);
+
+ misc_deregister(&rdc321x_wdt_misc);
+
projects / openwrt / staging / kaloz.git / commitdiff