ixp4xx-kernel: Updated for 2.6.16-rc4 from CVS patch repo

15 files changed, 22864 insertions, 779 deletions

diff --git a/packages/linux/ixp4xx-kernel/2.6.16/06-remove-extraversion.patch b/packages/linux/ixp4xx-kernel/2.6.16/06-remove-extraversion.patch
index 65aba13703..8f2ce831b2 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/06-remove-extraversion.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/06-remove-extraversion.patch
@@ -4,7 +4,7 @@
  VERSION = 2
  PATCHLEVEL = 6
  SUBLEVEL = 16
--EXTRAVERSION =-rc2
+-EXTRAVERSION =-rc4
 +EXTRAVERSION =
  NAME=Sliding Snow Leopard
  
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/40-rtc-class.patch b/packages/linux/ixp4xx-kernel/2.6.16/40-rtc-class.patch
index 38359a1bc0..3cc84b2a9b 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/40-rtc-class.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/40-rtc-class.patch
@@ -1,6 +1,6 @@
---- linux-nslu2.orig/include/linux/rtc.h	2006-02-06 20:37:43.000000000 +0100
-+++ linux-nslu2/include/linux/rtc.h	2006-02-06 21:41:39.000000000 +0100
-@@ -93,8 +93,91 @@ struct rtc_pll_info {
+--- linux-rtc.orig/include/linux/rtc.h	2006-02-19 23:33:10.000000000 +0100
++++ linux-rtc/include/linux/rtc.h	2006-02-19 23:33:15.000000000 +0100
+@@ -93,8 +93,97 @@ struct rtc_pll_info {
  #define RTC_PLL_GET	_IOR('p', 0x11, struct rtc_pll_info)  /* Get PLL correction */
  #define RTC_PLL_SET	_IOW('p', 0x12, struct rtc_pll_info)  /* Set PLL correction */
  
@@ -16,6 +16,7 @@
 +#include <linux/seq_file.h>
 +#include <linux/cdev.h>
 +#include <linux/poll.h>
++#include <linux/mutex.h>
 +
 +struct rtc_class_ops {
 +	int (*open)(struct device *);
@@ -29,6 +30,7 @@
 +	int (*set_mmss)(struct device *, unsigned long secs);
 +	int (*irq_set_state)(struct device *, int enabled);
 +	int (*irq_set_freq)(struct device *, int freq);
++	int (*read_callback)(struct device *, int data);
 +};
 +
 +#define RTC_DEVICE_NAME_SIZE 20
@@ -36,23 +38,25 @@
 +
 +struct rtc_device
 +{
-+	int id;
-+	struct module *owner;
 +	struct class_device class_dev;
-+	struct semaphore ops_lock;
-+	struct rtc_class_ops *ops;
++	struct module *owner;
++
++	int id;
 +	char name[RTC_DEVICE_NAME_SIZE];
 +
++	struct rtc_class_ops *ops;
++	struct mutex ops_lock;
++
 +	struct cdev char_dev;
-+	struct semaphore char_sem;
++	struct mutex char_lock;
 +
 +	unsigned long irq_data;
 +	spinlock_t irq_lock;
 +	wait_queue_head_t irq_queue;
 +	struct fasync_struct *async_queue;
 +
-+	spinlock_t irq_task_lock;
 +	struct rtc_task *irq_task;
++	spinlock_t irq_task_lock;
 +	int irq_freq;
 +};
 +#define to_rtc_device(d) container_of(d, struct rtc_device, class_dev)
@@ -71,15 +75,17 @@
 +
 +extern int rtc_read_time(struct class_device *class_dev, struct rtc_time *tm);
 +extern int rtc_set_time(struct class_device *class_dev, struct rtc_time *tm);
++extern int rtc_set_mmss(struct class_device *class_dev, unsigned long secs);
 +extern int rtc_read_alarm(struct class_device *class_dev,
-+				struct rtc_wkalrm *alrm);
++			struct rtc_wkalrm *alrm);
 +extern int rtc_set_alarm(struct class_device *class_dev,
 +				struct rtc_wkalrm *alrm);
 +extern void rtc_update_irq(struct class_device *class_dev,
 +			unsigned long num, unsigned long events);
 +
-+extern struct class_device *rtc_open(char *name);
-+extern void rtc_close(struct class_device *class_dev);
++extern struct class_device *rtc_class_open(char *name);
++extern void rtc_class_close(struct class_device *class_dev);
++
 +extern int rtc_irq_register(struct class_device *class_dev,
 +				struct rtc_task *task);
 +extern void rtc_irq_unregister(struct class_device *class_dev,
@@ -92,8 +98,8 @@
  typedef struct rtc_task {
  	void (*func)(void *private_data);
  	void *private_data;
---- linux-nslu2.orig/drivers/Kconfig	2006-02-06 20:37:14.000000000 +0100
-+++ linux-nslu2/drivers/Kconfig	2006-02-06 21:11:33.000000000 +0100
+--- linux-rtc.orig/drivers/Kconfig	2006-02-19 23:33:10.000000000 +0100
++++ linux-rtc/drivers/Kconfig	2006-02-19 23:33:15.000000000 +0100
 @@ -70,4 +70,6 @@ source "drivers/sn/Kconfig"
  
  source "drivers/edac/Kconfig"
@@ -101,8 +107,8 @@
 +source "drivers/rtc/Kconfig"
 +
  endmenu
---- linux-nslu2.orig/drivers/Makefile	2006-02-06 20:37:14.000000000 +0100
-+++ linux-nslu2/drivers/Makefile	2006-02-06 21:11:33.000000000 +0100
+--- linux-rtc.orig/drivers/Makefile	2006-02-19 23:33:10.000000000 +0100
++++ linux-rtc/drivers/Makefile	2006-02-19 23:33:15.000000000 +0100
 @@ -56,6 +56,7 @@ obj-$(CONFIG_USB_GADGET)	+= usb/gadget/
  obj-$(CONFIG_GAMEPORT)		+= input/gameport/
  obj-$(CONFIG_INPUT)		+= input/
@@ -112,7 +118,7 @@
  obj-$(CONFIG_W1)		+= w1/
  obj-$(CONFIG_HWMON)		+= hwmon/
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/class.c	2006-02-06 21:41:25.000000000 +0100
++++ linux-rtc/drivers/rtc/class.c	2006-02-19 23:33:15.000000000 +0100
 @@ -0,0 +1,143 @@
 +/*
 + * RTC subsystem, base class
@@ -133,15 +139,15 @@
 +#include <linux/idr.h>
 +
 +static DEFINE_IDR(rtc_idr);
-+static DECLARE_MUTEX(idr_lock);
++static DEFINE_MUTEX(idr_lock);
 +struct class *rtc_class;
 +
 +static void rtc_device_release(struct class_device *class_dev)
 +{
 +	struct rtc_device *rtc = to_rtc_device(class_dev);
-+	down(&idr_lock);
++	mutex_lock(&idr_lock);
 +	idr_remove(&rtc_idr, rtc->id);
-+	up(&idr_lock);
++	mutex_unlock(&idr_lock);
 +	kfree(rtc);
 +}
 +
@@ -167,9 +173,9 @@
 +	}
 +
 +
-+	down(&idr_lock);
++	mutex_lock(&idr_lock);
 +	err = idr_get_new(&rtc_idr, NULL, &id);
-+	up(&idr_lock);
++	mutex_unlock(&idr_lock);
 +
 +	if (err < 0)
 +		goto exit;
@@ -188,7 +194,7 @@
 +	rtc->class_dev.class = rtc_class;
 +	rtc->class_dev.release = rtc_device_release;
 +
-+	init_MUTEX(&rtc->ops_lock);
++	mutex_init(&rtc->ops_lock);
 +	spin_lock_init(&rtc->irq_lock);
 +	spin_lock_init(&rtc->irq_task_lock);
 +
@@ -222,9 +228,9 @@
 + */
 +void rtc_device_unregister(struct rtc_device *rtc)
 +{
-+	down(&rtc->ops_lock);
++	mutex_lock(&rtc->ops_lock);
 +	rtc->ops = NULL;
-+	up(&rtc->ops_lock);
++	mutex_unlock(&rtc->ops_lock);
 +	class_device_unregister(&rtc->class_dev);
 +}
 +EXPORT_SYMBOL_GPL(rtc_device_unregister);
@@ -258,8 +264,8 @@
 +MODULE_DESCRIPTION("RTC class support");
 +MODULE_LICENSE("GPL");
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/Kconfig	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,121 @@
++++ linux-rtc/drivers/rtc/Kconfig	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,131 @@
 +#
 +# RTC class/drivers configuration
 +#
@@ -365,6 +371,16 @@
 +	  This driver can also be built as a module. If so, the module
 +	  will be called rtc-pcf8563.
 +
++config RTC_DRV_RS5C372
++	tristate "Ricoh RS5C372A/B"
++	depends on RTC_CLASS && I2C
++	help
++	  If you say yes here you get support for the
++	  Ricoh RS5C372A and RS5C372B RTC chips.
++
++	  This driver can also be built as a module. If so, the module
++	  will be called rtc-rs5c372.
++
 +config RTC_DRV_TEST
 +	tristate "Test driver/device"
 +	depends on RTC_CLASS
@@ -382,8 +398,8 @@
 +
 +endmenu
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/Makefile	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,17 @@
++++ linux-rtc/drivers/rtc/Makefile	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,18 @@
 +#
 +# Makefile for RTC class/drivers.
 +#
@@ -400,10 +416,11 @@
 +obj-$(CONFIG_RTC_DRV_TEST)	+= rtc-test.o
 +obj-$(CONFIG_RTC_DRV_DS1672)	+= rtc-ds1672.o
 +obj-$(CONFIG_RTC_DRV_PCF8563)	+= rtc-pcf8563.o
++obj-$(CONFIG_RTC_DRV_RS5C372)	+= rtc-rs5c372.o
 +
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/interface.c	2006-02-07 01:32:10.000000000 +0100
-@@ -0,0 +1,232 @@
++++ linux-rtc/drivers/rtc/interface.c	2006-02-19 23:33:15.000000000 +0100
+@@ -0,0 +1,274 @@
 +/*
 + * RTC subsystem, interface functions
 + *
@@ -426,7 +443,7 @@
 +	int err;
 +	struct rtc_device *rtc = to_rtc_device(class_dev);
 +
-+	if ((err = down_interruptible(&rtc->ops_lock)))
++	if ((err = mutex_lock_interruptible(&rtc->ops_lock)))
 +		return err;
 +
 +	if (!rtc->ops)
@@ -438,7 +455,7 @@
 +		err = rtc->ops->read_time(class_dev->dev, tm);
 +	}
 +
-+	up(&rtc->ops_lock);
++	mutex_unlock(&rtc->ops_lock);
 +	return err;
 +}
 +EXPORT_SYMBOL(rtc_read_time);
@@ -451,7 +468,7 @@
 +	if ((err = rtc_valid_tm(tm)) != 0)
 +		return err;
 +
-+	if ((err = down_interruptible(&rtc->ops_lock)))
++	if ((err = mutex_lock_interruptible(&rtc->ops_lock)))
 +		return err;
 +
 +	if (!rtc->ops)
@@ -461,17 +478,59 @@
 +	else
 +		err = rtc->ops->set_time(class_dev->dev, tm);
 +
-+	up(&rtc->ops_lock);
++	mutex_unlock(&rtc->ops_lock);
 +	return err;
 +}
 +EXPORT_SYMBOL(rtc_set_time);
 +
++int rtc_set_mmss(struct class_device *class_dev, unsigned long secs)
++{
++	int err;
++	struct rtc_device *rtc = to_rtc_device(class_dev);
++
++	if ((err = mutex_lock_interruptible(&rtc->ops_lock)))
++		return err;
++
++	if (!rtc->ops)
++		err = -ENODEV;
++	else if (!rtc->ops->set_mmss) {
++		if (rtc->ops->read_time && rtc->ops->set_time) {
++		        struct rtc_time new, old;
++
++		        new.tm_sec  = secs % 60;
++		        secs /= 60;
++		        new.tm_min  = secs % 60;
++		        secs /= 60;
++		        new.tm_hour = secs % 24;
++
++		       /*
++		        * avoid writing when we're going to change the day
++		        * of the month.  We will retry in the next minute.
++		        * This basically means that if the RTC must not drift
++		        * by more than 1 minute in 11 minutes.
++		        */
++			if (!((old.tm_hour == 23 && old.tm_min == 59) ||
++		            (new.tm_hour == 23 && new.tm_min == 59)))
++				err = rtc->ops->set_time(class_dev->dev, &new);
++		}
++		else
++			err = -EINVAL;
++	}
++	else
++		err = rtc->ops->set_mmss(class_dev->dev, secs);
++
++	mutex_unlock(&rtc->ops_lock);
++
++	return err;
++}
++EXPORT_SYMBOL(rtc_set_mmss);
++
 +int rtc_read_alarm(struct class_device *class_dev, struct rtc_wkalrm *alarm)
 +{
 +	int err;
 +	struct rtc_device *rtc = to_rtc_device(class_dev);
 +
-+	if ((err = down_interruptible(&rtc->ops_lock)))
++	if ((err = mutex_lock_interruptible(&rtc->ops_lock)))
 +		return err;
 +
 +	if (rtc->ops == NULL)
@@ -483,7 +542,7 @@
 +		err = rtc->ops->read_alarm(class_dev->dev, alarm);
 +	}
 +
-+	up(&rtc->ops_lock);
++	mutex_unlock(&rtc->ops_lock);
 +	return err;
 +}
 +EXPORT_SYMBOL(rtc_read_alarm);
@@ -493,7 +552,7 @@
 +	int err;
 +	struct rtc_device *rtc = to_rtc_device(class_dev);
 +
-+	if ((err = down_interruptible(&rtc->ops_lock)))
++	if ((err = mutex_lock_interruptible(&rtc->ops_lock)))
 +		return err;
 +
 +	if (!rtc->ops)
@@ -503,7 +562,7 @@
 +	else
 +		err = rtc->ops->set_alarm(class_dev->dev, alarm);
 +
-+	up(&rtc->ops_lock);
++	mutex_unlock(&rtc->ops_lock);
 +	return err;
 +}
 +EXPORT_SYMBOL(rtc_set_alarm);
@@ -527,7 +586,7 @@
 +}
 +EXPORT_SYMBOL(rtc_update_irq);
 +
-+struct class_device *rtc_open(char *name)
++struct class_device *rtc_class_open(char *name)
 +{
 +	struct class_device *class_dev = NULL,
 +				*class_dev_tmp;
@@ -548,13 +607,13 @@
 +
 +	return class_dev;
 +}
-+EXPORT_SYMBOL(rtc_open);
++EXPORT_SYMBOL(rtc_class_open);
 +
-+void rtc_close(struct class_device *class_dev)
++void rtc_class_close(struct class_device *class_dev)
 +{
 +	module_put(to_rtc_device(class_dev)->owner);
 +}
-+EXPORT_SYMBOL(rtc_close);
++EXPORT_SYMBOL(rtc_class_close);
 +
 +int rtc_irq_register(struct class_device *class_dev, struct rtc_task *task)
 +{
@@ -637,7 +696,7 @@
 +
 +}
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/utils.c	2006-02-06 21:11:33.000000000 +0100
++++ linux-rtc/drivers/rtc/utils.c	2006-02-19 23:33:15.000000000 +0100
 @@ -0,0 +1,97 @@
 +/*
 + * RTC subsystem, utility functions
@@ -737,8 +796,8 @@
 +}
 +EXPORT_SYMBOL(rtc_tm_to_time);
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/hctosys.c	2006-02-06 21:11:33.000000000 +0100
-@@ -0,0 +1,62 @@
++++ linux-rtc/drivers/rtc/hctosys.c	2006-02-21 00:34:57.000000000 +0100
+@@ -0,0 +1,67 @@
 +/*
 + * RTC subsystem, initialize system time on startup
 + *
@@ -766,12 +825,17 @@
 +static int __init rtc_hctosys(void)
 +{
 +	int err;
-+	struct class_device *class_dev = rtc_open(CONFIG_RTC_HCTOSYS_DEVICE);
++	struct rtc_time tm;
++	struct class_device *class_dev = rtc_class_open(CONFIG_RTC_HCTOSYS_DEVICE);
 +
-+	if (class_dev) {
-+		struct rtc_time tm;
++	if (class_dev == NULL) {
++		printk("%s: unable to open rtc device (%s)\n",
++			__FILE__, CONFIG_RTC_HCTOSYS_DEVICE);
++		return -ENODEV;
++	}
 +
-+		if ((err = rtc_read_time(class_dev, &tm)) == 0) {
++	if ((err = rtc_read_time(class_dev, &tm)) == 0) {
++		if (rtc_valid_tm(&tm) == 0) {
 +			struct timespec tv;
 +
 +			tv.tv_nsec = NSEC_PER_SEC >> 1;
@@ -789,21 +853,21 @@
 +		}
 +		else
 +			dev_err(class_dev->dev,
-+				"unable to set the system clock\n");
-+
-+		rtc_close(class_dev);
++				"hctosys: invalid date/time\n");
 +	}
 +	else
-+		printk("%s: unable to open rtc device (%s)\n",
-+			__FILE__, CONFIG_RTC_HCTOSYS_DEVICE);
++		dev_err(class_dev->dev,
++			"hctosys: unable to read the hardware clock\n");
++
++	rtc_class_close(class_dev);
 +
 +	return 0;
 +}
 +
 +late_initcall(rtc_hctosys);
---- linux-nslu2.orig/arch/arm/Kconfig	2006-02-06 23:52:28.000000000 +0100
-+++ linux-nslu2/arch/arm/Kconfig	2006-02-06 23:53:25.000000000 +0100
-@@ -784,6 +784,8 @@ source "drivers/usb/Kconfig"
+--- linux-rtc.orig/arch/arm/Kconfig	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/arch/arm/Kconfig	2006-02-21 00:36:42.000000000 +0100
+@@ -817,6 +817,8 @@ source "drivers/usb/Kconfig"
  
  source "drivers/mmc/Kconfig"
  
@@ -812,8 +876,8 @@
  endmenu
  
  source "fs/Kconfig"
---- linux-nslu2.orig/arch/arm/common/rtctime.c	2006-02-06 23:52:28.000000000 +0100
-+++ linux-nslu2/arch/arm/common/rtctime.c	2006-02-06 23:53:25.000000000 +0100
+--- linux-rtc.orig/arch/arm/common/rtctime.c	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/arch/arm/common/rtctime.c	2006-02-21 00:36:42.000000000 +0100
 @@ -42,89 +42,6 @@ static struct rtc_ops *rtc_ops;
  
  #define rtc_epoch 1900UL
@@ -984,24 +1048,6 @@
  		if (ret)
  			break;
  		ret = copy_to_user(uarg, &alrm, sizeof(alrm));
-@@ -353,7 +270,7 @@ static int rtc_ioctl(struct inode *inode
- 	return ret;
- }
- 
--static int rtc_open(struct inode *inode, struct file *file)
-+static int rtc_arm_open(struct inode *inode, struct file *file)
- {
- 	int ret;
- 
-@@ -408,7 +325,7 @@ static struct file_operations rtc_fops =
- 	.read		= rtc_read,
- 	.poll		= rtc_poll,
- 	.ioctl		= rtc_ioctl,
--	.open		= rtc_open,
-+	.open		= rtc_arm_open,
- 	.release	= rtc_release,
- 	.fasync		= rtc_fasync,
- };
 @@ -427,7 +344,7 @@ static int rtc_read_proc(char *page, cha
  	struct rtc_time tm;
  	char *p = page;
@@ -1020,8 +1066,8 @@
  		p += sprintf(p, "alrm_time\t: ");
  		if ((unsigned int)alrm.time.tm_hour <= 24)
  			p += sprintf(p, "%02d:", alrm.time.tm_hour);
---- linux-nslu2.orig/include/asm-arm/rtc.h	2006-02-06 23:52:28.000000000 +0100
-+++ linux-nslu2/include/asm-arm/rtc.h	2006-02-06 23:53:25.000000000 +0100
+--- linux-rtc.orig/include/asm-arm/rtc.h	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/include/asm-arm/rtc.h	2006-02-21 00:36:42.000000000 +0100
 @@ -25,9 +25,6 @@ struct rtc_ops {
  	int		(*proc)(char *buf);
  };
@@ -1032,9 +1078,1269 @@
  void rtc_next_alarm_time(struct rtc_time *, struct rtc_time *, struct rtc_time *);
  void rtc_update(unsigned long, unsigned long);
  int register_rtc(struct rtc_ops *);
+--- linux-rtc.orig/drivers/char/Kconfig	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/drivers/char/Kconfig	2006-02-21 00:36:42.000000000 +0100
+@@ -695,7 +695,7 @@ config NVRAM
+ 
+ config RTC
+ 	tristate "Enhanced Real Time Clock Support"
+-	depends on !PPC32 && !PARISC && !IA64 && !M68K && (!SPARC || PCI) && !FRV
++	depends on !PPC32 && !PARISC && !IA64 && !M68K && (!SPARC || PCI) && !FRV && !ARM
+ 	---help---
+ 	  If you say Y here and create a character special file /dev/rtc with
+ 	  major number 10 and minor number 135 using mknod ("man mknod"), you
+--- linux-rtc.orig/drivers/i2c/chips/x1205.c	2006-02-21 00:34:27.000000000 +0100
++++ /dev/null	1970-01-01 00:00:00.000000000 +0000
+@@ -1,698 +0,0 @@
+-/*
+- *  x1205.c - An i2c driver for the Xicor X1205 RTC
+- *  Copyright 2004 Karen Spearel
+- *  Copyright 2005 Alessandro Zummo
+- *
+- *  please send all reports to:
+- *	kas11 at tampabay dot rr dot com
+- *      a dot zummo at towertech dot it
+- *
+- *  based on the other drivers in this same directory.
+- *
+- *  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.
+- */
+-
+-#include <linux/module.h>
+-#include <linux/init.h>
+-#include <linux/slab.h>
+-#include <linux/i2c.h>
+-#include <linux/string.h>
+-#include <linux/bcd.h>
+-#include <linux/rtc.h>
+-#include <linux/list.h>
+-
+-#include <linux/x1205.h>
+-
+-#define DRV_VERSION "0.9.9"
+-
+-/* Addresses to scan: none. This chip is located at
+- * 0x6f and uses a two bytes register addressing.
+- * Two bytes need to be written to read a single register,
+- * while most other chips just require one and take the second
+- * one as the data to be written. To prevent corrupting
+- * unknown chips, the user must explicitely set the probe parameter.
+- */
+-
+-static unsigned short normal_i2c[] = { I2C_CLIENT_END };
+-
+-/* Insmod parameters */
+-I2C_CLIENT_INSMOD;
+-I2C_CLIENT_MODULE_PARM(hctosys,
+-	"Set the system time from the hardware clock upon initialization");
+-
+-/* offsets into CCR area */
+-
+-#define CCR_SEC			0
+-#define CCR_MIN			1
+-#define CCR_HOUR		2
+-#define CCR_MDAY		3
+-#define CCR_MONTH		4
+-#define CCR_YEAR		5
+-#define CCR_WDAY		6
+-#define CCR_Y2K			7
+-
+-#define X1205_REG_SR		0x3F	/* status register */
+-#define X1205_REG_Y2K		0x37
+-#define X1205_REG_DW		0x36
+-#define X1205_REG_YR		0x35
+-#define X1205_REG_MO		0x34
+-#define X1205_REG_DT		0x33
+-#define X1205_REG_HR		0x32
+-#define X1205_REG_MN		0x31
+-#define X1205_REG_SC		0x30
+-#define X1205_REG_DTR		0x13
+-#define X1205_REG_ATR		0x12
+-#define X1205_REG_INT		0x11
+-#define X1205_REG_0		0x10
+-#define X1205_REG_Y2K1		0x0F
+-#define X1205_REG_DWA1		0x0E
+-#define X1205_REG_YRA1		0x0D
+-#define X1205_REG_MOA1		0x0C
+-#define X1205_REG_DTA1		0x0B
+-#define X1205_REG_HRA1		0x0A
+-#define X1205_REG_MNA1		0x09
+-#define X1205_REG_SCA1		0x08
+-#define X1205_REG_Y2K0		0x07
+-#define X1205_REG_DWA0		0x06
+-#define X1205_REG_YRA0		0x05
+-#define X1205_REG_MOA0		0x04
+-#define X1205_REG_DTA0		0x03
+-#define X1205_REG_HRA0		0x02
+-#define X1205_REG_MNA0		0x01
+-#define X1205_REG_SCA0		0x00
+-
+-#define X1205_CCR_BASE		0x30	/* Base address of CCR */
+-#define X1205_ALM0_BASE		0x00	/* Base address of ALARM0 */
+-
+-#define X1205_SR_RTCF		0x01	/* Clock failure */
+-#define X1205_SR_WEL		0x02	/* Write Enable Latch */
+-#define X1205_SR_RWEL		0x04	/* Register Write Enable */
+-
+-#define X1205_DTR_DTR0		0x01
+-#define X1205_DTR_DTR1		0x02
+-#define X1205_DTR_DTR2		0x04
+-
+-#define X1205_HR_MIL		0x80	/* Set in ccr.hour for 24 hr mode */
+-
+-/* Prototypes */
+-static int x1205_attach(struct i2c_adapter *adapter);
+-static int x1205_detach(struct i2c_client *client);
+-static int x1205_probe(struct i2c_adapter *adapter, int address, int kind);
+-static int x1205_command(struct i2c_client *client, unsigned int cmd,
+-	void *arg);
+-
+-static struct i2c_driver x1205_driver = {
+-	.driver = {
+-		.name	= "x1205",
+-	},
+-	.attach_adapter = &x1205_attach,
+-	.detach_client	= &x1205_detach,
+-};
+-
+-struct x1205_data {
+-	struct i2c_client client;
+-	struct list_head list;
+-	unsigned int epoch;
+-};
+-
+-static const unsigned char days_in_mo[] =
+-	{ 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31 };
+-
+-static LIST_HEAD(x1205_clients);
+-
+-/* Workaround until the I2C subsytem will allow to send
+- * commands to a specific client. This function will send the command
+- * to the first client.
+- */
+-int x1205_do_command(unsigned int cmd, void *arg)
+-{
+-	struct list_head *walk;
+-	struct list_head *tmp;
+-	struct x1205_data *data;
+-
+-	list_for_each_safe(walk, tmp, &x1205_clients) {
+-		data = list_entry(walk, struct x1205_data, list);
+-		return x1205_command(&data->client, cmd, arg);
+-	}
+-
+-	return -ENODEV;
+-}
+-
+-#define is_leap(year) \
+-	((year) % 4 == 0 && ((year) % 100 != 0 || (year) % 400 == 0))
+-
+-/* make sure the rtc_time values are in bounds */
+-static int x1205_validate_tm(struct rtc_time *tm)
+-{
+-	int year = tm->tm_year + 1900;
+-
+-	if ((tm->tm_year < 70) || (tm->tm_year > 255))
+-		return -EINVAL;
+-
+-	if ((tm->tm_mon > 11) || (tm->tm_mday == 0))
+-		return -EINVAL;
+-
+-	if (tm->tm_mday > days_in_mo[tm->tm_mon]
+-		+ ((tm->tm_mon == 1) && is_leap(year)))
+-		return -EINVAL;
+-
+-	if ((tm->tm_hour >= 24) || (tm->tm_min >= 60) || (tm->tm_sec >= 60))
+-		return -EINVAL;
+-
+-	return 0;
+-}
+-
+-/*
+- * In the routines that deal directly with the x1205 hardware, we use
+- * rtc_time -- month 0-11, hour 0-23, yr = calendar year-epoch
+- * Epoch is initialized as 2000. Time is set to UTC.
+- */
+-static int x1205_get_datetime(struct i2c_client *client, struct rtc_time *tm,
+-				u8 reg_base)
+-{
+-	unsigned char dt_addr[2] = { 0, reg_base };
+-	static unsigned char sr_addr[2] = { 0, X1205_REG_SR };
+-
+-	unsigned char buf[8], sr;
+-
+-	struct i2c_msg msgs[] = {
+-		{ client->addr, 0, 2, sr_addr },	/* setup read ptr */
+-		{ client->addr, I2C_M_RD, 1, &sr }, 	/* read status */
+-		{ client->addr, 0, 2, dt_addr },	/* setup read ptr */
+-		{ client->addr, I2C_M_RD, 8, buf },	/* read date */
+-	};
+-
+-	struct x1205_data *data = i2c_get_clientdata(client);
+-
+-	/* read status register */
+-	if ((i2c_transfer(client->adapter, &msgs[0], 2)) != 2) {
+-		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
+-		return -EIO;
+-	}
+-
+-	/* check for battery failure */
+-	if (sr & X1205_SR_RTCF) {
+-		dev_warn(&client->dev,
+-			"Clock had a power failure, you must set the date.\n");
+-		return -EINVAL;
+-	}
+-
+-	/* read date registers */
+-	if ((i2c_transfer(client->adapter, &msgs[2], 2)) != 2) {
+-		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
+-		return -EIO;
+-	}
+-
+-	dev_dbg(&client->dev,
+-		"%s: raw read data - sec=%02x, min=%02x, hr=%02x, "
+-		"mday=%02x, mon=%02x, year=%02x, wday=%02x, y2k=%02x\n",
+-		__FUNCTION__,
+-		buf[0], buf[1], buf[2], buf[3],
+-		buf[4], buf[5], buf[6], buf[7]);
+-
+-	tm->tm_sec = BCD2BIN(buf[CCR_SEC]);
+-	tm->tm_min = BCD2BIN(buf[CCR_MIN]);
+-	tm->tm_hour = BCD2BIN(buf[CCR_HOUR] & 0x3F); /* hr is 0-23 */
+-	tm->tm_mday = BCD2BIN(buf[CCR_MDAY]);
+-	tm->tm_mon = BCD2BIN(buf[CCR_MONTH]);
+-	data->epoch = BCD2BIN(buf[CCR_Y2K]) * 100;
+-	tm->tm_year = BCD2BIN(buf[CCR_YEAR]) + data->epoch - 1900;
+-	tm->tm_wday = buf[CCR_WDAY];
+-
+-	dev_dbg(&client->dev, "%s: tm is secs=%d, mins=%d, hours=%d, "
+-		"mday=%d, mon=%d, year=%d, wday=%d\n",
+-		__FUNCTION__,
+-		tm->tm_sec, tm->tm_min, tm->tm_hour,
+-		tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday);
+-
+-	return 0;
+-}
+-
+-static int x1205_set_datetime(struct i2c_client *client, struct rtc_time *tm,
+-				int datetoo, u8 reg_base)
+-{
+-	int i, err, xfer;
+-
+-	unsigned char buf[8];
+-
+-	static const unsigned char wel[3] = { 0, X1205_REG_SR,
+-						X1205_SR_WEL };
+-
+-	static const unsigned char rwel[3] = { 0, X1205_REG_SR,
+-						X1205_SR_WEL | X1205_SR_RWEL };
+-
+-	static const unsigned char diswe[3] = { 0, X1205_REG_SR, 0 };
+-
+-	struct x1205_data *data = i2c_get_clientdata(client);
+-
+-	/* check if all values in the tm struct are correct */
+-	if ((err = x1205_validate_tm(tm)) < 0)
+-		return err;
+-
+-	dev_dbg(&client->dev, "%s: secs=%d, mins=%d, hours=%d, "
+-		"mday=%d, mon=%d, year=%d, wday=%d\n",
+-		__FUNCTION__,
+-		tm->tm_sec, tm->tm_min, tm->tm_hour,
+-		tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday);
+-
+-	buf[CCR_SEC] = BIN2BCD(tm->tm_sec);
+-	buf[CCR_MIN] = BIN2BCD(tm->tm_min);
+-
+-	/* set hour and 24hr bit */
+-	buf[CCR_HOUR] = BIN2BCD(tm->tm_hour) | X1205_HR_MIL;
+-
+-	/* should we also set the date? */
+-	if (datetoo) {
+-		buf[CCR_MDAY] = BIN2BCD(tm->tm_mday);
+-
+-		/* month, 0 - 11 */
+-		buf[CCR_MONTH] = BIN2BCD(tm->tm_mon);
+-
+-		/* year, since 1900 */
+-		buf[CCR_YEAR] = BIN2BCD(tm->tm_year + 1900 - data->epoch);
+-		buf[CCR_WDAY] = tm->tm_wday & 0x07;
+-		buf[CCR_Y2K] = BIN2BCD(data->epoch / 100);
+-	}
+-
+-	/* this sequence is required to unlock the chip */
+-	xfer = i2c_master_send(client, wel, 3);
+-	if (xfer != 3) {
+-		dev_err(&client->dev, "%s: wel - %d\n", __FUNCTION__, xfer);
+-		return -EIO;
+-	}
+-
+-	xfer = i2c_master_send(client, rwel, 3);
+-	if (xfer != 3) {
+-		dev_err(&client->dev, "%s: rwel - %d\n", __FUNCTION__, xfer);
+-		return -EIO;
+-	}
+-
+-	/* write register's data */
+-	for (i = 0; i < (datetoo ? 8 : 3); i++) {
+-		unsigned char rdata[3] = { 0, reg_base + i, buf[i] };
+-
+-		xfer = i2c_master_send(client, rdata, 3);
+-		if (xfer != 3) {
+-			dev_err(&client->dev,
+-				"%s: xfer=%d addr=%02x, data=%02x\n",
+-				__FUNCTION__,
+-				 xfer, rdata[1], rdata[2]);
+-			return -EIO;
+-		}
+-	};
+-
+-	/* disable further writes */
+-	xfer = i2c_master_send(client, diswe, 3);
+-	if (xfer != 3) {
+-		dev_err(&client->dev, "%s: diswe - %d\n", __FUNCTION__, xfer);
+-		return -EIO;
+-	}
+-
+-	return 0;
+-}
+-
+-static int x1205_get_dtrim(struct i2c_client *client, int *trim)
+-{
+-	unsigned char dtr;
+-	static unsigned char dtr_addr[2] = { 0, X1205_REG_DTR };
+-
+-	struct i2c_msg msgs[] = {
+-		{ client->addr, 0, 2, dtr_addr },	/* setup read ptr */
+-		{ client->addr, I2C_M_RD, 1, &dtr }, 	/* read dtr */
+-	};
+-
+-	/* read dtr register */
+-	if ((i2c_transfer(client->adapter, &msgs[0], 2)) != 2) {
+-		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
+-		return -EIO;
+-	}
+-
+-	dev_dbg(&client->dev, "%s: raw dtr=%x\n", __FUNCTION__, dtr);
+-
+-	*trim = 0;
+-
+-	if (dtr & X1205_DTR_DTR0)
+-		*trim += 20;
+-
+-	if (dtr & X1205_DTR_DTR1)
+-		*trim += 10;
+-
+-	if (dtr & X1205_DTR_DTR2)
+-		*trim = -*trim;
+-
+-	return 0;
+-}
+-
+-static int x1205_get_atrim(struct i2c_client *client, int *trim)
+-{
+-	s8 atr;
+-	static unsigned char atr_addr[2] = { 0, X1205_REG_ATR };
+-
+-	struct i2c_msg msgs[] = {
+-		{ client->addr, 0, 2, atr_addr },	/* setup read ptr */
+-		{ client->addr, I2C_M_RD, 1, &atr }, 	/* read atr */
+-	};
+-
+-	/* read atr register */
+-	if ((i2c_transfer(client->adapter, &msgs[0], 2)) != 2) {
+-		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
+-		return -EIO;
+-	}
+-
+-	dev_dbg(&client->dev, "%s: raw atr=%x\n", __FUNCTION__, atr);
+-
+-	/* atr is a two's complement value on 6 bits,
+-	 * perform sign extension. The formula is
+-	 * Catr = (atr * 0.25pF) + 11.00pF.
+-	 */
+-	if (atr & 0x20)
+-		atr |= 0xC0;
+-
+-	dev_dbg(&client->dev, "%s: raw atr=%x (%d)\n", __FUNCTION__, atr, atr);
+-
+-	*trim = (atr * 250) + 11000;
+-
+-	dev_dbg(&client->dev, "%s: real=%d\n", __FUNCTION__, *trim);
+-
+-	return 0;
+-}
+-
+-static int x1205_hctosys(struct i2c_client *client)
+-{
+-	int err;
+-
+-	struct rtc_time tm;
+-	struct timespec tv;
+-
+-	err = x1205_command(client, X1205_CMD_GETDATETIME, &tm);
+-
+-	if (err) {
+-		dev_err(&client->dev,
+-			"Unable to set the system clock\n");
+-		return err;
+-	}
+-
+-	/* IMPORTANT: the RTC only stores whole seconds. It is arbitrary
+-	 * whether it stores the most close value or the value with partial
+-	 * seconds truncated. However, it is important that we use it to store
+-	 * the truncated value. This is because otherwise it is necessary,
+-	 * in an rtc sync function, to read both xtime.tv_sec and
+-	 * xtime.tv_nsec. On some processors (i.e. ARM), an atomic read
+-	 * of >32bits is not possible. So storing the most close value would
+-	 * slow down the sync API. So here we have the truncated value and
+-	 * the best guess is to add 0.5s.
+-	 */
+-
+-	tv.tv_nsec = NSEC_PER_SEC >> 1;
+-
+-	/* WARNING: this is not the C library 'mktime' call, it is a built in
+-	 * inline function from include/linux/time.h.  It expects (requires)
+-	 * the month to be in the range 1-12
+-	 */
+-
+-	tv.tv_sec  = mktime(tm.tm_year + 1900, tm.tm_mon + 1,
+-				tm.tm_mday, tm.tm_hour,
+-				tm.tm_min, tm.tm_sec);
+-
+-	do_settimeofday(&tv);
+-
+-	dev_info(&client->dev,
+-		"setting the system clock to %d-%d-%d %d:%d:%d\n",
+-		tm.tm_year + 1900, tm.tm_mon + 1,
+-		tm.tm_mday, tm.tm_hour, tm.tm_min,
+-		tm.tm_sec);
+-
+-	return 0;
+-}
+-
+-struct x1205_limit
+-{
+-	unsigned char reg;
+-	unsigned char mask;
+-	unsigned char min;
+-	unsigned char max;
+-};
+-
+-static int x1205_validate_client(struct i2c_client *client)
+-{
+-	int i, xfer;
+-
+-	/* Probe array. We will read the register at the specified
+-	 * address and check if the given bits are zero.
+-	 */
+-	static const unsigned char probe_zero_pattern[] = {
+-		/* register, mask */
+-		X1205_REG_SR,	0x18,
+-		X1205_REG_DTR,	0xF8,
+-		X1205_REG_ATR,	0xC0,
+-		X1205_REG_INT,	0x18,
+-		X1205_REG_0,	0xFF,
+-	};
+-
+-	static const struct x1205_limit probe_limits_pattern[] = {
+-		/* register, mask, min, max */
+-		{ X1205_REG_Y2K,	0xFF,	19,	20	},
+-		{ X1205_REG_DW,		0xFF,	0,	6	},
+-		{ X1205_REG_YR,		0xFF,	0,	99	},
+-		{ X1205_REG_MO,		0xFF,	0,	12	},
+-		{ X1205_REG_DT,		0xFF,	0,	31	},
+-		{ X1205_REG_HR,		0x7F,	0,	23	},
+-		{ X1205_REG_MN,		0xFF,	0,	59	},
+-		{ X1205_REG_SC,		0xFF,	0,	59	},
+-		{ X1205_REG_Y2K1,	0xFF,	19,	20	},
+-		{ X1205_REG_Y2K0,	0xFF,	19,	20	},
+-	};
+-
+-	/* check that registers have bits a 0 where expected */
+-	for (i = 0; i < ARRAY_SIZE(probe_zero_pattern); i += 2) {
+-		unsigned char buf;
+-
+-		unsigned char addr[2] = { 0, probe_zero_pattern[i] };
+-
+-		struct i2c_msg msgs[2] = {
+-			{ client->addr, 0, 2, addr },
+-			{ client->addr, I2C_M_RD, 1, &buf },
+-		};
+-
+-		xfer = i2c_transfer(client->adapter, msgs, 2);
+-		if (xfer != 2) {
+-			dev_err(&client->adapter->dev,
+-				"%s: could not read register %x\n",
+-				__FUNCTION__, addr[1]);
+-
+-			return -EIO;
+-		}
+-
+-		if ((buf & probe_zero_pattern[i+1]) != 0) {
+-			dev_err(&client->adapter->dev,
+-				"%s: register=%02x, zero pattern=%d, value=%x\n",
+-				__FUNCTION__, addr[1], i, buf);
+-
+-			return -ENODEV;
+-		}
+-	}
+-
+-	/* check limits (only registers with bcd values) */
+-	for (i = 0; i < ARRAY_SIZE(probe_limits_pattern); i++) {
+-		unsigned char reg, value;
+-
+-		unsigned char addr[2] = { 0, probe_limits_pattern[i].reg };
+-
+-		struct i2c_msg msgs[2] = {
+-			{ client->addr, 0, 2, addr },
+-			{ client->addr, I2C_M_RD, 1, &reg },
+-		};
+-
+-		xfer = i2c_transfer(client->adapter, msgs, 2);
+-
+-		if (xfer != 2) {
+-			dev_err(&client->adapter->dev,
+-				"%s: could not read register %x\n",
+-				__FUNCTION__, addr[1]);
+-
+-			return -EIO;
+-		}
+-
+-		value = BCD2BIN(reg & probe_limits_pattern[i].mask);
+-
+-		if (value > probe_limits_pattern[i].max ||
+-			value < probe_limits_pattern[i].min) {
+-			dev_dbg(&client->adapter->dev,
+-				"%s: register=%x, lim pattern=%d, value=%d\n",
+-				__FUNCTION__, addr[1], i, value);
+-
+-			return -ENODEV;
+-		}
+-	}
+-
+-	return 0;
+-}
+-
+-static int x1205_attach(struct i2c_adapter *adapter)
+-{
+-	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
+-
+-	return i2c_probe(adapter, &addr_data, x1205_probe);
+-}
+-
+-int x1205_direct_attach(int adapter_id,
+-	struct i2c_client_address_data *address_data)
+-{
+-	int err;
+-	struct i2c_adapter *adapter = i2c_get_adapter(adapter_id);
+-
+-	if (adapter) {
+-		err = i2c_probe(adapter,
+-			address_data, x1205_probe);
+-
+-		i2c_put_adapter(adapter);
+-
+-		return err;
+-	}
+-
+-	return -ENODEV;
+-}
+-
+-static int x1205_probe(struct i2c_adapter *adapter, int address, int kind)
+-{
+-	struct i2c_client *client;
+-	struct x1205_data *data;
+-
+-	int err = 0;
+-
+-	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
+-
+-	if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) {
+-		err = -ENODEV;
+-		goto exit;
+-	}
+-
+-	if (!(data = kzalloc(sizeof(struct x1205_data), GFP_KERNEL))) {
+-		err = -ENOMEM;
+-		goto exit;
+-	}
+-
+-	/* Initialize our structures */
+-	data->epoch = 2000;
+-
+-	client = &data->client;
+-	client->addr = address;
+-	client->driver = &x1205_driver;
+-	client->adapter	= adapter;
+-
+-	strlcpy(client->name, "x1205", I2C_NAME_SIZE);
+-
+-	i2c_set_clientdata(client, data);
+-
+-	/* Verify the chip is really an X1205 */
+-	if (kind < 0) {
+-		if (x1205_validate_client(client) < 0) {
+-			err = -ENODEV;
+-			goto exit_kfree;
+-		}
+-	}
+-
+-	/* Inform the i2c layer */
+-	if ((err = i2c_attach_client(client)))
+-		goto exit_kfree;
+-
+-	list_add(&data->list, &x1205_clients);
+-
+-	dev_info(&client->dev, "chip found, driver version " DRV_VERSION "\n");
+-
+-	/* If requested, set the system time */
+-	if (hctosys)
+-		x1205_hctosys(client);
+-
+-	return 0;
+-
+-exit_kfree:
+-	kfree(data);
+-
+-exit:
+-	return err;
+-}
+-
+-static int x1205_detach(struct i2c_client *client)
+-{
+-	int err;
+-	struct x1205_data *data = i2c_get_clientdata(client);
+-
+-	dev_dbg(&client->dev, "%s\n", __FUNCTION__);
+-
+-	if ((err = i2c_detach_client(client)))
+-		return err;
+-
+-	list_del(&data->list);
+-
+-	kfree(data);
+-
+-	return 0;
+-}
+-
+-static int x1205_command(struct i2c_client *client, unsigned int cmd,
+-	void *param)
+-{
+-	if (param == NULL)
+-		return -EINVAL;
+-
+-	if (!capable(CAP_SYS_TIME))
+-		return -EACCES;
+-
+-	dev_dbg(&client->dev, "%s: cmd=%d\n", __FUNCTION__, cmd);
+-
+-	switch (cmd) {
+-	case X1205_CMD_GETDATETIME:
+-		return x1205_get_datetime(client, param, X1205_CCR_BASE);
+-
+-	case X1205_CMD_SETTIME:
+-		return x1205_set_datetime(client, param, 0,
+-				X1205_CCR_BASE);
+-
+-	case X1205_CMD_SETDATETIME:
+-		return x1205_set_datetime(client, param, 1,
+-				X1205_CCR_BASE);
+-
+-	case X1205_CMD_GETALARM:
+-		return x1205_get_datetime(client, param, X1205_ALM0_BASE);
+-
+-	case X1205_CMD_SETALARM:
+-		return x1205_set_datetime(client, param, 1,
+-				X1205_ALM0_BASE);
+-
+-	case X1205_CMD_GETDTRIM:
+-		return x1205_get_dtrim(client, param);
+-
+-	case X1205_CMD_GETATRIM:
+-		return x1205_get_atrim(client, param);
+-
+-	default:
+-		return -EINVAL;
+-	}
+-}
+-
+-static int __init x1205_init(void)
+-{
+-	return i2c_add_driver(&x1205_driver);
+-}
+-
+-static void __exit x1205_exit(void)
+-{
+-	i2c_del_driver(&x1205_driver);
+-}
+-
+-MODULE_AUTHOR(
+-	"Karen Spearel <kas11@tampabay.rr.com>, "
+-	"Alessandro Zummo <a.zummo@towertech.it>");
+-MODULE_DESCRIPTION("Xicor X1205 RTC driver");
+-MODULE_LICENSE("GPL");
+-MODULE_VERSION(DRV_VERSION);
+-
+-EXPORT_SYMBOL_GPL(x1205_do_command);
+-EXPORT_SYMBOL_GPL(x1205_direct_attach);
+-
+-module_init(x1205_init);
+-module_exit(x1205_exit);
+--- linux-rtc.orig/drivers/i2c/chips/Makefile	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/drivers/i2c/chips/Makefile	2006-02-21 00:36:43.000000000 +0100
+@@ -10,10 +10,8 @@ obj-$(CONFIG_SENSORS_M41T00)	+= m41t00.o
+ obj-$(CONFIG_SENSORS_PCA9539)	+= pca9539.o
+ obj-$(CONFIG_SENSORS_PCF8574)	+= pcf8574.o
+ obj-$(CONFIG_SENSORS_PCF8591)	+= pcf8591.o
+-obj-$(CONFIG_SENSORS_RTC8564)	+= rtc8564.o
+ obj-$(CONFIG_ISP1301_OMAP)	+= isp1301_omap.o
+ obj-$(CONFIG_TPS65010)		+= tps65010.o
+-obj-$(CONFIG_RTC_X1205_I2C)	+= x1205.o
+ 
+ ifeq ($(CONFIG_I2C_DEBUG_CHIP),y)
+ EXTRA_CFLAGS += -DDEBUG
+--- linux-rtc.orig/drivers/i2c/chips/rtc8564.c	2006-02-21 00:34:27.000000000 +0100
++++ /dev/null	1970-01-01 00:00:00.000000000 +0000
+@@ -1,385 +0,0 @@
+-/*
+- *  linux/drivers/i2c/chips/rtc8564.c
+- *
+- *  Copyright (C) 2002-2004 Stefan Eletzhofer
+- *
+- *	based on linux/drivers/acron/char/pcf8583.c
+- *  Copyright (C) 2000 Russell King
+- *
+- * This program is free software; you can redistribute it and/or modify
+- * it under the terms of the GNU General Public License version 2 as
+- * published by the Free Software Foundation.
+- *
+- * Driver for system3's EPSON RTC 8564 chip
+- */
+-#include <linux/module.h>
+-#include <linux/kernel.h>
+-#include <linux/bcd.h>
+-#include <linux/i2c.h>
+-#include <linux/slab.h>
+-#include <linux/string.h>
+-#include <linux/rtc.h>		/* get the user-level API */
+-#include <linux/init.h>
+-
+-#include "rtc8564.h"
+-
+-#ifdef DEBUG
+-# define _DBG(x, fmt, args...) do{ if (debug>=x) printk(KERN_DEBUG"%s: " fmt "\n", __FUNCTION__, ##args); } while(0);
+-#else
+-# define _DBG(x, fmt, args...) do { } while(0);
+-#endif
+-
+-#define _DBGRTCTM(x, rtctm) if (debug>=x) printk("%s: secs=%d, mins=%d, hours=%d, mday=%d, " \
+-			"mon=%d, year=%d, wday=%d VL=%d\n", __FUNCTION__, \
+-			(rtctm).secs, (rtctm).mins, (rtctm).hours, (rtctm).mday, \
+-			(rtctm).mon, (rtctm).year, (rtctm).wday, (rtctm).vl);
+-
+-struct rtc8564_data {
+-	struct i2c_client client;
+-	u16 ctrl;
+-};
+-
+-static inline u8 _rtc8564_ctrl1(struct i2c_client *client)
+-{
+-	struct rtc8564_data *data = i2c_get_clientdata(client);
+-	return data->ctrl & 0xff;
+-}
+-static inline u8 _rtc8564_ctrl2(struct i2c_client *client)
+-{
+-	struct rtc8564_data *data = i2c_get_clientdata(client);
+-	return (data->ctrl & 0xff00) >> 8;
+-}
+-
+-#define CTRL1(c) _rtc8564_ctrl1(c)
+-#define CTRL2(c) _rtc8564_ctrl2(c)
+-
+-static int debug;;
+-module_param(debug, int, S_IRUGO | S_IWUSR);
+-
+-static struct i2c_driver rtc8564_driver;
+-
+-static unsigned short ignore[] = { I2C_CLIENT_END };
+-static unsigned short normal_addr[] = { 0x51, I2C_CLIENT_END };
+-
+-static struct i2c_client_address_data addr_data = {
+-	.normal_i2c		= normal_addr,
+-	.probe			= ignore,
+-	.ignore			= ignore,
+-};
+-
+-static int rtc8564_read_mem(struct i2c_client *client, struct mem *mem);
+-static int rtc8564_write_mem(struct i2c_client *client, struct mem *mem);
+-
+-static int rtc8564_read(struct i2c_client *client, unsigned char adr,
+-			unsigned char *buf, unsigned char len)
+-{
+-	int ret = -EIO;
+-	unsigned char addr[1] = { adr };
+-	struct i2c_msg msgs[2] = {
+-		{client->addr, 0, 1, addr},
+-		{client->addr, I2C_M_RD, len, buf}
+-	};
+-
+-	_DBG(1, "client=%p, adr=%d, buf=%p, len=%d", client, adr, buf, len);
+-
+-	if (!buf) {
+-		ret = -EINVAL;
+-		goto done;
+-	}
+-
+-	ret = i2c_transfer(client->adapter, msgs, 2);
+-	if (ret == 2) {
+-		ret = 0;
+-	}
+-
+-done:
+-	return ret;
+-}
+-
+-static int rtc8564_write(struct i2c_client *client, unsigned char adr,
+-			 unsigned char *data, unsigned char len)
+-{
+-	int ret = 0;
+-	unsigned char _data[16];
+-	struct i2c_msg wr;
+-	int i;
+-
+-	if (!data || len > 15) {
+-		ret = -EINVAL;
+-		goto done;
+-	}
+-
+-	_DBG(1, "client=%p, adr=%d, buf=%p, len=%d", client, adr, data, len);
+-
+-	_data[0] = adr;
+-	for (i = 0; i < len; i++) {
+-		_data[i + 1] = data[i];
+-		_DBG(5, "data[%d] = 0x%02x (%d)", i, data[i], data[i]);
+-	}
+-
+-	wr.addr = client->addr;
+-	wr.flags = 0;
+-	wr.len = len + 1;
+-	wr.buf = _data;
+-
+-	ret = i2c_transfer(client->adapter, &wr, 1);
+-	if (ret == 1) {
+-		ret = 0;
+-	}
+-
+-done:
+-	return ret;
+-}
+-
+-static int rtc8564_attach(struct i2c_adapter *adap, int addr, int kind)
+-{
+-	int ret;
+-	struct i2c_client *new_client;
+-	struct rtc8564_data *d;
+-	unsigned char data[10];
+-	unsigned char ad[1] = { 0 };
+-	struct i2c_msg ctrl_wr[1] = {
+-		{addr, 0, 2, data}
+-	};
+-	struct i2c_msg ctrl_rd[2] = {
+-		{addr, 0, 1, ad},
+-		{addr, I2C_M_RD, 2, data}
+-	};
+-
+-	d = kzalloc(sizeof(struct rtc8564_data), GFP_KERNEL);
+-	if (!d) {
+-		ret = -ENOMEM;
+-		goto done;
+-	}
+-	new_client = &d->client;
+-
+-	strlcpy(new_client->name, "RTC8564", I2C_NAME_SIZE);
+-	i2c_set_clientdata(new_client, d);
+-	new_client->addr = addr;
+-	new_client->adapter = adap;
+-	new_client->driver = &rtc8564_driver;
+-
+-	_DBG(1, "client=%p", new_client);
+-
+-	/* init ctrl1 reg */
+-	data[0] = 0;
+-	data[1] = 0;
+-	ret = i2c_transfer(new_client->adapter, ctrl_wr, 1);
+-	if (ret != 1) {
+-		printk(KERN_INFO "rtc8564: cant init ctrl1\n");
+-		ret = -ENODEV;
+-		goto done;
+-	}
+-
+-	/* read back ctrl1 and ctrl2 */
+-	ret = i2c_transfer(new_client->adapter, ctrl_rd, 2);
+-	if (ret != 2) {
+-		printk(KERN_INFO "rtc8564: cant read ctrl\n");
+-		ret = -ENODEV;
+-		goto done;
+-	}
+-
+-	d->ctrl = data[0] | (data[1] << 8);
+-
+-	_DBG(1, "RTC8564_REG_CTRL1=%02x, RTC8564_REG_CTRL2=%02x",
+-	     data[0], data[1]);
+-
+-	ret = i2c_attach_client(new_client);
+-done:
+-	if (ret) {
+-		kfree(d);
+-	}
+-	return ret;
+-}
+-
+-static int rtc8564_probe(struct i2c_adapter *adap)
+-{
+-	return i2c_probe(adap, &addr_data, rtc8564_attach);
+-}
+-
+-static int rtc8564_detach(struct i2c_client *client)
+-{
+-	i2c_detach_client(client);
+-	kfree(i2c_get_clientdata(client));
+-	return 0;
+-}
+-
+-static int rtc8564_get_datetime(struct i2c_client *client, struct rtc_tm *dt)
+-{
+-	int ret = -EIO;
+-	unsigned char buf[15];
+-
+-	_DBG(1, "client=%p, dt=%p", client, dt);
+-
+-	if (!dt)
+-		return -EINVAL;
+-
+-	memset(buf, 0, sizeof(buf));
+-
+-	ret = rtc8564_read(client, 0, buf, 15);
+-	if (ret)
+-		return ret;
+-
+-	/* century stored in minute alarm reg */
+-	dt->year = BCD2BIN(buf[RTC8564_REG_YEAR]);
+-	dt->year += 100 * BCD2BIN(buf[RTC8564_REG_AL_MIN] & 0x3f);
+-	dt->mday = BCD2BIN(buf[RTC8564_REG_DAY] & 0x3f);
+-	dt->wday = BCD2BIN(buf[RTC8564_REG_WDAY] & 7);
+-	dt->mon = BCD2BIN(buf[RTC8564_REG_MON_CENT] & 0x1f);
+-
+-	dt->secs = BCD2BIN(buf[RTC8564_REG_SEC] & 0x7f);
+-	dt->vl = (buf[RTC8564_REG_SEC] & 0x80) == 0x80;
+-	dt->mins = BCD2BIN(buf[RTC8564_REG_MIN] & 0x7f);
+-	dt->hours = BCD2BIN(buf[RTC8564_REG_HR] & 0x3f);
+-
+-	_DBGRTCTM(2, *dt);
+-
+-	return 0;
+-}
+-
+-static int
+-rtc8564_set_datetime(struct i2c_client *client, struct rtc_tm *dt, int datetoo)
+-{
+-	int ret, len = 5;
+-	unsigned char buf[15];
+-
+-	_DBG(1, "client=%p, dt=%p", client, dt);
+-
+-	if (!dt)
+-		return -EINVAL;
+-
+-	_DBGRTCTM(2, *dt);
+-
+-	buf[RTC8564_REG_CTRL1] = CTRL1(client) | RTC8564_CTRL1_STOP;
+-	buf[RTC8564_REG_CTRL2] = CTRL2(client);
+-	buf[RTC8564_REG_SEC] = BIN2BCD(dt->secs);
+-	buf[RTC8564_REG_MIN] = BIN2BCD(dt->mins);
+-	buf[RTC8564_REG_HR] = BIN2BCD(dt->hours);
+-
+-	if (datetoo) {
+-		len += 5;
+-		buf[RTC8564_REG_DAY] = BIN2BCD(dt->mday);
+-		buf[RTC8564_REG_WDAY] = BIN2BCD(dt->wday);
+-		buf[RTC8564_REG_MON_CENT] = BIN2BCD(dt->mon) & 0x1f;
+-		/* century stored in minute alarm reg */
+-		buf[RTC8564_REG_YEAR] = BIN2BCD(dt->year % 100);
+-		buf[RTC8564_REG_AL_MIN] = BIN2BCD(dt->year / 100);
+-	}
+-
+-	ret = rtc8564_write(client, 0, buf, len);
+-	if (ret) {
+-		_DBG(1, "error writing data! %d", ret);
+-	}
+-
+-	buf[RTC8564_REG_CTRL1] = CTRL1(client);
+-	ret = rtc8564_write(client, 0, buf, 1);
+-	if (ret) {
+-		_DBG(1, "error writing data! %d", ret);
+-	}
+-
+-	return ret;
+-}
+-
+-static int rtc8564_get_ctrl(struct i2c_client *client, unsigned int *ctrl)
+-{
+-	struct rtc8564_data *data = i2c_get_clientdata(client);
+-
+-	if (!ctrl)
+-		return -1;
+-
+-	*ctrl = data->ctrl;
+-	return 0;
+-}
+-
+-static int rtc8564_set_ctrl(struct i2c_client *client, unsigned int *ctrl)
+-{
+-	struct rtc8564_data *data = i2c_get_clientdata(client);
+-	unsigned char buf[2];
+-
+-	if (!ctrl)
+-		return -1;
+-
+-	buf[0] = *ctrl & 0xff;
+-	buf[1] = (*ctrl & 0xff00) >> 8;
+-	data->ctrl = *ctrl;
+-
+-	return rtc8564_write(client, 0, buf, 2);
+-}
+-
+-static int rtc8564_read_mem(struct i2c_client *client, struct mem *mem)
+-{
+-
+-	if (!mem)
+-		return -EINVAL;
+-
+-	return rtc8564_read(client, mem->loc, mem->data, mem->nr);
+-}
+-
+-static int rtc8564_write_mem(struct i2c_client *client, struct mem *mem)
+-{
+-
+-	if (!mem)
+-		return -EINVAL;
+-
+-	return rtc8564_write(client, mem->loc, mem->data, mem->nr);
+-}
+-
+-static int
+-rtc8564_command(struct i2c_client *client, unsigned int cmd, void *arg)
+-{
+-
+-	_DBG(1, "cmd=%d", cmd);
+-
+-	switch (cmd) {
+-	case RTC_GETDATETIME:
+-		return rtc8564_get_datetime(client, arg);
+-
+-	case RTC_SETTIME:
+-		return rtc8564_set_datetime(client, arg, 0);
+-
+-	case RTC_SETDATETIME:
+-		return rtc8564_set_datetime(client, arg, 1);
+-
+-	case RTC_GETCTRL:
+-		return rtc8564_get_ctrl(client, arg);
+-
+-	case RTC_SETCTRL:
+-		return rtc8564_set_ctrl(client, arg);
+-
+-	case MEM_READ:
+-		return rtc8564_read_mem(client, arg);
+-
+-	case MEM_WRITE:
+-		return rtc8564_write_mem(client, arg);
+-
+-	default:
+-		return -EINVAL;
+-	}
+-}
+-
+-static struct i2c_driver rtc8564_driver = {
+-	.driver = {
+-		.name	= "RTC8564",
+-	},
+-	.id		= I2C_DRIVERID_RTC8564,
+-	.attach_adapter = rtc8564_probe,
+-	.detach_client	= rtc8564_detach,
+-	.command	= rtc8564_command
+-};
+-
+-static __init int rtc8564_init(void)
+-{
+-	return i2c_add_driver(&rtc8564_driver);
+-}
+-
+-static __exit void rtc8564_exit(void)
+-{
+-	i2c_del_driver(&rtc8564_driver);
+-}
+-
+-MODULE_AUTHOR("Stefan Eletzhofer <Stefan.Eletzhofer@eletztrick.de>");
+-MODULE_DESCRIPTION("EPSON RTC8564 Driver");
+-MODULE_LICENSE("GPL");
+-
+-module_init(rtc8564_init);
+-module_exit(rtc8564_exit);
+--- linux-rtc.orig/drivers/i2c/chips/rtc8564.h	2006-02-21 00:34:27.000000000 +0100
++++ /dev/null	1970-01-01 00:00:00.000000000 +0000
+@@ -1,78 +0,0 @@
+-/*
+- *  linux/drivers/i2c/chips/rtc8564.h
+- *
+- *  Copyright (C) 2002-2004 Stefan Eletzhofer
+- *
+- *	based on linux/drivers/acron/char/pcf8583.h
+- *  Copyright (C) 2000 Russell King
+- *
+- * This program is free software; you can redistribute it and/or modify
+- * it under the terms of the GNU General Public License version 2 as
+- * published by the Free Software Foundation.
+- */
+-struct rtc_tm {
+-	unsigned char	secs;
+-	unsigned char	mins;
+-	unsigned char	hours;
+-	unsigned char	mday;
+-	unsigned char	mon;
+-	unsigned short	year; /* xxxx 4 digits :) */
+-	unsigned char	wday;
+-	unsigned char	vl;
+-};
+-
+-struct mem {
+-	unsigned int	loc;
+-	unsigned int	nr;
+-	unsigned char	*data;
+-};
+-
+-#define RTC_GETDATETIME	0
+-#define RTC_SETTIME	1
+-#define RTC_SETDATETIME	2
+-#define RTC_GETCTRL	3
+-#define RTC_SETCTRL	4
+-#define MEM_READ	5
+-#define MEM_WRITE	6
+-
+-#define RTC8564_REG_CTRL1		0x0 /* T  0 S 0 | T 0 0 0 */
+-#define RTC8564_REG_CTRL2		0x1 /* 0  0 0 TI/TP | AF TF AIE TIE */
+-#define RTC8564_REG_SEC			0x2 /* VL 4 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_MIN			0x3 /* x  4 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_HR			0x4 /* x  x 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_DAY			0x5 /* x  x 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_WDAY		0x6 /* x  x x x | x 4 2 1 */
+-#define RTC8564_REG_MON_CENT	0x7 /* C  x x 1 | 8 4 2 1 */
+-#define RTC8564_REG_YEAR		0x8 /* 8  4 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_AL_MIN		0x9 /* AE 4 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_AL_HR		0xa /* AE 4 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_AL_DAY		0xb /* AE x 2 1 | 8 4 2 1 */
+-#define RTC8564_REG_AL_WDAY		0xc /* AE x x x | x 4 2 1 */
+-#define RTC8564_REG_CLKOUT		0xd /* FE x x x | x x FD1 FD0 */
+-#define RTC8564_REG_TCTL		0xe /* TE x x x | x x FD1 FD0 */
+-#define RTC8564_REG_TIMER		0xf /* 8 bit binary */
+-
+-/* Control reg */
+-#define RTC8564_CTRL1_TEST1		(1<<3)
+-#define RTC8564_CTRL1_STOP		(1<<5)
+-#define RTC8564_CTRL1_TEST2		(1<<7)
+-
+-#define RTC8564_CTRL2_TIE		(1<<0)
+-#define RTC8564_CTRL2_AIE		(1<<1)
+-#define RTC8564_CTRL2_TF		(1<<2)
+-#define RTC8564_CTRL2_AF		(1<<3)
+-#define RTC8564_CTRL2_TI_TP		(1<<4)
+-
+-/* CLKOUT frequencies */
+-#define RTC8564_FD_32768HZ		(0x0)
+-#define RTC8564_FD_1024HZ		(0x1)
+-#define RTC8564_FD_32			(0x2)
+-#define RTC8564_FD_1HZ			(0x3)
+-
+-/* Timer CTRL */
+-#define RTC8564_TD_4096HZ		(0x0)
+-#define RTC8564_TD_64HZ			(0x1)
+-#define RTC8564_TD_1HZ			(0x2)
+-#define RTC8564_TD_1_60HZ		(0x3)
+-
+-#define I2C_DRIVERID_RTC8564 0xf000
+--- linux-rtc.orig/include/linux/x1205.h	2006-02-21 00:34:27.000000000 +0100
++++ /dev/null	1970-01-01 00:00:00.000000000 +0000
+@@ -1,31 +0,0 @@
+-/*
+- *  x1205.h - defines for drivers/i2c/chips/x1205.c
+- *  Copyright 2004 Karen Spearel
+- *  Copyright 2005 Alessandro Zummo
+- *
+- *  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.
+- */
+-
+-#ifndef __LINUX_X1205_H__
+-#define __LINUX_X1205_H__
+-
+-/* commands */
+-
+-#define X1205_CMD_GETDATETIME	0
+-#define X1205_CMD_SETTIME	1
+-#define X1205_CMD_SETDATETIME	2
+-#define X1205_CMD_GETALARM	3
+-#define X1205_CMD_SETALARM	4
+-#define X1205_CMD_GETDTRIM	5
+-#define X1205_CMD_SETDTRIM	6
+-#define X1205_CMD_GETATRIM	7
+-#define X1205_CMD_SETATRIM	8
+-
+-extern int x1205_do_command(unsigned int cmd, void *arg);
+-extern int x1205_direct_attach(int adapter_id,
+-	struct i2c_client_address_data *address_data);
+-
+-#endif /* __LINUX_X1205_H__ */
+--- linux-rtc.orig/drivers/i2c/chips/Kconfig	2006-02-21 00:34:27.000000000 +0100
++++ linux-rtc/drivers/i2c/chips/Kconfig	2006-02-21 00:36:43.000000000 +0100
+@@ -65,15 +65,6 @@ config SENSORS_PCF8591
+ 	  This driver can also be built as a module.  If so, the module
+ 	  will be called pcf8591.
+ 
+-config SENSORS_RTC8564
+-	tristate "Epson 8564 RTC chip"
+-	depends on I2C && EXPERIMENTAL
+-	help
+-	  If you say yes here you get support for the Epson 8564 RTC chip.
+-
+-	  This driver can also be built as a module.  If so, the module
+-	  will be called i2c-rtc8564.
+-
+ config ISP1301_OMAP
+ 	tristate "Philips ISP1301 with OMAP OTG"
+ 	depends on I2C && ARCH_OMAP_OTG
+@@ -126,13 +117,4 @@ config SENSORS_MAX6875
+ 	  This driver can also be built as a module.  If so, the module
+ 	  will be called max6875.
+ 
+-config RTC_X1205_I2C
+-	tristate "Xicor X1205 RTC chip"
+-	depends on I2C && EXPERIMENTAL
+-	help
+-	  If you say yes here you get support for the Xicor X1205 RTC chip.
+-
+-	  This driver can also be built as a module. If so, the module
+-	  will be called x1205.
+-
+ endmenu
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-sysfs.c	2006-02-06 23:56:37.000000000 +0100
-@@ -0,0 +1,113 @@
++++ linux-rtc/drivers/rtc/rtc-sysfs.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,120 @@
 +/*
 + * RTC subsystem, sysfs interface
 + *
@@ -1059,8 +2365,7 @@
 +
 +static ssize_t rtc_sysfs_show_date(struct class_device *dev, char *buf)
 +{
-+	ssize_t retval = -ENODEV;
-+	struct rtc_device *rtc = to_rtc_device(dev);
++	ssize_t retval;
 +	struct rtc_time tm;
 +
 +	if ((retval = rtc_read_time(dev, &tm)) == 0) {
@@ -1074,8 +2379,7 @@
 +
 +static ssize_t rtc_sysfs_show_time(struct class_device *dev, char *buf)
 +{
-+	ssize_t retval = -ENODEV;
-+	struct rtc_device *rtc = to_rtc_device(dev);
++	ssize_t retval;
 +	struct rtc_time tm;
 +
 +	if ((retval = rtc_read_time(dev, &tm)) == 0) {
@@ -1089,8 +2393,7 @@
 +
 +static ssize_t rtc_sysfs_show_since_epoch(struct class_device *dev, char *buf)
 +{
-+	ssize_t retval = -ENODEV;
-+	struct rtc_device *rtc = to_rtc_device(dev);
++	ssize_t retval;
 +	struct rtc_time tm;
 +
 +	if ((retval = rtc_read_time(dev, &tm)) == 0) {
@@ -1103,26 +2406,36 @@
 +}
 +static CLASS_DEVICE_ATTR(since_epoch, S_IRUGO, rtc_sysfs_show_since_epoch, NULL);
 +
-+/* insertion/removal hooks */
++static struct attribute *rtc_attrs[] = {
++        &class_device_attr_name.attr,
++        &class_device_attr_date.attr,
++        &class_device_attr_time.attr,
++        &class_device_attr_since_epoch.attr,
++        NULL,
++};
++
++static struct attribute_group rtc_attr_group = {
++        .attrs  = rtc_attrs,
++};
 +
 +static int __devinit rtc_sysfs_add_device(struct class_device *class_dev,
 +					   struct class_interface *class_intf)
 +{
-+	class_device_create_file(class_dev, &class_device_attr_name);
-+	class_device_create_file(class_dev, &class_device_attr_date);
-+	class_device_create_file(class_dev, &class_device_attr_time);
-+	class_device_create_file(class_dev, &class_device_attr_since_epoch);
++	int err;
++
 +	dev_info(class_dev->dev, "rtc intf: sysfs\n");
-+	return 0;
++
++	if ((err = sysfs_create_group(&class_dev->kobj, &rtc_attr_group)) != 0)
++		dev_err(class_dev->dev,
++			"failed to create sysfs attributes\n");
++
++	return err;
 +}
 +
 +static void rtc_sysfs_remove_device(struct class_device *class_dev,
 +				      struct class_interface *class_intf)
 +{
-+	class_device_remove_file(class_dev, &class_device_attr_name);
-+	class_device_remove_file(class_dev, &class_device_attr_date);
-+	class_device_remove_file(class_dev, &class_device_attr_time);
-+	class_device_remove_file(class_dev, &class_device_attr_since_epoch);
++	sysfs_remove_group(&class_dev->kobj, &rtc_attr_group);
 +}
 +
 +/* interface registration */
@@ -1149,7 +2462,7 @@
 +MODULE_DESCRIPTION("RTC class sysfs interface");
 +MODULE_LICENSE("GPL");
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-proc.c	2006-02-06 23:58:32.000000000 +0100
++++ linux-rtc/drivers/rtc/rtc-proc.c	2006-02-21 00:36:43.000000000 +0100
 @@ -0,0 +1,158 @@
 +/*
 + * RTC subsystem, proc interface
@@ -1170,7 +2483,7 @@
 +#include <linux/seq_file.h>
 +
 +static struct class_device *rtc_dev = NULL;
-+static DECLARE_MUTEX(rtc_sem);
++static DEFINE_MUTEX(rtc_lock);
 +
 +static int rtc_proc_show(struct seq_file *seq, void *offset)
 +{
@@ -1254,7 +2567,7 @@
 +static int rtc_proc_add_device(struct class_device *class_dev,
 +					   struct class_interface *class_intf)
 +{
-+	down(&rtc_sem);
++	mutex_lock(&rtc_lock);
 +	if (rtc_dev == NULL) {
 +		struct proc_dir_entry *ent;
 +
@@ -1272,7 +2585,7 @@
 +		else
 +			rtc_dev = NULL;
 +	}
-+	up(&rtc_sem);
++	mutex_unlock(&rtc_lock);
 +
 +	return 0;
 +}
@@ -1280,12 +2593,12 @@
 +static void rtc_proc_remove_device(struct class_device *class_dev,
 +					      struct class_interface *class_intf)
 +{
-+	down(&rtc_sem);
++	mutex_lock(&rtc_lock);
 +	if (rtc_dev == class_dev) {
 +		remove_proc_entry("driver/rtc", NULL);
 +		rtc_dev = NULL;
 +	}
-+	up(&rtc_sem);
++	mutex_unlock(&rtc_lock);
 +}
 +
 +struct class_interface rtc_proc_interface = {
@@ -1310,8 +2623,8 @@
 +MODULE_DESCRIPTION("RTC class proc interface");
 +MODULE_LICENSE("GPL");
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-dev.c	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,366 @@
++++ linux-rtc/drivers/rtc/rtc-dev.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,370 @@
 +/*
 + * RTC subsystem, dev interface
 + *
@@ -1342,7 +2655,7 @@
 +	/* We keep the lock as long as the device is in use
 +	 * and return immediately if busy
 +	 */
-+	if (down_trylock(&rtc->char_sem))
++	if (!(mutex_trylock(&rtc->char_lock)))
 +		return -EBUSY;
 +
 +	file->private_data = &rtc->class_dev;
@@ -1358,7 +2671,7 @@
 +	}
 +
 +	/* something has gone wrong, release the lock */
-+	up(&rtc->char_sem);
++	mutex_unlock(&rtc->char_lock);
 +	return err;
 +}
 +
@@ -1402,6 +2715,10 @@
 +	remove_wait_queue(&rtc->irq_queue, &wait);
 +
 +	if (ret == 0) {
++		/* Check for any data updates */
++		if (rtc->ops->read_callback)
++			data = rtc->ops->read_callback(rtc->class_dev.dev, data);
++
 +		ret = put_user(data, (unsigned long __user *)buf);
 +		if (ret == 0)
 +			ret = sizeof(unsigned long);
@@ -1549,7 +2866,7 @@
 +	if (rtc->ops->release)
 +		rtc->ops->release(rtc->class_dev.dev);
 +
-+	up(&rtc->char_sem);
++	mutex_unlock(&rtc->char_lock);
 +	return 0;
 +}
 +
@@ -1588,7 +2905,7 @@
 +		return -EINVAL;
 +	}
 +
-+	init_MUTEX(&rtc->char_sem);
++	mutex_init(&rtc->char_lock);
 +	spin_lock_init(&rtc->irq_lock);
 +	init_waitqueue_head(&rtc->irq_queue);
 +
@@ -1679,16 +2996,16 @@
 +MODULE_DESCRIPTION("RTC class dev interface");
 +MODULE_LICENSE("GPL");
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-x1205.c	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,672 @@
++++ linux-rtc/drivers/rtc/rtc-x1205.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,619 @@
 +/*
 + * An i2c driver for the Xicor/Intersil X1205 RTC
 + * Copyright 2004 Karen Spearel
 + * Copyright 2005 Alessandro Zummo
 + *
 + * please send all reports to:
-+ *	kas11 at tampabay dot rr dot com
-+ *	a dot zummo at towertech dot it
++ * 	Karen Spearel <kas111 at gmail dot com>
++ *	Alessandro Zummo <a.zummo@towertech.it>
 + *
 + * based on a lot of other RTC drivers.
 + *
@@ -1698,17 +3015,12 @@
 + * (at your option) any later version.
 + */
 +
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/slab.h>
-+#include <linux/err.h>
 +#include <linux/i2c.h>
-+#include <linux/string.h>
 +#include <linux/bcd.h>
 +#include <linux/rtc.h>
 +#include <linux/delay.h>
 +
-+#define DRV_VERSION "1.0.5"
++#define DRV_VERSION "1.0.6"
 +
 +/* Addresses to scan: none. This chip is located at
 + * 0x6f and uses a two bytes register addressing.
@@ -1900,14 +3212,12 @@
 +	}
 +
 +	/* this sequence is required to unlock the chip */
-+	xfer = i2c_master_send(client, wel, 3);
-+	if (xfer != 3) {
++	if ((xfer = i2c_master_send(client, wel, 3)) != 3) {
 +		dev_err(&client->dev, "%s: wel - %d\n", __FUNCTION__, xfer);
 +		return -EIO;
 +	}
 +
-+	xfer = i2c_master_send(client, rwel, 3);
-+	if (xfer != 3) {
++	if ((xfer = i2c_master_send(client, rwel, 3)) != 3) {
 +		dev_err(&client->dev, "%s: rwel - %d\n", __FUNCTION__, xfer);
 +		return -EIO;
 +	}
@@ -1927,8 +3237,7 @@
 +	};
 +
 +	/* disable further writes */
-+	xfer = i2c_master_send(client, diswe, 3);
-+	if (xfer != 3) {
++	if ((xfer = i2c_master_send(client, diswe, 3)) != 3) {
 +		dev_err(&client->dev, "%s: diswe - %d\n", __FUNCTION__, xfer);
 +		return -EIO;
 +	}
@@ -1941,13 +3250,11 @@
 +	int err;
 +	struct rtc_time tm;
 +
-+	tm.tm_hour = 0;
-+	tm.tm_min = 0;
-+	tm.tm_sec = 0;
++	tm.tm_hour = tm.tm_min = tm.tm_sec = 0;
 +
 +	if ((err = x1205_set_datetime(client, &tm, 0, X1205_CCR_BASE)) < 0)
 +		dev_err(&client->dev,
-+			"unable to restart the clock\n");
++			"unable to restart the oscillator\n");
 +
 +	return err;
 +}
@@ -2020,10 +3327,7 @@
 +
 +struct x1205_limit
 +{
-+	unsigned char reg;
-+	unsigned char mask;
-+	unsigned char min;
-+	unsigned char max;
++	unsigned char reg, mask, min, max;
 +};
 +
 +static int x1205_validate_client(struct i2c_client *client)
@@ -2067,11 +3371,10 @@
 +			{ client->addr, I2C_M_RD, 1, &buf },
 +		};
 +
-+		xfer = i2c_transfer(client->adapter, msgs, 2);
-+		if (xfer != 2) {
++		if ((xfer = i2c_transfer(client->adapter, msgs, 2)) != 2) {
 +			dev_err(&client->adapter->dev,
 +				"%s: could not read register %x\n",
-+				__FUNCTION__, addr[1]);
++				__FUNCTION__,  probe_zero_pattern[i]);
 +
 +			return -EIO;
 +		}
@@ -2079,7 +3382,7 @@
 +		if ((buf & probe_zero_pattern[i+1]) != 0) {
 +			dev_err(&client->adapter->dev,
 +				"%s: register=%02x, zero pattern=%d, value=%x\n",
-+				__FUNCTION__, addr[1], i, buf);
++				__FUNCTION__, probe_zero_pattern[i], i, buf);
 +
 +			return -ENODEV;
 +		}
@@ -2096,12 +3399,10 @@
 +			{ client->addr, I2C_M_RD, 1, &reg },
 +		};
 +
-+		xfer = i2c_transfer(client->adapter, msgs, 2);
-+
-+		if (xfer != 2) {
++		if ((xfer = i2c_transfer(client->adapter, msgs, 2)) != 2) {
 +			dev_err(&client->adapter->dev,
 +				"%s: could not read register %x\n",
-+				__FUNCTION__, addr[1]);
++				__FUNCTION__, probe_limits_pattern[i].reg);
 +
 +			return -EIO;
 +		}
@@ -2112,7 +3413,8 @@
 +			value < probe_limits_pattern[i].min) {
 +			dev_dbg(&client->adapter->dev,
 +				"%s: register=%x, lim pattern=%d, value=%d\n",
-+				__FUNCTION__, addr[1], i, value);
++				__FUNCTION__, probe_limits_pattern[i].reg,
++				i, value);
 +
 +			return -ENODEV;
 +		}
@@ -2121,87 +3423,51 @@
 +	return 0;
 +}
 +
-+static int x1205_rtc_read_alarm(struct device *dev,
-+	struct rtc_wkalrm *alrm)
++static int x1205_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
 +{
 +	return x1205_get_datetime(to_i2c_client(dev),
 +		&alrm->time, X1205_ALM0_BASE);
 +}
 +
-+static int x1205_rtc_set_alarm(struct device *dev,
-+	struct rtc_wkalrm *alrm)
++static int x1205_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
 +{
 +	return x1205_set_datetime(to_i2c_client(dev),
 +		&alrm->time, 1, X1205_ALM0_BASE);
 +}
 +
-+static int x1205_rtc_read_time(struct device *dev,
-+	struct rtc_time *tm)
++static int x1205_rtc_read_time(struct device *dev, struct rtc_time *tm)
 +{
 +	return x1205_get_datetime(to_i2c_client(dev),
 +		tm, X1205_CCR_BASE);
 +}
 +
-+static int x1205_rtc_set_time(struct device *dev,
-+	struct rtc_time *tm)
++static int x1205_rtc_set_time(struct device *dev, struct rtc_time *tm)
 +{
 +	return x1205_set_datetime(to_i2c_client(dev),
 +		tm, 1, X1205_CCR_BASE);
 +}
 +
-+static int x1205_rtc_set_mmss(struct device *dev, unsigned long secs)
-+{
-+	int err;
-+
-+	struct rtc_time new_tm, old_tm;
-+
-+	if ((err = x1205_rtc_read_time(dev, &old_tm) == 0))
-+		return err;
-+
-+	/* FIXME      xtime.tv_nsec = old_tm.tm_sec * 10000000; */
-+	new_tm.tm_sec  = secs % 60;
-+	secs /= 60;
-+	new_tm.tm_min  = secs % 60;
-+	secs /= 60;
-+	new_tm.tm_hour = secs % 24;
-+
-+       /*
-+	* avoid writing when we're going to change the day
-+	* of the month.  We will retry in the next minute.
-+	* This basically means that if the RTC must not drift
-+	* by more than 1 minute in 11 minutes.
-+	*/
-+	if ((old_tm.tm_hour == 23 && old_tm.tm_min == 59) ||
-+	    (new_tm.tm_hour == 23 && new_tm.tm_min == 59))
-+		return 1;
-+
-+	return x1205_rtc_set_time(dev, &new_tm);
-+}
-+
 +static int x1205_rtc_proc(struct device *dev, struct seq_file *seq)
 +{
 +	int err, dtrim, atrim;
 +
 +	seq_printf(seq, "24hr\t\t: yes\n");
 +
-+	err = x1205_get_dtrim(to_i2c_client(dev), &dtrim);
-+	if (err == 0)
++	if ((err = x1205_get_dtrim(to_i2c_client(dev), &dtrim)) == 0)
 +		seq_printf(seq, "digital_trim\t: %d ppm\n", dtrim);
 +
-+	err = x1205_get_atrim(to_i2c_client(dev), &atrim);
-+	if (err == 0)
++	if ((err = x1205_get_atrim(to_i2c_client(dev), &atrim)) == 0)
 +		seq_printf(seq, "analog_trim\t: %d.%02d pF\n",
 +			atrim / 1000, atrim % 1000);
 +	return 0;
 +}
 +
 +static struct rtc_class_ops x1205_rtc_ops = {
-+	.proc = x1205_rtc_proc,
-+	.read_time = x1205_rtc_read_time,
-+	.set_time = x1205_rtc_set_time,
-+	.read_alarm = x1205_rtc_read_alarm,
-+	.set_alarm = x1205_rtc_set_alarm,
-+	.set_mmss = x1205_rtc_set_mmss,
++	.proc		= x1205_rtc_proc,
++	.read_time	= x1205_rtc_read_time,
++	.set_time	= x1205_rtc_set_time,
++	.read_alarm	= x1205_rtc_read_alarm,
++	.set_alarm	= x1205_rtc_set_alarm,
 +};
 +
 +static ssize_t x1205_sysfs_show_atrim(struct device *dev,
@@ -2209,10 +3475,10 @@
 +{
 +	int atrim;
 +
-+        if (x1205_get_atrim(to_i2c_client(dev), &atrim) == 0) {
-+                return sprintf(buf, "%d.%02d pF\n",
-+                        atrim / 1000, atrim % 1000);        }
-+        return 0;
++	if (x1205_get_atrim(to_i2c_client(dev), &atrim) == 0)
++		return sprintf(buf, "%d.%02d pF\n",
++			atrim / 1000, atrim % 1000);
++	return 0;
 +}
 +static DEVICE_ATTR(atrim, S_IRUGO, x1205_sysfs_show_atrim, NULL);
 +
@@ -2221,18 +3487,16 @@
 +{
 +	int dtrim;
 +
-+        if (x1205_get_dtrim(to_i2c_client(dev), &dtrim) == 0) {
-+                return sprintf(buf, "%d ppm\n", dtrim);
-+        }
-+        return 0;
++	if (x1205_get_dtrim(to_i2c_client(dev), &dtrim) == 0)
++		return sprintf(buf, "%d ppm\n", dtrim);
++
++	return 0;
 +}
 +static DEVICE_ATTR(dtrim, S_IRUGO, x1205_sysfs_show_dtrim, NULL);
 +
-+
 +static int x1205_attach(struct i2c_adapter *adapter)
 +{
 +	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
-+
 +	return i2c_probe(adapter, &addr_data, x1205_probe);
 +}
 +
@@ -2345,7 +3609,7 @@
 +}
 +
 +MODULE_AUTHOR(
-+	"Karen Spearel <kas11@tampabay.rr.com>, "
++	"Karen Spearel <kas111 at gmail dot com>, "
 +	"Alessandro Zummo <a.zummo@towertech.it>");
 +MODULE_DESCRIPTION("Xicor/Intersil X1205 RTC driver");
 +MODULE_LICENSE("GPL");
@@ -2354,7 +3618,7 @@
 +module_init(x1205_init);
 +module_exit(x1205_exit);
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-test.c	2006-02-06 23:58:32.000000000 +0100
++++ linux-rtc/drivers/rtc/rtc-test.c	2006-02-21 00:36:43.000000000 +0100
 @@ -0,0 +1,206 @@
 +/*
 + * An RTC test device/driver
@@ -2563,8 +3827,8 @@
 +module_init(test_init);
 +module_exit(test_exit);
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-ds1672.c	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,234 @@
++++ linux-rtc/drivers/rtc/rtc-ds1672.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,233 @@
 +/*
 + * An rtc/i2c driver for the Dallas DS1672
 + * Copyright 2005 Alessandro Zummo
@@ -2689,15 +3953,14 @@
 +}
 +
 +static struct rtc_class_ops ds1672_rtc_ops = {
-+	.read_time = ds1672_rtc_read_time,
-+	.set_time = ds1672_rtc_set_time,
-+	.set_mmss = ds1672_rtc_set_mmss,
++	.read_time	= ds1672_rtc_read_time,
++	.set_time	= ds1672_rtc_set_time,
++	.set_mmss	= ds1672_rtc_set_mmss,
 +};
 +
 +static int ds1672_attach(struct i2c_adapter *adapter)
 +{
 +	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
-+
 +	return i2c_probe(adapter, &addr_data, ds1672_probe);
 +}
 +
@@ -2800,8 +4063,8 @@
 +module_init(ds1672_init);
 +module_exit(ds1672_exit);
 --- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/rtc/rtc-pcf8563.c	2006-02-06 23:58:32.000000000 +0100
-@@ -0,0 +1,384 @@
++++ linux-rtc/drivers/rtc/rtc-pcf8563.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,355 @@
 +/*
 + * An I2C driver for the Philips PCF8563 RTC
 + * Copyright 2005-06 Tower Technologies
@@ -2819,15 +4082,18 @@
 + * (at your option) any later version.
 + */
 +
-+#include <linux/module.h>
 +#include <linux/i2c.h>
 +#include <linux/bcd.h>
 +#include <linux/rtc.h>
 +
-+#define DRV_VERSION "0.4.0"
++#define DRV_VERSION "0.4.2"
 +
-+/* Addresses to scan */
-+static unsigned short normal_i2c[] = { 0x51, I2C_CLIENT_END };
++/* Addresses to scan: none
++ * This chip cannot be reliably autodetected. An empty eeprom
++ * located at 0x51 will pass the validation routine due to
++ * the way the registers are implemented.
++ */
++static unsigned short normal_i2c[] = { I2C_CLIENT_END };
 +
 +/* Module parameters */
 +I2C_CLIENT_INSMOD;
@@ -2874,11 +4140,10 @@
 + */
 +static int pcf8563_get_datetime(struct i2c_client *client, struct rtc_time *tm)
 +{
-+	unsigned char buf[13];
-+	unsigned char addr = PCF8563_REG_ST1;
++	unsigned char buf[13] = { PCF8563_REG_ST1 };
 +
 +	struct i2c_msg msgs[] = {
-+		{ client->addr, 0, 1, &addr },	/* setup read ptr */
++		{ client->addr, 0, 1, buf },	/* setup read ptr */
 +		{ client->addr, I2C_M_RD, 13, buf },	/* read status + date */
 +	};
 +
@@ -2980,46 +4245,48 @@
 +
 +static int pcf8563_validate_client(struct i2c_client *client)
 +{
-+	int i, xfer;
++	int i;
 +
-+	static const struct pcf8563_limit probe_limits_pattern[] = {
++	static const struct pcf8563_limit pattern[] = {
 +		/* register, mask, min, max */
 +		{ PCF8563_REG_SC,	0x7F,	0,	59	},
 +		{ PCF8563_REG_MN,	0x7F,	0,	59	},
 +		{ PCF8563_REG_HR,	0x3F,	0,	23	},
 +		{ PCF8563_REG_DM,	0x3F,	0,	31	},
 +		{ PCF8563_REG_MO,	0x1F,	0,	12	},
-+		{ PCF8563_REG_YR,	0xFF,	0,	99	},
 +	};
 +
 +	/* check limits (only registers with bcd values) */
-+	for (i = 0; i < ARRAY_SIZE(probe_limits_pattern); i++) {
-+		unsigned char addr, buf, value;
++	for (i = 0; i < ARRAY_SIZE(pattern); i++) {
++		int xfer;
++		unsigned char value;
++		unsigned char buf = pattern[i].reg;
 +
-+		addr = probe_limits_pattern[i].reg;
-+
-+		struct i2c_msg msgs[2] = {
-+			{ client->addr, 0, 2, &addr },
++		struct i2c_msg msgs[] = {
++			{ client->addr, 0, 1, &buf },
 +			{ client->addr, I2C_M_RD, 1, &buf },
 +		};
 +
-+		xfer = i2c_transfer(client->adapter, msgs, 2);
++		xfer = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 +
-+		if (xfer != 2) {
++		if (xfer != ARRAY_SIZE(msgs)) {
 +			dev_err(&client->adapter->dev,
-+				"%s: could not read register %x\n",
-+				__FUNCTION__, probe_limits_pattern[i].reg);
++				"%s: could not read register 0x%02X\n",
++				__FUNCTION__, pattern[i].reg);
 +
 +			return -EIO;
 +		}
 +
-+		value = BCD2BIN(buf & probe_limits_pattern[i].mask);
++		value = BCD2BIN(buf & pattern[i].mask);
 +
-+		if (value > probe_limits_pattern[i].max ||
-+			value < probe_limits_pattern[i].min) {
++		if (value > pattern[i].max ||
++			value < pattern[i].min) {
 +			dev_dbg(&client->adapter->dev,
-+				"%s: register=%x, lim pattern=%d, value=%d\n",
-+				__FUNCTION__, probe_limits_pattern[i].reg, i, value);
++				"%s: pattern=%d, reg=%x, mask=0x%02x, min=%d, "
++				"max=%d, value=%d, raw=0x%02X\n",
++				__FUNCTION__, i, pattern[i].reg, pattern[i].mask,
++				pattern[i].min, pattern[i].max,
++				value, buf);
 +
 +			return -ENODEV;
 +		}
@@ -3028,47 +4295,16 @@
 +	return 0;
 +}
 +
-+static int pcf8563_rtc_read_time(struct device *dev,
-+	struct rtc_time *tm)
++static int pcf8563_rtc_read_time(struct device *dev, struct rtc_time *tm)
 +{
 +	return pcf8563_get_datetime(to_i2c_client(dev), tm);
 +}
 +
-+static int pcf8563_rtc_set_time(struct device *dev,
-+	struct rtc_time *tm)
++static int pcf8563_rtc_set_time(struct device *dev, struct rtc_time *tm)
 +{
 +	return pcf8563_set_datetime(to_i2c_client(dev), tm);
 +}
 +
-+static int pcf8563_rtc_set_mmss(struct device *dev, unsigned long secs)
-+{
-+	int err;
-+
-+	struct rtc_time new_tm, old_tm;
-+
-+	if ((err = pcf8563_rtc_read_time(dev, &old_tm) == 0))
-+		return err;
-+
-+	/* FIXME      xtime.tv_nsec = old_tm.tm_sec * 10000000; */
-+	new_tm.tm_sec  = secs % 60;
-+	secs /= 60;
-+	new_tm.tm_min  = secs % 60;
-+	secs /= 60;
-+	new_tm.tm_hour = secs % 24;
-+
-+       /*
-+	* avoid writing when we're going to change the day
-+	* of the month.  We will retry in the next minute.
-+	* This basically means that if the RTC must not drift
-+	* by more than 1 minute in 11 minutes.
-+	*/
-+	if ((old_tm.tm_hour == 23 && old_tm.tm_min == 59) ||
-+	    (new_tm.tm_hour == 23 && new_tm.tm_min == 59))
-+		return 1;
-+
-+	return pcf8563_rtc_set_time(dev, &new_tm);
-+}
-+
 +static int pcf8563_rtc_proc(struct device *dev, struct seq_file *seq)
 +{
 +	seq_printf(seq, "24hr\t\t: yes\n");
@@ -3076,10 +4312,9 @@
 +}
 +
 +static struct rtc_class_ops pcf8563_rtc_ops = {
-+	.proc = pcf8563_rtc_proc,
-+	.read_time = pcf8563_rtc_read_time,
-+	.set_time = pcf8563_rtc_set_time,
-+	.set_mmss = pcf8563_rtc_set_mmss,
++	.proc		= pcf8563_rtc_proc,
++	.read_time	= pcf8563_rtc_read_time,
++	.set_time	= pcf8563_rtc_set_time,
 +};
 +
 +static int pcf8563_attach(struct i2c_adapter *adapter)
@@ -3185,4 +4420,301 @@
 +
 +module_init(pcf8563_init);
 +module_exit(pcf8563_exit);
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-rtc/drivers/rtc/rtc-rs5c372.c	2006-02-21 00:36:43.000000000 +0100
+@@ -0,0 +1,295 @@
++/*
++ * An I2C driver for the Ricoh RS5C372 RTC
++ *
++ * Copyright (C) 2005 Pavel Mironchik pmironchik@optifacio.net
++ * Copyright (C) 2006 Tower Technologies
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
 +
++#include <linux/i2c.h>
++#include <linux/rtc.h>
++#include <linux/bcd.h>
++
++#define DRV_VERSION "0.2"
++
++/* Addresses to scan */
++static unsigned short normal_i2c[] = { /* 0x32,*/ I2C_CLIENT_END };
++
++/* Insmod parameters */
++I2C_CLIENT_INSMOD;
++
++#define RS5C372_REG_SECS	0
++#define RS5C372_REG_MINS	1
++#define RS5C372_REG_HOURS	2
++#define RS5C372_REG_WDAY	3
++#define RS5C372_REG_DAY		4
++#define RS5C372_REG_MONTH	5
++#define RS5C372_REG_YEAR	6
++#define RS5C372_REG_TRIM	7
++
++#define RS5C372_TRIM_XSL	0x80
++#define RS5C372_TRIM_MASK	0x7F
++
++#define RS5C372_REG_BASE	0
++
++static int rs5c372_attach(struct i2c_adapter *adapter);
++static int rs5c372_detach(struct i2c_client *client);
++static int rs5c372_probe(struct i2c_adapter *adapter, int address, int kind);
++
++static struct i2c_driver rs5c372_driver = {
++	.driver		= {
++		.name	= "rs5c372",
++	},
++	.attach_adapter	= &rs5c372_attach,
++	.detach_client	= &rs5c372_detach,
++};
++
++static int rs5c372_get_datetime(struct i2c_client *client, struct rtc_time *tm)
++{
++	unsigned char buf[7] = { RS5C372_REG_BASE };
++
++	/* this implements the 1st reading method, according
++	 * to the datasheet. buf[0] is initialized with
++	 * address ptr and transmission format register.
++	 */
++	struct i2c_msg msgs[] = {
++		{ client->addr, 0, 1, buf },
++		{ client->addr, I2C_M_RD, 7, buf },
++	};
++
++	if ((i2c_transfer(client->adapter, msgs, 2)) != 2) {
++		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
++		return -EIO;
++	}
++
++	tm->tm_sec = BCD2BIN(buf[RS5C372_REG_SECS] & 0x7f);
++	tm->tm_min = BCD2BIN(buf[RS5C372_REG_MINS] & 0x7f);
++	tm->tm_hour = BCD2BIN(buf[RS5C372_REG_HOURS] & 0x3f);
++	tm->tm_wday = BCD2BIN(buf[RS5C372_REG_WDAY] & 0x07);
++	tm->tm_mday = BCD2BIN(buf[RS5C372_REG_DAY] & 0x3f);
++
++	/* tm->tm_mon is zero-based */
++	tm->tm_mon = BCD2BIN(buf[RS5C372_REG_MONTH] & 0x1f) - 1;
++
++	/* year is 1900 + tm->tm_year */
++	tm->tm_year = BCD2BIN(buf[RS5C372_REG_YEAR]) + 100;
++
++	dev_dbg(&client->dev, "%s: tm is secs=%d, mins=%d, hours=%d, "
++		"mday=%d, mon=%d, year=%d, wday=%d\n",
++		__FUNCTION__,
++		tm->tm_sec, tm->tm_min, tm->tm_hour,
++		tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday);
++
++	return 0;
++}
++
++static int rs5c372_set_datetime(struct i2c_client *client, struct rtc_time *tm)
++{
++	unsigned char buf[8] = { RS5C372_REG_BASE };
++
++	dev_dbg(&client->dev,
++		"%s: secs=%d, mins=%d, hours=%d ",
++		"mday=%d, mon=%d, year=%d, wday=%d\n",
++		__FUNCTION__, tm->tm_sec, tm->tm_min, tm->tm_hour,
++		tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday);
++
++	buf[1] = BIN2BCD(tm->tm_sec);
++	buf[2] = BIN2BCD(tm->tm_min);
++	buf[3] = BIN2BCD(tm->tm_hour);
++	buf[4] = BIN2BCD(tm->tm_wday);
++	buf[5] = BIN2BCD(tm->tm_mday);
++	buf[6] = BIN2BCD(tm->tm_mon + 1);
++	buf[7] = BIN2BCD(tm->tm_year - 100);
++
++	if ((i2c_master_send(client, buf, 8)) != 8) {
++		dev_err(&client->dev, "%s: write error\n", __FUNCTION__);
++		return -EIO;
++	}
++
++	return 0;
++}
++
++static int rs5c372_get_trim(struct i2c_client *client, int *osc, int *trim)
++{
++	unsigned char buf = RS5C372_REG_TRIM;
++
++	struct i2c_msg msgs[] = {
++		{ client->addr, 0, 1, &buf },
++		{ client->addr, I2C_M_RD, 1, &buf },
++	};
++
++	if ((i2c_transfer(client->adapter, msgs, 2)) != 2) {
++		dev_err(&client->dev, "%s: read error\n", __FUNCTION__);
++		return -EIO;
++	}
++
++	dev_dbg(&client->dev, "%s: raw trim=%x\n", __FUNCTION__, trim);
++
++	if (osc)
++		*osc = (buf & RS5C372_TRIM_XSL) ? 32000 : 32768;
++
++	if (trim)
++		*trim = buf & RS5C372_TRIM_MASK;
++
++	return 0;
++}
++
++static int rs5c372_rtc_read_time(struct device *dev, struct rtc_time *tm)
++{
++	return rs5c372_get_datetime(to_i2c_client(dev), tm);
++}
++
++static int rs5c372_rtc_set_time(struct device *dev, struct rtc_time *tm)
++{
++	return rs5c372_set_datetime(to_i2c_client(dev), tm);
++}
++
++static int rs5c372_rtc_proc(struct device *dev, struct seq_file *seq)
++{
++	int err, osc, trim;
++
++	seq_printf(seq, "24hr\t\t: yes\n");
++
++	if ((err = rs5c372_get_trim(to_i2c_client(dev), &osc, &trim)) == 0) {
++		seq_printf(seq, "%d.%03d KHz\n", osc / 1000, osc % 1000);
++		seq_printf(seq, "trim\t: %d\n", trim);
++	}
++
++	return 0;
++}
++
++static struct rtc_class_ops rs5c372_rtc_ops = {
++	.proc		= rs5c372_rtc_proc,
++	.read_time	= rs5c372_rtc_read_time,
++	.set_time	= rs5c372_rtc_set_time,
++};
++
++static ssize_t rs5c372_sysfs_show_trim(struct device *dev,
++				struct device_attribute *attr, char *buf)
++{
++	int trim;
++
++	if (rs5c372_get_trim(to_i2c_client(dev), NULL, &trim) == 0)
++		return sprintf(buf, "0x%2x\n", trim);
++
++	return 0;
++}
++static DEVICE_ATTR(trim, S_IRUGO, rs5c372_sysfs_show_trim, NULL);
++
++static ssize_t rs5c372_sysfs_show_osc(struct device *dev,
++				struct device_attribute *attr, char *buf)
++{
++	int osc;
++
++	if (rs5c372_get_trim(to_i2c_client(dev), &osc, NULL) == 0)
++		return sprintf(buf, "%d.%03d KHz\n", osc / 1000, osc % 1000);
++
++	return 0;
++}
++static DEVICE_ATTR(osc, S_IRUGO, rs5c372_sysfs_show_osc, NULL);
++
++static int rs5c372_attach(struct i2c_adapter *adapter)
++{
++	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
++	return i2c_probe(adapter, &addr_data, rs5c372_probe);
++}
++
++static int rs5c372_probe(struct i2c_adapter *adapter, int address, int kind)
++{
++	int err = 0;
++	struct i2c_client *client;
++	struct rtc_device *rtc;
++
++	dev_dbg(&adapter->dev, "%s\n", __FUNCTION__);
++
++	if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) {
++		err = -ENODEV;
++		goto exit;
++	}
++
++	if (!(client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL))) {
++		err = -ENOMEM;
++		goto exit;
++	}
++
++	/* I2C client */
++	client->addr = address;
++	client->driver = &rs5c372_driver;
++	client->adapter = adapter;
++
++	strlcpy(client->name, rs5c372_driver.driver.name, I2C_NAME_SIZE);
++
++	/* Inform the i2c layer */
++	if ((err = i2c_attach_client(client)))
++		goto exit_kfree;
++
++	dev_info(&client->dev, "chip found, driver version " DRV_VERSION "\n");
++
++	rtc = rtc_device_register(rs5c372_driver.driver.name, &client->dev,
++				&rs5c372_rtc_ops, THIS_MODULE);
++
++	if (IS_ERR(rtc)) {
++		err = PTR_ERR(rtc);
++		dev_err(&client->dev,
++			"unable to register the class device\n");
++		goto exit_detach;
++	}
++
++	i2c_set_clientdata(client, rtc);
++
++	device_create_file(&client->dev, &dev_attr_trim);
++	device_create_file(&client->dev, &dev_attr_osc);
++
++	return 0;
++
++exit_detach:
++	i2c_detach_client(client);
++
++exit_kfree:
++	kfree(client);
++
++exit:
++	return err;
++}
++
++static int rs5c372_detach(struct i2c_client *client)
++{
++	int err;
++	struct rtc_device *rtc = i2c_get_clientdata(client);
++
++	dev_dbg(&client->dev, "%s\n", __FUNCTION__);
++
++	if (rtc)
++		rtc_device_unregister(rtc);
++
++	if ((err = i2c_detach_client(client)))
++		return err;
++
++	kfree(client);
++
++	return 0;
++}
++
++static __init int rs5c372_init(void)
++{
++	return i2c_add_driver(&rs5c372_driver);
++}
++
++static __exit void rs5c372_exit(void)
++{
++	i2c_del_driver(&rs5c372_driver);
++}
++
++module_init(rs5c372_init);
++module_exit(rs5c372_exit);
++
++MODULE_AUTHOR(
++		"Pavel Mironchik <pmironchik@optifacio.net>, "
++		"Alessandro Zummo <a.zummo@towertech.it>");
++MODULE_DESCRIPTION("Ricoh RS5C372 RTC driver");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/91-maclist.patch b/packages/linux/ixp4xx-kernel/2.6.16/91-maclist.patch
index 3915c50cb7..72b9fa9a7d 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/91-maclist.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/91-maclist.patch
@@ -1,38 +1,55 @@
- drivers/net/Kconfig   |   15 ++
- drivers/net/Makefile  |    1 
- drivers/net/maclist.c |  314 ++++++++++++++++++++++++++++++++++++++++++++++++++
- include/net/maclist.h |   23 +++
- 4 files changed, 353 insertions(+)
+Ethernet MAC repository.
 
---- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/include/net/maclist.h	2006-02-06 22:35:23.000000000 +0100
-@@ -0,0 +1,23 @@
-+#ifndef _MACLIST_H
-+#define _MACLIST_H 1
-+/*
-+ * Interfaces to the MAC repository
-+ */
-+/*
-+ * Add a single entry, returns 0 on success else an error
-+ * code.  Must *not* be called from an interrupt handler.
-+ */
-+extern int maclist_add(const u8 id_to_add[6]);
-+
-+/*
-+ * Return the current entry count (valid in any context).
-+ */
-+extern int maclist_count(void);
-+
-+/*
-+ * Return the ID from the n'th entry (valid in any context),
-+ * returns 0 on success, -EINVAL if 'n' is out of range.
-+ */
-+extern int maclist_read(u8 (*buffer_for_id)[6], int index_of_id_to_return);
+Some ethernet controllers have no built-in way of obtaining an
+appropriate Ethernet MAC address.  Such controllers have to be
+initialised in a board-specific way, depending on how the allocated
+MAC is stored.  The MAC repository provides a set of APIs and a
+proc entry (/proc/net/maclist) to store MAC values from the board
+so that such drivers can obtain a MAC address without board-specific
+code.
+
+Signed-off-by: John Bowler <jbowler@acm.org>
+
+diff -rup linux-2.6.15.1/.pc/91-maclist.patch/drivers/net/Kconfig linux-2.6.15.1/drivers/net/Kconfig
+--- linux-2.6.15/drivers/net/Kconfig	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/net/Kconfig	1970-01-01 00:00:00.000000000 +0000
+@@ -166,6 +166,21 @@ config NET_ETHERNET
+ 	  kernel: saying N will just cause the configurator to skip all
+ 	  the questions about Ethernet network cards. If unsure, say N.
+ 
++config MACLIST
++	tristate "Ethernet MAC repository"
++	depends on NET_ETHERNET
++	help
++	  Some ethernet controllers have no built-in way of obtaining an
++	  appropriate Ethernet MAC address.  Such controllers have to be
++	  initialised in a board-specific way, depending on how the allocated
++	  MAC is stored.  The MAC repository provides a set of APIs and a
++	  proc entry (/proc/net/maclist) to store MAC values from the board
++	  so that such drivers can obtain a MAC address without board-specific
++	  code.  You do not need to enable this device - it will be selected
++	  automatically by any device which requires it.  It is only useful
++	  to enable it manually when building a device driver independently
++	  of the kernel build.
 +
-+#endif /*_MACLIST_H*/
---- /dev/null	1970-01-01 00:00:00.000000000 +0000
-+++ linux-nslu2/drivers/net/maclist.c	2006-02-06 22:35:23.000000000 +0100
-@@ -0,0 +1,314 @@
+ config MII
+ 	tristate "Generic Media Independent Interface device support"
+ 	depends on NET_ETHERNET
+diff -rup linux-2.6.15.1/.pc/91-maclist.patch/drivers/net/Makefile linux-2.6.15.1/drivers/net/Makefile
+--- linux-2.6.15/drivers/net/Makefile	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/net/Makefile	1970-01-01 00:00:00.000000000 +0000
+@@ -70,6 +70,7 @@ obj-$(CONFIG_RIONET) += rionet.o
+ # end link order section
+ #
+ 
++obj-$(CONFIG_MACLIST) += maclist.o
+ obj-$(CONFIG_MII) += mii.o
+ obj-$(CONFIG_PHYLIB) += phy/
+ 
+diff -rup linux-2.6.15.1/.pc/91-maclist.patch/drivers/net/maclist.c linux-2.6.15.1/drivers/net/maclist.c
+--- linux-2.6.15/drivers/net/maclist.c	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/net/maclist.c	1970-01-01 00:00:00.000000000 +0000
+@@ -0,0 +1,465 @@
 +/*
 + * drivers/net/maclist.c
 + *
@@ -61,15 +78,70 @@
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
 + * version 2 as published by the Free Software Foundation.
-+ *
++ */
++
++/*
 + * External interfaces:
 + *  Interfaces to linux kernel (and modules)
-+ *   maclist_add:   add a single MAC
++ *   maclist_add:   add a single MAC, sequenced with a single
++ *                  writer lock (reads may happen simultaneously
++ *                  because of the way the list is built)
 + *   maclist_count: total number of MACs stored
-+ *   maclist_read:  read a MAC 0..(maclist_count-1)
++ *   maclist_read:  read a MAC 0..(maclist_count-1).  Call this
++ *                  to get a specific MAC.  If the argument is
++ *                  a new key and all the allocaed MACs have been
++ *                  assigned a random but valid MAC will be return
++ *                  (and this will be stored for later retrieval
++ *                  under the given key.)
++ *
++ * Sequencing:
++ *  The MAC ids must be added before any driver tries to use them
++ *  (this is obvious isn't it?)  This can be made to happen by
++ *  sequencing the initcalls correctly.  The module or kernel
++ *  parameters have been handled before any init call happens.
++ *  The important trick here is to ensure that the platform
++ *  initialises any devices with MAC ids *before* any devices
++ *  which might use them.
++ *
++ *  When this code is a module any other module which adds a
++ *  MAC should be modprobed before modules for ethernet
++ *  devices.
++ *
++ *  The failure case is 'soft' - the device will get a valid, but
++ *  random, MAC and the real allocated MACs will never get used.
++ *  This can be seen by looking at the list of ids in sysfs (there
++ *  will be extra, random, ones after the allocated ones).
++ *
++ * Recommendations:
++ *  For ethernet drivers which are known to be the sole driver on
++ *  the board (without a built in MAC) and where the number of
++ *  devices driven is known simply use an index 0..(n-1) as a
++ *  key for each of the n devices.
++ *
++ *  This is the common case, it works where one driver handles
++ *  multiple devices so long as the total number of devices can
++ *  be determined reliably.  It is sufficient merely to maintain
++ *  a global count of the number of devices initialised so far,
++ *  just so long as the initialisation order is consistent.
++ *
++ *  When the driver is generic and the board may be populated with
++ *  other devices which allocate MACs from the maclist pool and
++ *  use different drivers create a random key and compile this into
++ *  the code.  Use this as the base for all devices from the driver
++ *  (using a global device count for this driver if necessary).
++ *
++ *  With the second strategy the assignment of MACs will depend on
++ *  the order of initialisation of the different drivers.  To avoid
++ *  this provide a kernel (or module) command line parameter to
++ *  specify a base index and (optional) count for each driver or
++ *  pass in a (struct resource) with the start and end of the keys
++ *  to pass to maclist_read.  Either method allows the higher levels
++ *  (boot loader or machine description) to specify which MACs in
++ *  the list to assign to each device.
 + */
 +#include <linux/module.h>
 +#include <linux/moduleparam.h>
++#include <linux/spinlock.h>
 +#include <linux/etherdevice.h>
 +#include <linux/proc_fs.h>
 +#include <linux/errno.h>
@@ -84,22 +156,27 @@
 +
 +typedef struct maclist_entry {
 +	struct maclist_entry *next;  /* Linked list, first first */
++	u32                   key;   /* count or key for this entry */
++	u16                   flags;
 +	u8                    id[6]; /* 6 byte Ethernet MAC */
 +} maclist_entry_t;
 +
-+/* Access to this list is possible at any time - entries in
-+ * the list are never destroyed.  Modification of the list is
-+ * safe only from the init code (i.e. modification must be
-+ * single threaded), but read from an interrupt at the same
-+ * time is possible and safe.
++/*
++ * flag definitions
 + */
++#define MACLIST_ALLOCATED 1
++#define MACLIST_RANDOM    2
++
++/* Access to this list is protected by a standard rwlock_t. */
 +static maclist_entry_t *maclist_list = 0;
 +
++static DEFINE_RWLOCK(maclist_lock);
++
 +/*
 + * External interfaces.
 + *
 + * Add a single entry, returns 0 on success else an error
-+ * code.  Must be single threaded.
++ * code.  Checks for invalid addresses.
 + */
 +int maclist_add(const u8 new_id[6]) {
 +	maclist_entry_t *new_entry, **tail;
@@ -111,21 +188,27 @@
 +	new_entry = kmalloc(sizeof *new_entry, GFP_KERNEL);
 +	if (new_entry == 0)
 +		return -ENOMEM;
-+	new_entry->next = 0;
++	new_entry->next  = 0;
++	new_entry->key   = 0;
++	new_entry->flags = 0;
 +	memcpy(new_entry->id, new_id, sizeof new_entry->id);
 +
 +	tail = &maclist_list;
++
++	write_lock(&maclist_lock);
 +	while (*tail != 0)
 +		tail = &(*tail)->next;
 +	*tail = new_entry;
++	write_unlock(&maclist_lock);
++
 +	return 0;
 +}
 +EXPORT_SYMBOL(maclist_add);
 +
 +/*
-+ * Return the current entry count (valid in any context).
++ * Return the current entry count.
 + */
-+int maclist_count(void) {
++static int maclist_count_unlocked(void) {
 +	maclist_entry_t *tail = maclist_list;
 +	int count = 0;
 +
@@ -136,27 +219,73 @@
 +
 +	return count;
 +}
++
++int maclist_count(void) {
++	int count;
++
++	read_lock(&maclist_lock);
++		count = maclist_count_unlocked();
++	read_unlock(&maclist_lock);
++
++	return count;
++}
 +EXPORT_SYMBOL(maclist_count);
 +
 +/*
-+ * Return the ID from the n'th entry (valid in any context),
-+ * returns 0 on success, -EINVAL if 'n' is out of range.
++ * Return the ID with the given key (the key is allocated
++ * to an entry if not found).
 + */
-+int maclist_read(u8 (*id)[6], int n) {
-+	maclist_entry_t *entry = maclist_list;
-+
-+	while (n > 0 && entry != 0) {
-+		--n;
-+		entry = entry->next;
-+	}
++void maclist_read(u8 (*id)[6], u32 key) {
++	int              count, index;
++	maclist_entry_t *entry, *entry_to_allocate;
++	
++	/* Do this under a write lock to avoid the SMP race
++	 * where we find the key isn't assigned, drop the lock,
++	 * have another CPU assign it, then assign it on this
++	 * CPU too - very bad...
++	 */
++	write_lock(&maclist_lock);
++		count             = maclist_count_unlocked();
++		index             = key % count; /* index of entry to allocate */
++		entry_to_allocate = 0;
++
++		entry = maclist_list;
++		while (entry != 0) {
++			if ((entry->flags & MACLIST_ALLOCATED) != 0) {
++				if (entry->key == key) {
++					/* Found it, use this entry. */
++					entry_to_allocate = entry;
++					break;
++				}
++			} else if (entry_to_allocate == 0 || count <= index) {
++				/* The algorithm is to try for entry
++				 * (key % count), but if this isn't possible
++				 * return the prior unallocated entry.
++				 */
++				entry_to_allocate = entry;
++			}
++
++			++count;
++			entry = entry->next;
++		}
 +
-+	if (n == 0 && entry != 0) {
-+		memcpy(id, entry->id, sizeof *id);
-+		return 0;
++		/* Use entry_to_allocate, allocating it if necessary. */
++		if (entry_to_allocate != 0) {
++			if ((entry_to_allocate->flags & MACLIST_ALLOCATED) == 0) {
++				entry_to_allocate->key = key;
++				entry_to_allocate->flags |= MACLIST_ALLOCATED;
++			}
++			memcpy(id, entry_to_allocate->id, sizeof *id);
++		}
++	write_unlock(&maclist_lock);
++
++	if (entry_to_allocate == 0) {
++		/* No unallocated entries.  Make a new one and return it. */
++		printk(KERN_INFO MACLIST_NAME ": adding random MAC for key 0x%x\n", key);
++		random_ether_addr(*id);
++		if (maclist_add(*id) == 0)
++			maclist_read(id, key);
 +	}
-+
-+	printk(KERN_ERR MACLIST_NAME ": id does not exist\n");
-+	return -EINVAL;
 +}
 +EXPORT_SYMBOL(maclist_read);
 +
@@ -165,7 +294,7 @@
 + * addresses, comma separated.  (The parsing really should
 + * be somewhere central...)
 + */
-+static int __init maclist_setup(char *param) {
++static int __init maclist_setup(const char *param) {
 +	int bytes = 0, seen_a_digit = 0;
 +	u8 id[6];
 +
@@ -219,7 +348,7 @@
 +
 +		if (bytes >= 12) {
 +			int rc = maclist_add(id);
-+			if (rc)
++			if (unlikely(rc))
 +				return rc;
 +			bytes = 0;
 +			seen_a_digit = 0;
@@ -233,10 +362,7 @@
 +	return 0;
 +}
 +
-+/*
-+ * procfs support, if compiled in.
-+ */
-+#ifdef CONFIG_PROC_FS
++#if (defined CONFIG_PROC_FS) || (defined MODULE)
 +/*
 + * Character device read
 + */
@@ -264,8 +390,13 @@
 +	default: return ':';
 +	}
 +}
++#endif
 +
 +/*
++ * procfs support, if compiled in.
++ */
++#ifdef CONFIG_PROC_FS
++/*
 + * The extensively undocumented proc_read_t callback is implemented here.
 + * Go look in fs/proc/generic.c:
 + *
@@ -306,6 +437,49 @@
 +#endif
 +
 +/*
++ * set works once, at init time (the param is set to 0444 below),
++ * get works any time.
++ */
++static int param_set_maclist(const char *val, struct kernel_param *kp)
++{
++	if (maclist_list == 0)
++		return maclist_setup(val);
++
++	printk(KERN_ERR MACLIST_NAME ": call to set parameters too late\n");
++	return -EINVAL;
++}
++
++static int param_get_maclist(char *buffer, struct kernel_param *kp)
++{
++#ifdef MODULE
++	off_t offset = 0;
++
++	/* buffer is only 4k! */
++	while (offset < 4096) {
++		int ch = maclist_getchar(offset++);
++		if (ch < 0) {
++			*buffer = 0;
++			return 0;
++		}
++		*buffer++ = ch;
++	}
++
++	*--buffer = 0;
++	return -ENOMEM;
++#else
++	return -EINVAL;
++#endif
++}
++
++/*
++ * module: the argument is ids=mac,mac,mac
++ * kernel command line: maclist.ids=mac,mac,mac
++ */
++#define param_check_maclist(name, p) __param_check(name, p, maclist_entry_t*)
++module_param_named(ids, maclist_list, maclist, 0444);
++MODULE_PARM_DESC(ids, "comma separated list of MAC ids\n");
++
++/*
 + * Finally, the init/exit functions.
 + */
 +static void __exit maclist_exit(void)
@@ -314,8 +488,10 @@
 +
 +	remove_proc_entry(MACLIST_NAME, proc_net);
 +
-+	list = maclist_list;
-+	maclist_list = 0;
++	write_lock(&maclist_lock);
++		list = maclist_list;
++		maclist_list = 0;
++	write_unlock(&maclist_lock);
 +
 +	while (list != 0) {
 +		maclist_entry_t *head = list;
@@ -324,14 +500,6 @@
 +	}
 +}
 +
-+#ifdef MODULE
-+static char ids[256];
-+module_param_string(ids, ids, sizeof ids, 0);
-+MODULE_PARM_DESC(ids, "comma separated list of MAC ids\n");
-+#else
-+__setup("maclist_ids=", maclist_setup);
-+#endif
-+
 +static int __init maclist_init(void)
 +{
 +#	ifdef MODULE
@@ -347,37 +515,56 @@
 +
 +module_init(maclist_init);
 +module_exit(maclist_exit);
---- linux-nslu2.orig/drivers/net/Makefile	2006-02-06 22:35:18.000000000 +0100
-+++ linux-nslu2/drivers/net/Makefile	2006-02-06 22:35:23.000000000 +0100
-@@ -74,6 +74,7 @@ obj-$(CONFIG_RIONET) += rionet.o
- # end link order section
- #
- 
-+obj-$(CONFIG_MACLIST) += maclist.o
- obj-$(CONFIG_MII) += mii.o
- obj-$(CONFIG_PHYLIB) += phy/
- 
---- linux-nslu2.orig/drivers/net/Kconfig	2006-02-06 22:35:18.000000000 +0100
-+++ linux-nslu2/drivers/net/Kconfig	2006-02-06 22:35:23.000000000 +0100
-@@ -180,6 +180,21 @@ config NET_ETHERNET
- 	  kernel: saying N will just cause the configurator to skip all
- 	  the questions about Ethernet network cards. If unsure, say N.
- 
-+config MACLIST
-+	tristate "Ethernet MAC repository"
-+	depends on NET_ETHERNET
-+	help
-+	  Some ethernet controllers have no built-in way of obtaining an
-+	  appropriate Ethernet MAC address.  Such controllers have to be
-+	  initialised in a board-specific way, depending on how the allocated
-+	  MAC is stored.  The MAC repository provides a set of APIs and a
-+	  proc entry (/proc/net/maclist) to store MAC values from the board
-+	  so that such drivers can obtain a MAC address without board-specific
-+	  code.  You do not need to enable this device - it will be selected
-+	  automatically by any device which requires it.  It is only useful
-+	  to enable it manually when building a device driver independently
-+	  of the kernel build.
+diff -rup linux-2.6.15.1/.pc/91-maclist.patch/include/net/maclist.h linux-2.6.15.1/include/net/maclist.h
+--- linux-2.6.15/include/net/maclist.h	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/include/net/maclist.h	1970-01-01 00:00:00.000000000 +0000
+@@ -0,0 +1,49 @@
++#ifndef _MACLIST_H
++#define _MACLIST_H 1
++/*
++ * Interfaces to the MAC repository
++ *
++ * Copyright (C) 2005 John Bowler
++ * Author: John Bowler <jbowler@acm.org>
++ * Maintainers: http://www.nslu2-linux.org/
++ *
++ * This program is free software; you can redistribute it and/or
++ * modify it under the terms of the GNU General Public License
++ * version 2 as published by the Free Software Foundation.
++ */
 +
- config MII
- 	tristate "Generic Media Independent Interface device support"
- 	depends on NET_ETHERNET
++/*
++ * Add a single entry, returns 0 on success else an error
++ * code.  Allocates memory, claims and releases a write
++ * lock.
++ */
++extern int maclist_add(const u8 id_to_add[6]);
++
++/*
++ * Return the current entry count, claims and releases a
++ * read lock.
++ */
++extern int maclist_count(void);
++
++/*
++ * Return the ID from the given entry.  Always succeeds.
++ * Claims and releases a write lock.
++ *
++ * If any entry has not been allocated for this key one
++ * is allocated.  If there are no remaining unallocated
++ * entries a new one is created.
++ *
++ * If the value of the key is less than maclist_count()
++ * the entry indexed by the key (i.e. for key 'n' the
++ * n'th entry starting at 0) will be returned if available.
++ * Otherwise the entry to be returned will be unpredictable
++ * but consistent for a given value of maclist_count().
++ */
++extern void maclist_read(u8 (*buffer_for_id)[6],
++		u32 key_of_entry_to_return);
++
++/*
++ * See the implementation in drivers/net/maclist.c for
++ * more information.
++ */
++#endif /*_MACLIST_H*/
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/94-nas100d-setup.patch b/packages/linux/ixp4xx-kernel/2.6.16/94-nas100d-setup.patch
index 15ddc44584..cdca7d2766 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/94-nas100d-setup.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/94-nas100d-setup.patch
@@ -41,7 +41,7 @@ Signed-off-by: John Bowler <jbowler@acm.org>
 + */
 +static char nas100d_command_line[] __initdata =
 +	"root=/dev/mtdblock2 rootfstype=jffs2 init=/linuxrc "
-+	"rtc-pcf8563.force=0,0x51 "
++	"rtc-pcf8563.probe=0,0x51 "
 +	CONFIG_CMDLINE;
 +
 +static void __init nas100d_fixup(struct machine_desc *desc,
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/951-ixp4xx-leds-cpu-activity.patch b/packages/linux/ixp4xx-kernel/2.6.16/951-ixp4xx-leds-cpu-activity.patch
index b6b3897005..92b03836d4 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/951-ixp4xx-leds-cpu-activity.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/951-ixp4xx-leds-cpu-activity.patch
@@ -6,18 +6,25 @@ are idle.
 
 Signed-off-by: John Bowler <jbowler@acm.org>
 
-diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/arch/arm/kernel/process.c linux-2.6.15.2/arch/arm/kernel/process.c
---- linux-2.6.15/arch/arm/kernel/process.c	1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.15/arch/arm/kernel/process.c	1970-01-01 00:00:00.000000000 +0000
+---
+ arch/arm/kernel/process.c  |   11 
+ drivers/leds/Kconfig       |    9 
+ drivers/leds/Makefile      |    1 
+ drivers/leds/ledtrig-cpu.c |  501 +++++++++++++++++++++++++++++++++++++++++++++
+ include/linux/leds.h       |    9 
+ 5 files changed, 531 insertions(+)
+
+--- linux-ixp4xx.orig/arch/arm/kernel/process.c	2006-02-21 00:53:28.000000000 +0100
++++ linux-ixp4xx/arch/arm/kernel/process.c	2006-02-21 01:03:33.000000000 +0100
 @@ -27,6 +27,7 @@
  #include <linux/kallsyms.h>
  #include <linux/init.h>
  #include <linux/cpu.h>
 +#include <linux/leds.h>
  
- #include <asm/system.h>
- #include <asm/io.h>
-@@ -81,6 +82,12 @@ void (*pm_power_off)(void);
+ #include <asm/leds.h>
+ #include <asm/processor.h>
+@@ -80,6 +81,12 @@ void (*pm_power_off)(void);
  EXPORT_SYMBOL(pm_power_off);
  
  /*
@@ -30,7 +37,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/arch/arm/kernel/
   * This is our default idle handler.  We need to disable
   * interrupts here to ensure we don't miss a wakeup call.
   */
-@@ -121,8 +128,12 @@ void cpu_idle(void)
+@@ -120,8 +127,12 @@ void cpu_idle(void)
  		if (!idle)
  			idle = default_idle;
  		leds_event(led_idle_start);
@@ -43,9 +50,8 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/arch/arm/kernel/
  		leds_event(led_idle_end);
  		preempt_enable_no_resched();
  		schedule();
-diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/Kconfig linux-2.6.15.2/drivers/leds/Kconfig
---- linux-2.6.15/drivers/leds/Kconfig	1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.15/drivers/leds/Kconfig	1970-01-01 00:00:00.000000000 +0000
+--- linux-ixp4xx.orig/drivers/leds/Kconfig	2006-02-21 00:58:36.000000000 +0100
++++ linux-ixp4xx/drivers/leds/Kconfig	2006-02-21 01:03:33.000000000 +0100
 @@ -66,5 +66,14 @@ config LEDS_TRIGGER_TIMER
  	  This allows LEDs to be controlled by a programmable timer
  	  via sysfs. If unsure, say Y.
@@ -61,17 +67,15 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/Kco
 +
  endmenu
  
-diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/Makefile linux-2.6.15.2/drivers/leds/Makefile
---- linux-2.6.15/drivers/leds/Makefile	1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.15/drivers/leds/Makefile	1970-01-01 00:00:00.000000000 +0000
+--- linux-ixp4xx.orig/drivers/leds/Makefile	2006-02-21 00:58:36.000000000 +0100
++++ linux-ixp4xx/drivers/leds/Makefile	2006-02-21 01:03:33.000000000 +0100
 @@ -13,3 +13,4 @@ obj-$(CONFIG_LEDS_TOSA)			+= leds-tosa.o
  
  # LED Triggers
  obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
 +obj-$(CONFIG_LEDS_TRIGGER_CPU_ACTIVITY)	+= ledtrig-cpu.o
-diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/ledtrig-cpu.c linux-2.6.15.2/drivers/leds/ledtrig-cpu.c
---- linux-2.6.15/drivers/leds/ledtrig-cpu.c	1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.15/drivers/leds/ledtrig-cpu.c	1970-01-01 00:00:00.000000000 +0000
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-ixp4xx/drivers/leds/ledtrig-cpu.c	2006-02-21 01:08:57.000000000 +0100
 @@ -0,0 +1,501 @@
 +/*
 + * LEDs CPU activity trigger
@@ -182,7 +186,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 + * have changed.  Returns true if the LED is blinking.  The argument
 + * is the blink state - the brightness of the blinking LED.
 + */
-+static int leds_cpu_trigger_led_state_change(struct led_device *led,
++static int leds_cpu_trigger_led_state_change(struct led_classdev *led,
 +		int is_active, enum led_brightness brightness)
 +{
 +	int is_blinking = 0;
@@ -218,7 +222,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 +static ssize_t leds_cpu_trigger_show_prop(struct class_device *dev, char *buf,
 +		size_t where)
 +{
-+	struct led_device     *led = dev->class_data;
++	struct led_classdev     *led = dev->class_data;
 +	cpu_trigger_led_state  item = cpu_led_invalid, i;
 +	char                  *next;
 +
@@ -270,7 +274,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 +{
 +	size_t rc = 0;
 +	cpu_trigger_led_state value = 0/*sic*/;
-+	struct led_device *led;
++	struct led_classdev *led;
 +
 +	/* ignore space characters before the value. */
 +	while (rc < size && isspace(buf[rc]))
@@ -336,7 +340,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 + * Activate and deactivate are called on individual LEDs when the
 + * LED trigger property is changed.  The LED write lock is held.
 + */
-+static void leds_cpu_trigger_activate(struct led_device *led)
++static void leds_cpu_trigger_activate(struct led_classdev *led)
 +{
 +	/*
 +	 * The initial setting of the trigger is simple CPU activity
@@ -358,7 +362,7 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 +	led_set_brightness(led, LED_FULL);
 +}
 +
-+static void leds_cpu_trigger_deactivate(struct led_device *led)
++static void leds_cpu_trigger_deactivate(struct led_classdev *led)
 +{
 +	struct cpu_trigger_data *data = led->trigger_data;
 +	if (likely(data != 0)) {
@@ -422,9 +426,9 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 +		leds_cpu_trigger_mark(data, now) ? LED_FULL : LED_OFF;
 +	struct list_head *entry;
 +
-+	list_for_each(entry, &data->trigger.led_devs) {
-+		struct led_device *led =
-+			list_entry(entry, struct led_device, trig_list);
++	list_for_each(entry, &data->trigger.led_cdevs) {
++		struct led_classdev *led =
++			list_entry(entry, struct led_classdev, trig_list);
 +
 +		blinking |= leds_cpu_trigger_led_state_change(led,
 +				active, brightness);
@@ -574,9 +578,8 @@ diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/drivers/leds/led
 +MODULE_AUTHOR("John Bowler <jbowler@acm.org>");
 +MODULE_DESCRIPTION("CPU activity LED trigger");
 +MODULE_LICENSE("MIT");
-diff -rup linux-2.6.15.2/.pc/951-ixp4xx-leds-cpu-activity.patch/include/linux/leds.h linux-2.6.15.2/include/linux/leds.h
---- linux-2.6.15/include/linux/leds.h	1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.15/include/linux/leds.h	1970-01-01 00:00:00.000000000 +0000
+--- linux-ixp4xx.orig/include/linux/leds.h	2006-02-21 00:54:33.000000000 +0100
++++ linux-ixp4xx/include/linux/leds.h	2006-02-21 01:03:33.000000000 +0100
 @@ -95,3 +95,12 @@ void led_trigger_event(struct led_trigge
  #define led_trigger_event(x, y) do {} while(0)
  
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/96-nas100d-leds.patch b/packages/linux/ixp4xx-kernel/2.6.16/96-nas100d-leds.patch
index 796ca87718..d78a779127 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/96-nas100d-leds.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/96-nas100d-leds.patch
@@ -1,7 +1,6 @@
 NEW_LEDS support for the IOMega NAS100D
 
 Signed-off-by: John Bowler <jbowler@acm.org>
-Signed-off-by: Rod Whitby <rod@whitby.id.au>
 
 --- linux-2.6.15/arch/arm/mach-ixp4xx/nas100d-setup.c	1970-01-01 00:00:00.000000000 +0000
 +++ linux-2.6.15/arch/arm/mach-ixp4xx/nas100d-setup.c	1970-01-01 00:00:00.000000000 +0000
@@ -32,7 +31,7 @@ Signed-off-by: Rod Whitby <rod@whitby.id.au>
 +		.flags		= IXP4XX_GPIO_LOW,
 +	},
 +	{
-+		.name		= "disk",   /* green flashing (off) and yellow (on) led */
++		.name		= "disk-1", /* yellow led */
 +		.start		= 3,
 +		.end		= 3,
 +		.flags		= IXP4XX_GPIO_LOW,
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-buttons.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-buttons.patch
new file mode 100644
index 0000000000..b72c880259
--- /dev/null
+++ b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-buttons.patch
@@ -0,0 +1,122 @@
+Index: linux-2.6.15/arch/arm/mach-ixp4xx/ds101-buttons.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/arch/arm/mach-ixp4xx/ds101-buttons.c	2006-02-16 20:04:47.000000000 +0100
+@@ -0,0 +1,117 @@
++/*
++ * arch/arm/mach-ixp4xx/ds101-buttons.c
++ *
++ * DS101 Button driver
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/reboot.h>
++#include <linux/interrupt.h>
++#include <asm/mach-types.h>
++
++extern void ctrl_alt_del(void);
++static int usbcopyb_irqcount = 0;
++static int resetb_irqcount = 0;
++static int powerb_irqcount = 0;
++
++static irqreturn_t ds101_usbcopy_handler(int irq, void *dev_id, struct pt_regs *regs)
++{
++	usbcopyb_irqcount++;
++	if (usbcopyb_irqcount > 1)  /* Init creates one IRQ. Ignore it */
++	{
++		/* The GPIO line is shared between the button and the led.
++		 * Make sure the GPIO is GPIO_OUT, so we don't recieve
++		 * irqs from the led going on/off. Disable the irq just in
++		 * case.
++		 */
++		gpio_line_config(DS101_USBCOPYB_IRQ, DS101_GPIO_OUT);
++		disable_irq(DS101_USBCOPYB_IRQ);
++		printk(KERN_INFO "Usbcopy\n");
++	}
++	return IRQ_HANDLED;
++}
++
++static irqreturn_t ds101_power_handler(int irq, void *dev_id, struct pt_regs *regs)
++{
++	powerb_irqcount++;
++	if (powerb_irqcount > 1)
++	{
++		/* Make the power led flash */
++		gpio_line_set(DS101_POWER_LED, DS101_GPIO_LOW);
++		ctrl_alt_del();
++	}
++	return IRQ_HANDLED;
++}
++
++static irqreturn_t ds101_reset_handler(int irq, void *dev_id, struct pt_regs *regs)
++{
++	resetb_irqcount++;
++	if (resetb_irqcount > 1)
++	{
++		machine_power_off();
++	}
++	return IRQ_HANDLED;
++}
++
++static int __init ds101_buttons_init(void)
++{
++	if (!(machine_is_ds101()))
++		return 0;
++	printk(KERN_INFO "DiskStation DS101 button driver v0.2\n");
++	gpio_line_config(DS101_POWERB_GPIO, (DS101_GPIO_IN|IRQT_FALLING));
++	gpio_line_config(DS101_RESETB_GPIO, (DS101_GPIO_IN|IRQT_FALLING));
++	gpio_line_config(DS101_USBCOPYB_GPIO, (DS101_GPIO_IN|IRQT_FALLING));
++	set_irq_type(DS101_USBCOPYB_IRQ, IRQT_FALLING);
++	set_irq_type(DS101_POWERB_IRQ, IRQT_FALLING);
++	set_irq_type(DS101_RESETB_IRQ, IRQT_FALLING);
++	if (request_irq(DS101_USBCOPYB_IRQ, &ds101_usbcopy_handler, SA_INTERRUPT,
++		"DS101 USBCopy button", NULL) < 0)
++	{
++		printk(KERN_DEBUG "Could not get USBCopy button IRQ (%d)\n",
++				DS101_USBCOPYB_IRQ);
++
++		return -EIO;
++	}
++
++	if (request_irq(DS101_POWERB_IRQ, &ds101_power_handler, SA_INTERRUPT,
++		"DS101 Powerbutton", NULL) < 0)
++	{
++		printk(KERN_DEBUG "Could not get powerbutton IRQ (%d)\n",
++				DS101_POWERB_IRQ);
++		return -EIO;
++	}
++
++	if (request_irq(DS101_RESETB_IRQ, &ds101_reset_handler, SA_INTERRUPT,
++		"DS101 Resetbutton", NULL) < 0)
++	{
++		printk(KERN_DEBUG "Could not get resetbutton IRQ (%d)\n",
++				DS101_RESETB_IRQ);
++		return -EIO;
++	}
++	return 0;
++}
++
++static void __exit ds101_buttons_exit(void)
++{
++	if (!(machine_is_ds101()))
++		return;
++
++	disable_irq(DS101_USBCOPYB_IRQ);
++	disable_irq(DS101_POWERB_IRQ);
++	disable_irq(DS101_RESETB_IRQ);
++	free_irq(DS101_USBCOPYB_IRQ, NULL);
++	free_irq(DS101_POWERB_IRQ, NULL);
++	free_irq(DS101_RESETB_IRQ, NULL);
++}
++
++module_init(ds101_buttons_init);
++module_exit(ds101_buttons_exit);
++
++MODULE_AUTHOR("OEyvind Repvik <nail@nslu2-linux.org>");
++MODULE_DESCRIPTION("DS101 Button driver");
++MODULE_LICENSE("GPL");
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-includes.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-includes.patch
index d9a5f07494..e9127dbbb4 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-includes.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-includes.patch
@@ -1,41 +1,19 @@
-diff -ruN linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/hardware.h linux-2.6.15.new/include/asm-arm/arch-ixp4xx/hardware.h
---- linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/hardware.h    2006-02-11 02:58:47.000000000 +0100
-+++ linux-2.6.15.new/include/asm-arm/arch-ixp4xx/hardware.h     2006-02-10 22:26:54.000000000 +0100
-@@ -46,5 +46,6 @@
- #include "prpmc1100.h"
- #include "nslu2.h"
- #include "nas100d.h"
-+#include "ds101.h"
+ include/asm-arm/arch-ixp4xx/ds101.h    |   70 +++++++++++++++++++++++++++++++++
+ include/asm-arm/arch-ixp4xx/hardware.h |    1 
+ include/asm-arm/arch-ixp4xx/irqs.h     |    7 +++
+ 3 files changed, 78 insertions(+)
 
- #endif  /* _ASM_ARCH_HARDWARE_H */
-diff -ruN linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/irqs.h linux-2.6.15.new/include/asm-arm/arch-ixp4xx/irqs.h
---- linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/irqs.h        2006-02-11 02:58:47.000000000 +0100
-+++ linux-2.6.15.new/include/asm-arm/arch-ixp4xx/irqs.h 2006-02-10 22:56:11.000000000 +0100
-@@ -108,5 +108,12 @@
- #define        IRQ_NAS100D_PCI_INTC    IRQ_IXP4XX_GPIO9
- #define        IRQ_NAS100D_PCI_INTD    IRQ_IXP4XX_GPIO8
- #define        IRQ_NAS100D_PCI_INTE    IRQ_IXP4XX_GPIO7
-+/*
-+ * DS101 board IRQs
-+ */
-+
-+#define        IRQ_DS101_PCI_INTA    IRQ_IXP4XX_GPIO11
-+#define        IRQ_DS101_PCI_INTB    IRQ_IXP4XX_GPIO10
-+#define        IRQ_DS101_PCI_INTC    IRQ_IXP4XX_GPIO9
-
- #endif
-diff -ruN linux-2.6.15.orig/include/asm-arm/arch/ds101.h linux-2.6.15.new/include/asm-arm/arch/ds101.h
---- linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/ds101.h      1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.15.new/include/asm-arm/arch-ixp4xx/ds101.h       2006-02-10 22:16:24.000000000 +0100
-@@ -0,0 +1,72 @@
+Index: linux-2.6.15/include/asm-arm/arch-ixp4xx/ds101.h
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/include/asm-arm/arch-ixp4xx/ds101.h	2006-02-15 22:35:31.000000000 +0100
+@@ -0,0 +1,89 @@
 +/*
 + * include/asm-arm/arch-ixp4xx/ds101.h
 + *
 + * DS101 platform specific definitions
 + *
-+ * Copyright (c) 2005 Tower Technologies
-+ *
-+ * Author: Alessandro Zummo <a.zummo@towertech.it>
++ * Author: Øyvind Repvik <nail@nslu2-linux.org>
 + *
 + * based on ixdp425.h:
 + *     Copyright 2004 (c) MontaVista, Software, Inc.
@@ -49,23 +27,37 @@ diff -ruN linux-2.6.15.orig/include/asm-arm/arch/ds101.h linux-2.6.15.new/includ
 +#error "Do not include this directly, instead #include <asm/hardware.h>"
 +#endif
 +
-+#define DS101_SDA_PIN          1
-+#define DS101_SCL_PIN          0
++#define DS101_SCL_PIN		DS101_GPIO0
++#define DS101_SDA_PIN		DS101_GPIO1
++#define DS101_GPIO_BUZZ		DS101_GPIO2
++#define DS101_POWER_LED		DS101_GPIO3
++#define DS101_USBCOPYB_GPIO	DS101_GPIO4
++#define DS101_USBCOPY_SOLID_LED	DS101_GPIO4	/* The led and button share GPIO */
++#define DS101_USBCOPY_BLINK_LED	DS101_GPIO5
++/* GPIO6 is unknown */
++#define DS101_POWEROFF_GPIO	DS101_GPIO7
++#define DS101_POWERB_GPIO	DS101_GPIO8
++#define DS101_PCI_INTC_PIN	DS101_GPIO9
++#define DS101_PCI_INTB_PIN	DS101_GPIO10
++#define DS101_PCI_INTA_PIN	DS101_GPIO11
++#define DS101_RESETB_GPIO	DS101_GPIO12
++#define DS101_STATUSOK_LED	DS101_GPIO14
++#define DS101_STATUSBAD_LED	DS101_GPIO15
 +
-+/*
-+ * DS101 PCI IRQs
-+ */
-+#define DS101_PCI_MAX_DEV      3
-+#define DS101_PCI_IRQ_LINES    3
++#define DS101_PCI_MAX_DEV	2
++#define DS101_PCI_IRQ_LINES	3
 +
++#define DS101_POWERB_IRQ	IRQ_IXP4XX_GPIO8
++#define DS101_RESETB_IRQ	IRQ_IXP4XX_GPIO12
++#define DS101_USBCOPYB_IRQ	IRQ_IXP4XX_GPIO4
 +
-+/* PCI controller GPIO to IRQ pin mappings */
-+#define DS101_PCI_INTA_PIN     11
-+#define DS101_PCI_INTB_PIN     10
-+#define DS101_PCI_INTC_PIN     9
-+// #define DS101_PCI_INTD_PIN  8
-+// #define DS101_PCI_INTE_PIN  7
++#define DS101_GPIO_IN		IXP4XX_GPIO_IN
++#define DS101_GPIO_OUT		IXP4XX_GPIO_OUT
++#define DS101_GPIO_HIGH		1
++#define DS101_GPIO_LOW		0
 +
++#define DS101_GPIO_CLK0_ENABLE	0x100
++#define DS101_GPIO_CLK1_ENABLE	0x1000000
 +/* GPIO */
 +
 +#define DS101_GPIO0           0
@@ -85,18 +77,51 @@ diff -ruN linux-2.6.15.orig/include/asm-arm/arch/ds101.h linux-2.6.15.new/includ
 +#define DS101_GPIO14          14
 +#define DS101_GPIO15          15
 +
++/* Stuff needed to setup the IXP expansion
++ * bus on the DS101
++ */
++ 
++#define DS101_EXP_RECOVERY_T(x)	(((x) & 15) << 16)
++#define DS101_EXP_HOLD_T(x)	(((x) & 3) << 20)
++#define DS101_EXP_STROBE_T(x)	(((x) & 15) << 22)
++#define DS101_EXP_SETUP_T(x)	(((x) & 3) << 26)
++#define DS101_EXP_ADDR_T(x)	(((x) & 3) << 28)
 +
-+/* Buttons */
-+
-+#define DS101_PB_GPIO         DS101_GPIO8
-+#define DS101_RB_GPIO         DS101_GPIO12
-+#define DS101_PO_GPIO         DS101_GPIO7   /* power off */
-+
-+#define DS101_PB_IRQ          IRQ_IXP4XX_GPIO8
-+#define DS101_RB_IRQ          IRQ_IXP4XX_GPIO12
++#define DS101_EXP_SZ_16M	(15 << 10)
++#define DS101_EXP_WR_EN		(1 << 1)
++#define DS101_EXP_BYTE_RD16	(1 << 6)
++#define DS101_EXP_CS_EN		(1 << 31)
 +
++#define DS101_EXP_CS0_INIT	(DS101_EXP_ADDR_T(1) | \
++        DS101_EXP_SETUP_T(1) | DS101_EXP_STROBE_T(1) | \
++        DS101_EXP_HOLD_T(1) | DS101_EXP_RECOVERY_T(1)| \
++        DS101_EXP_SZ_16M | DS101_EXP_WR_EN | \
++        DS101_EXP_BYTE_RD16 | DS101_EXP_CS_EN)
+Index: linux-2.6.15/include/asm-arm/arch-ixp4xx/hardware.h
+===================================================================
+--- linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/hardware.h	2006-02-13 21:23:22.000000000 +0100
++++ linux-2.6.15/include/asm-arm/arch-ixp4xx/hardware.h	2006-02-13 21:23:26.000000000 +0100
+@@ -46,5 +46,6 @@
+ #include "prpmc1100.h"
+ #include "nslu2.h"
+ #include "nas100d.h"
++#include "ds101.h"
+ 
+ #endif  /* _ASM_ARCH_HARDWARE_H */
+Index: linux-2.6.15/include/asm-arm/arch-ixp4xx/irqs.h
+===================================================================
+--- linux-2.6.15.orig/include/asm-arm/arch-ixp4xx/irqs.h	2006-02-13 21:23:22.000000000 +0100
++++ linux-2.6.15/include/asm-arm/arch-ixp4xx/irqs.h	2006-02-13 21:23:26.000000000 +0100
+@@ -108,5 +108,12 @@
+ #define        IRQ_NAS100D_PCI_INTC    IRQ_IXP4XX_GPIO9
+ #define        IRQ_NAS100D_PCI_INTD    IRQ_IXP4XX_GPIO8
+ #define        IRQ_NAS100D_PCI_INTE    IRQ_IXP4XX_GPIO7
 +/*
-+#define DS101_PB_BM           (1L << DS101_PB_GPIO)
-+#define DS101_PO_BM           (1L << DS101_PO_GPIO)
-+#define DS101_RB_BM           (1L << DS101_RB_GPIO)
-+*/
++ * DS101 board IRQs
++ */
++
++#define        IRQ_DS101_PCI_INTA    IRQ_IXP4XX_GPIO11
++#define        IRQ_DS101_PCI_INTB    IRQ_IXP4XX_GPIO10
++#define        IRQ_DS101_PCI_INTC    IRQ_IXP4XX_GPIO9
+ 
+ #endif
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-misc.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-misc.patch
index ea5f91b45f..6f62a7debb 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-misc.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-misc.patch
@@ -1,19 +1,15 @@
-diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/Makefile linux-2.6.15.new/arch/arm/mach-ixp4xx/Makefile
---- linux-2.6.15.orig/arch/arm/mach-ixp4xx/Makefile     2006-02-11 02:57:58.000000000 +0100
-+++ linux-2.6.15.new/arch/arm/mach-ixp4xx/Makefile      2006-02-10 22:13:27.000000000 +0100
-@@ -10,4 +10,4 @@
- obj-$(CONFIG_MACH_GTWX5715)	+= gtwx5715-pci.o gtwx5715-setup.o
- obj-$(CONFIG_MACH_NSLU2)	+= nslu2-pci.o nslu2-setup.o nslu2-power.o
- obj-$(CONFIG_MACH_NAS100D)	+= nas100d-pci.o nas100d-setup.o nas100d-power.o
--
-+obj-$(CONFIG_MACH_DS101)	+= ds101-pci.o ds101-setup.o ds101-power.o
-diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/Kconfig linux-2.6.15.new/arch/arm/mach-ixp4xx/Kconfig
---- linux-2.6.15.orig/arch/arm/mach-ixp4xx/Kconfig      2006-02-11 03:00:07.000000000 +0100
-+++ linux-2.6.15.new/arch/arm/mach-ixp4xx/Kconfig       2006-02-10 22:21:09.000000000 +0100
-@@ -86,6 +86,14 @@
-          NAS 100d device. For more information on this platform,
-          see http://www.nslu2-linux.org/wiki/NAS100d/HomePage
+ arch/arm/mach-ixp4xx/Kconfig  |    8 ++++++++
+ arch/arm/mach-ixp4xx/Makefile |    2 +-
+ 2 files changed, 9 insertions(+), 1 deletion(-)
 
+Index: linux-2.6.15/arch/arm/mach-ixp4xx/Kconfig
+===================================================================
+--- linux-2.6.15.orig/arch/arm/mach-ixp4xx/Kconfig	2006-02-14 19:20:21.000000000 +0100
++++ linux-2.6.15/arch/arm/mach-ixp4xx/Kconfig	2006-02-14 19:20:26.000000000 +0100
+@@ -86,6 +86,14 @@
+ 	  NAS 100d device. For more information on this platform,
+ 	  see http://www.nslu2-linux.org/wiki/NAS100d/HomePage
+ 
 +config MACH_DS101
 +       bool
 +       prompt "DS101"
@@ -25,3 +21,13 @@ diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/Kconfig linux-2.6.15.new/arch/a
  #
  # Avila and IXDP share the same source for now. Will change in future
  #
+Index: linux-2.6.15/arch/arm/mach-ixp4xx/Makefile
+===================================================================
+--- linux-2.6.15.orig/arch/arm/mach-ixp4xx/Makefile	2006-02-14 19:20:21.000000000 +0100
++++ linux-2.6.15/arch/arm/mach-ixp4xx/Makefile	2006-02-14 19:20:36.000000000 +0100
+@@ -10,4 +10,4 @@
+ obj-$(CONFIG_MACH_GTWX5715)	+= gtwx5715-pci.o gtwx5715-setup.o
+ obj-$(CONFIG_MACH_NSLU2)	+= nslu2-pci.o nslu2-setup.o nslu2-power.o
+ obj-$(CONFIG_MACH_NAS100D)	+= nas100d-pci.o nas100d-setup.o nas100d-power.o
+-
++obj-$(CONFIG_MACH_DS101)	+= ds101-pci.o ds101-setup.o ds101-buttons.o
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-pci.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-pci.patch
index 8940bd63a6..46556f7cee 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-pci.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-pci.patch
@@ -1,7 +1,9 @@
-diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-pci.c linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-pci.c
---- linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-pci.c  1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-pci.c   2006-02-10 22:31:00.000000000 +0100
-@@ -0,0 +1,69 @@
+ arch/arm/mach-ixp4xx/ds101-pci.c |   68 +++++++++++++++++++++++++++++++++++++++
+ 1 file changed, 68 insertions(+)
+
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-ixp4xx/arch/arm/mach-ixp4xx/ds101-pci.c	2006-02-11 16:27:21.000000000 +0100
+@@ -0,0 +1,68 @@
 +/*
 + * arch/arm/mach-ixp4xx/ds101-pci.c
 + *
@@ -40,8 +42,7 @@ diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-pci.c linux-2.6.15.new/ar
 +       static int pci_irq_table[DS101_PCI_MAX_DEV][DS101_PCI_IRQ_LINES] =
 +       {
 +               { IRQ_DS101_PCI_INTA, -1, -1 },
-+               { IRQ_DS101_PCI_INTB, -1, -1 },
-+               { IRQ_DS101_PCI_INTC, -1, -1 },
++               { IRQ_DS101_PCI_INTB, IRQ_DS101_PCI_INTB, IRQ_DS101_PCI_INTC },
 +       };
 +
 +       int irq = -1;
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-power.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-power.patch
deleted file mode 100644
index 3c309f3536..0000000000
--- a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-power.patch
+++ /dev/null
@@ -1,75 +0,0 @@
-diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-power.c linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-power.c
---- linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-power.c        1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-power.c 2006-02-10 23:54:40.000000000 +0100
-@@ -0,0 +1,71 @@
-+/*
-+ * arch/arm/mach-ixp4xx/ds101-power.c
-+ *
-+ * DS101 Power/Reset driver
-+ *
-+ * Copyright (C) 2005 Tower Technologies
-+ *
-+ * based on ds101-io.c
-+ *  Copyright (C) 2004 Karen Spearel
-+ *
-+ * Author: Alessandro Zummo <a.zummo@towertech.it>
-+ * Author: OEyvind Repvik <oyvind@repvik.org>
-+ * Maintainers: http://www.nslu2-linux.org/
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/reboot.h>
-+#include <linux/interrupt.h>
-+
-+#include <asm/mach-types.h>
-+
-+extern void ctrl_alt_del(void);
-+
-+static irqreturn_t ds101_reset_handler(int irq, void *dev_id, struct pt_regs *regs)
-+{
-+       /* Signal init to do the ctrlaltdel action, this will bypass init if
-+        * it hasn't started and do a kernel_restart.
-+        */
-+       ctrl_alt_del();
-+
-+       return IRQ_HANDLED;
-+}
-+
-+static int __init ds101_power_init(void)
-+{
-+       if (!(machine_is_ds101()))
-+               return 0;
-+
-+       set_irq_type(DS101_RB_IRQ, IRQT_LOW);
-+
-+       if (request_irq(DS101_RB_IRQ, &ds101_reset_handler,
-+               SA_INTERRUPT, "DS101 reset button", NULL) < 0) {
-+
-+               printk(KERN_DEBUG "Reset Button IRQ %d not available\n",
-+                       DS101_RB_IRQ);
-+
-+               return -EIO;
-+       }
-+
-+       return 0;
-+}
-+
-+static void __exit ds101_power_exit(void)
-+{
-+       if (!(machine_is_ds101()))
-+               return;
-+
-+       free_irq(DS101_RB_IRQ, NULL);
-+}
-+
-+module_init(ds101_power_init);
-+module_exit(ds101_power_exit);
-+
-+MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
-+MODULE_DESCRIPTION("DS101 Power/Reset driver");
-+MODULE_LICENSE("GPL");
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-setup.patch b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-setup.patch
index ac3f7d19c7..107808f6b8 100644
--- a/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-setup.patch
+++ b/packages/linux/ixp4xx-kernel/2.6.16/97-ds101-setup.patch
@@ -1,7 +1,11 @@
-diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-setup.c linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-setup.c
---- linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-setup.c        1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.15.new/arch/arm/mach-ixp4xx/ds101-setup.c 2006-02-11 02:17:35.000000000 +0100
-@@ -0,0 +1,284 @@
+ arch/arm/mach-ixp4xx/ds101-setup.c |  287 +++++++++++++++++++++++++++++++++++++
+ 1 file changed, 287 insertions(+)
+
+Index: linux-2.6.15/arch/arm/mach-ixp4xx/ds101-setup.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/arch/arm/mach-ixp4xx/ds101-setup.c	2006-02-16 19:44:23.000000000 +0100
+@@ -0,0 +1,246 @@
 +/*
 + * arch/arm/mach-ixp4xx/ds101-setup.c
 + *
@@ -20,8 +24,9 @@ diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-setup.c linux-2.6.15.new/
 +#include <linux/kernel.h>
 +#include <linux/serial.h>
 +#include <linux/serial_8250.h>
-+#include <linux/mtd/mtd.h>
++/* #include <linux/mtd/mtd.h> */
 +#include <linux/leds.h>
++#include <linux/pci.h>
 +
 +#include <asm/setup.h>
 +#include <asm/memory.h>
@@ -29,260 +34,221 @@ diff -ruN linux-2.6.15.orig/arch/arm/mach-ixp4xx/ds101-setup.c linux-2.6.15.new/
 +#include <asm/mach/arch.h>
 +#include <asm/mach/flash.h>
 +
++#ifdef CONFIG_MACLIST
 +#include <net/maclist.h>
-+
-+static struct flash_platform_data ds101_flash_data = {
-+       .map_name               = "cfi_probe",
-+       .width                  = 2,
-+};
-+
-+static struct resource ds101_flash_resource = {
-+       .flags                  = IORESOURCE_MEM,
-+};
-+
-+static struct platform_device ds101_flash = {
-+       .name                   = "IXP4XX-Flash",
-+       .id                     = 0,
-+       .dev.platform_data      = &ds101_flash_data,
-+       .num_resources          = 1,
-+       .resource               = &ds101_flash_resource,
-+};
++#endif
 +
 +#ifdef CONFIG_LEDS_CLASS
 +static struct resource ds101_led_resources[] = {
-+       {
-+               .name           = "power", /* blue power led */
-+               .start          = 3,
-+               .end            = 3,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
-+       {
-+               .name           = "status-1",
-+               .start          = 14,
-+               .end            = 14,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
-+       {
-+               .name           = "status-2",
-+               .start          = 15,
-+               .end            = 15,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
-+       {
-+               .name           = "usb-1", /* The usb-copy-button led */
-+               .start          = 5,
-+               .end            = 5,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
-+       {
-+               .name           = "usb-2", /* also the usb-copy-button led */
-+               .start          = 4,
-+               .end            = 4,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
-+       {
-+               .name           = "test",
-+               .start          = 6,
-+               .end            = 6,
-+               .flags          = IXP4XX_GPIO_LOW,
-+       },
++	{
++		.name	= "power",
++		.start	= DS101_POWER_LED,
++		.end	= DS101_POWER_LED,
++		.flags	= IXP4XX_GPIO_LOW,
++	},
++	{
++		.name	= "usbcopy-solid",
++		.start	= DS101_USBCOPY_SOLID_LED,
++		.end	= DS101_USBCOPY_SOLID_LED,
++		.flags	= IXP4XX_GPIO_LOW,
++	},
++	{
++		.name	= "usbcopy-blink",
++		.start	= DS101_USBCOPY_BLINK_LED,
++		.end	= DS101_USBCOPY_BLINK_LED,
++		.flags	= IXP4XX_GPIO_LOW,
++	},
++	{
++		.name	= "status-ready",
++		.start	= DS101_STATUSOK_LED,
++		.end	= DS101_STATUSOK_LED,
++		.flags	= IXP4XX_GPIO_LOW,
++	},
++	{
++		.name	= "status-error",
++		.start	= DS101_STATUSBAD_LED,
++		.start	= DS101_STATUSBAD_LED,
++		.flags	= IXP4XX_GPIO_LOW,
++	}
 +};
 +
 +
 +static struct platform_device ds101_leds = {
-+       .name                   = "IXP4XX-GPIO-LED",
-+       .id                     = -1,
-+       .num_resources          = ARRAY_SIZE(ds101_led_resources),
-+       .resource               = ds101_led_resources,
++	.name		= "IXP4XX-GPIO-LED",
++	.id		= -1,
++	.num_resources	= ARRAY_SIZE(ds101_led_resources),
++	.resource	= ds101_led_resources,
 +};
 +#endif
 +
 +static struct ixp4xx_i2c_pins ds101_i2c_gpio_pins = {
-+       .sda_pin                = DS101_SDA_PIN,
-+       .scl_pin                = DS101_SCL_PIN,
++	.sda_pin		= DS101_SDA_PIN,
++	.scl_pin		= DS101_SCL_PIN,
 +};
 +
 +static struct platform_device ds101_i2c_controller = {
-+       .name                   = "IXP4XX-I2C",
-+       .id                     = 0,
-+       .dev.platform_data      = &ds101_i2c_gpio_pins,
-+       .num_resources          = 0,
++	.name			= "IXP4XX-I2C",
++	.id			= 0,
++	.dev.platform_data	= &ds101_i2c_gpio_pins,
++	.num_resources		= 0,
 +};
 +
 +static struct platform_device ds101_beeper = {
-+        .name                   = "ixp4xx-beeper",
-+        .id                     = 2,
-+       .num_resources          = 0,
++	.name		= "ixp4xx-beeper",
++	.id		= DS101_GPIO_BUZZ,
++	.num_resources	= 0,
 +};
 +
 +static struct resource ds101_uart_resources[] = {
-+       {
-+               .start          = IXP4XX_UART1_BASE_PHYS,
-+               .end            = IXP4XX_UART1_BASE_PHYS + 0x0fff,
-+               .flags          = IORESOURCE_MEM,
-+       },
-+       {
-+               .start          = IXP4XX_UART2_BASE_PHYS,
-+               .end            = IXP4XX_UART2_BASE_PHYS + 0x0fff,
-+               .flags          = IORESOURCE_MEM,
-+       }
++	{
++		.start	= IXP4XX_UART1_BASE_PHYS,
++		.end	= IXP4XX_UART1_BASE_PHYS + 0x0fff,
++		.flags	= IORESOURCE_MEM,
++	},
++	{
++		.start	= IXP4XX_UART2_BASE_PHYS,
++		.end	= IXP4XX_UART2_BASE_PHYS + 0x0fff,
++		.flags	= IORESOURCE_MEM,
++	}
 +};
 +
 +static struct plat_serial8250_port ds101_uart_data[] = {
-+       {
-+               .mapbase        = IXP4XX_UART1_BASE_PHYS,
-+               .membase        = (char *)IXP4XX_UART1_BASE_VIRT + REG_OFFSET,
-+               .irq            = IRQ_IXP4XX_UART1,
-+               .flags          = UPF_BOOT_AUTOCONF,
-+               .iotype         = UPIO_MEM,
-+               .regshift       = 2,
-+               .uartclk        = IXP4XX_UART_XTAL,
-+       },
-+       {
-+               .mapbase        = IXP4XX_UART2_BASE_PHYS,
-+               .membase        = (char *)IXP4XX_UART2_BASE_VIRT + REG_OFFSET,
-+               .irq            = IRQ_IXP4XX_UART2,
-+               .flags          = UPF_BOOT_AUTOCONF,
-+               .iotype         = UPIO_MEM,
-+               .regshift       = 2,
-+               .uartclk        = IXP4XX_UART_XTAL,
-+       },
-+       { }
++	{
++		.mapbase	= IXP4XX_UART1_BASE_PHYS,
++		.membase	= (char *)IXP4XX_UART1_BASE_VIRT + REG_OFFSET,
++		.irq		= IRQ_IXP4XX_UART1,
++		.flags		= UPF_BOOT_AUTOCONF,
++		.iotype		= UPIO_MEM,
++		.regshift	= 2,
++		.uartclk	= IXP4XX_UART_XTAL,
++	},
++	{
++		.mapbase	= IXP4XX_UART2_BASE_PHYS,
++		.membase	= (char *)IXP4XX_UART2_BASE_VIRT + REG_OFFSET,
++		.irq		= IRQ_IXP4XX_UART2,
++		.flags		= UPF_BOOT_AUTOCONF,
++		.iotype		= UPIO_MEM,
++		.regshift	= 2,
++		.uartclk	= IXP4XX_UART_XTAL,
++	},
++	{ }
 +};
 +
 +static struct platform_device ds101_uart = {
-+       .name                   = "serial8250",
-+       .id                     = PLAT8250_DEV_PLATFORM,
-+       .dev.platform_data      = ds101_uart_data,
-+       .num_resources          = 2,
-+       .resource               = ds101_uart_resources,
++	.name			= "serial8250",
++	.id			= PLAT8250_DEV_PLATFORM,
++	.dev.platform_data	= ds101_uart_data,
++	.num_resources		= 2,
++	.resource		= ds101_uart_resources,
 +};
 +
 +static struct platform_device *ds101_devices[] __initdata = {
-+       &ds101_i2c_controller,
-+       &ds101_flash,
-+       &ds101_beeper,
++	&ds101_i2c_controller,
++	&ds101_beeper,
 +};
 +
 +static void ds101_power_off(void)
 +{
-+       /* This causes the box to drop the power and go dead. */
-+
-+       /* enable the pwr cntl gpio */
-+       gpio_line_config(DS101_PO_GPIO, IXP4XX_GPIO_OUT);
-+
-+       /* do the deed */
-+       gpio_line_set(DS101_PO_GPIO, IXP4XX_GPIO_HIGH);
++	/* Simple, but effective */
++	gpio_line_set(DS101_POWEROFF_GPIO, IXP4XX_GPIO_LOW);
 +}
 +
-+/*
-+ * When the RedBoot config partition is added the MAC address is read from
-+ * it.
-+ * FIXME: This isn't correct on the DS101!
-+ */
-+static void ds101_flash_add(struct mtd_info *mtd) {
-+       if (strcmp(mtd->name, "RedBoot config") == 0) {
-+               size_t retlen;
-+               u_char mac[6];
-+
-+               /* The MAC is at a known offset... */
-+               if (mtd->read(mtd, 0x0FD8, 6, &retlen, mac) == 0 && retlen == 6) {
-+                       printk(KERN_INFO "DS101 MAC: %.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n",
-+                               mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
-+                       maclist_add(mac);
-+               } else {
-+                       printk(KERN_ERR "DS101 MAC: read failed\n");
-+               }
-+       }
-+}
-+
-+/*
-+ * Nothing to do on remove at present.
-+ */
-+static void ds101_flash_remove(struct mtd_info *mtd) {
-+}
++static void ds101_gpio_setup(void)
++{
++	/* Set up buzzer */
++	gpio_line_config(DS101_GPIO_BUZZ, DS101_GPIO_OUT);
++	gpio_line_set(DS101_GPIO_BUZZ, DS101_GPIO_LOW);
++
++	/* Set up powerled */
++	gpio_line_config(DS101_POWER_LED, DS101_GPIO_OUT);
++	gpio_line_set(DS101_POWER_LED, DS101_GPIO_LOW);
++
++	/* Poweroff */
++	gpio_line_config(DS101_POWEROFF_GPIO, DS101_GPIO_OUT);
++	gpio_line_set(DS101_POWEROFF_GPIO, DS101_GPIO_HIGH);
++
++	/* Status leds */
++	(*IXP4XX_GPIO_GPCLKR) = ((*IXP4XX_GPIO_GPCLKR) & ~DS101_GPIO_CLK0_ENABLE);
++	(*IXP4XX_GPIO_GPCLKR) = ((*IXP4XX_GPIO_GPCLKR) & ~DS101_GPIO_CLK1_ENABLE);
++	gpio_line_config(DS101_STATUSOK_LED, DS101_GPIO_OUT);
++	gpio_line_config(DS101_STATUSBAD_LED, DS101_GPIO_OUT);
++	gpio_line_set(DS101_STATUSOK_LED, DS101_GPIO_HIGH);
++	gpio_line_set(DS101_STATUSBAD_LED, DS101_GPIO_LOW);
++};
 +
-+static struct mtd_notifier ds101_flash_notifier = {
-+       .add = ds101_flash_add,
-+       .remove = ds101_flash_remove,
++static void ds101_cs0_setup(void)
++{
++	*IXP4XX_EXP_CS0 = DS101_EXP_CS0_INIT;
 +};
 +
 +static void __init ds101_init(void)
 +{
-+       /* The flash has an ethernet MAC embedded in it which we need,
-+        * that is all this notifier does.
-+        */
-+       register_mtd_user(&ds101_flash_notifier);
-+
-+       ixp4xx_sys_init();
-+
-+       ds101_flash_resource.start = IXP4XX_EXP_BUS_BASE(0);
-+       ds101_flash_resource.end =
-+               IXP4XX_EXP_BUS_BASE(0) + ixp4xx_exp_bus_size - 1;
-+
-+       pm_power_off = ds101_power_off;
-+
-+       /* This is only useful on a modified machine, but it is valuable
-+        * to have it first in order to see debug messages, and so that
-+        * it does *not* get removed if platform_add_devices fails!
-+        */
-+       (void)platform_device_register(&ds101_uart);
-+
-+       platform_add_devices(ds101_devices, ARRAY_SIZE(ds101_devices));
-+
++	ixp4xx_sys_init();
++	ds101_cs0_setup(); /* Needed for DoC support */
++	ds101_gpio_setup();
++	pm_power_off = ds101_power_off;
++
++	/* This is only useful on a modified machine, but it is valuable
++	* to have it first in order to see debug messages, and so that
++	* it does *not* get removed if platform_add_devices fails!
++	*/
++	(void)platform_device_register(&ds101_uart);
++	platform_add_devices(ds101_devices, ARRAY_SIZE(ds101_devices));
 +#ifdef CONFIG_LEDS_CLASS
-+       /* We don't care whether or not this works. */
-+       (void)platform_device_register(&ds101_leds);
++	/* We don't care whether or not this works. */
++	(void)platform_device_register(&ds101_leds);
 +#endif
 +}
 +
 +/*
 + * DS101 bootstrap may pass in parameters, but we zap the mem
-+ * settings to be safe (the box always has 64MByte at 0).  The
-+ * passed in command line can override this default, we prepend
-+ * to the config'ed default.
++ * settings to be safe (DS101  always has 64MByte at 0, DS101J has
++ * 32MB).  The passed in command line can override this default, we
++ * prepend to the config'ed default.
 + *
 + * NOTE: the startup sequence is:
 + *     1) Call the machine fixup
 + *     2) Parse the ATAG list, the ATAG_CMDLINE is copied in
-+ *        to default_command_line which is the value of *from
++ *	to default_command_line which is the value of *from
 + *     3) Parse the command line in *from (*not*
-+ *        default_command_line unless they are the same!)
++ *	default_command_line unless they are the same!)
 + *
 + * Setting mi->nr_banks causes (2) to 'squash' (set to ATAG_NONE)
 + * any ATAG_MEM tags, but mem= command line options cause nr_banks
 + * to be reset to 0 (on the first mem=)
 + */
++
 +static char ds101_command_line[] __initdata =
-+       "root=/dev/sda1 rootfstype=ext3 init=/sbin/init "
-+       CONFIG_CMDLINE;
++	"root=/dev/sda1 rootfstype=ext3 init=/sbin/init "
++	"rtc-rs5c372.probe=0,0x32 "
++	CONFIG_CMDLINE;
 +
 +static void __init ds101_fixup(struct machine_desc *desc,
-+               struct tag *tags, char **cmdline, struct meminfo *mi)
++		struct tag *tags, char **cmdline, struct meminfo *mi)
 +{
-+       /* The DS101 has one bank of 64MByte memory.
-+        * NOTE: setting nr_banks != 0 causes kernel/setup.c to remove
-+        * the mem tags from the tag list.  We need do nothing here!
-+        */
-+       mi->nr_banks=1;
-+       mi->bank[0].start = 0;
-+       mi->bank[0].size = (64*1024*1024);
-+       mi->bank[0].node = PHYS_TO_NID(0);
-+
-+       /* A command line in the ATAG list will override this one,
-+        * as is intended.
-+        */
-+       strlcpy(*cmdline, ds101_command_line, COMMAND_LINE_SIZE);
++	/* The DS101 has one bank of 64MByte memory.
++	* NOTE: setting nr_banks != 0 causes kernel/setup.c to remove
++	* the mem tags from the tag list.  We need do nothing here!
++	*/
++	mi->nr_banks=1;
++	mi->bank[0].start = 0;
++	mi->bank[0].size = (64*1024*1024);
++	mi->bank[0].node = PHYS_TO_NID(0);
++	/* A command line in the ATAG list will override this one,
++	* as is intended.
++	*/
++	strlcpy(*cmdline, ds101_command_line, COMMAND_LINE_SIZE);
 +}
 +
 +MACHINE_START(DS101, "Synology DiskStation DS101")
-+       /* Maintainer: www.nslu2-linux.org */
-+       .phys_io        = IXP4XX_PERIPHERAL_BASE_PHYS,
-+       .io_pg_offst    = ((IXP4XX_PERIPHERAL_BASE_VIRT) >> 18) & 0xFFFC,
-+       .boot_params    = 0x00000100,
-+       .fixup          = ds101_fixup,
-+       .map_io         = ixp4xx_map_io,
-+       .init_irq       = ixp4xx_init_irq,
-+       .timer          = &ixp4xx_timer,
-+       .init_machine   = ds101_init,
++	/* Maintainer: www.nslu2-linux.org */
++	.phys_io	= IXP4XX_PERIPHERAL_BASE_PHYS,
++	.io_pg_offst	= ((IXP4XX_PERIPHERAL_BASE_VIRT) >> 18) & 0xFFFC,
++	.boot_params	= 0x00000100,
++	.fixup		= ds101_fixup,
++	.map_io		= ixp4xx_map_io,
++	.init_irq	= ixp4xx_init_irq,
++	.timer		= &ixp4xx_timer,
++	.init_machine	= ds101_init,
 +MACHINE_END
++
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/leds-class.patch b/packages/linux/ixp4xx-kernel/2.6.16/leds-class.patch
new file mode 100644
index 0000000000..9fbcae79b9
--- /dev/null
+++ b/packages/linux/ixp4xx-kernel/2.6.16/leds-class.patch
@@ -0,0 +1,2069 @@
+Add the foundations of a new LEDs subsystem. This patch adds a class
+which presents LED devices within sysfs and allows their brightness to
+be controlled.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-29 16:02:38.000000000 +0000
+@@ -0,0 +1,18 @@
++
++menu "LED devices"
++
++config NEW_LEDS
++	bool "LED Support"
++	help
++	  Say Y to enable Linux LED support.  This is not related to standard
++	  keyboard LEDs which are controlled via the input system.
++
++config LEDS_CLASS
++	tristate "LED Class Support"
++	depends NEW_LEDS
++	help
++	  This option enables the led sysfs class in /sys/class/leds.  You'll
++	  need this to do anything useful with LEDs.  If unsure, say N.
++
++endmenu
++
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-29 16:02:38.000000000 +0000
+@@ -0,0 +1,4 @@
++
++# LED Core
++obj-$(CONFIG_NEW_LEDS)			+= led-core.o
++obj-$(CONFIG_LEDS_CLASS)		+= led-class.o
+Index: linux-2.6.15/include/linux/leds.h
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/include/linux/leds.h	2006-01-29 16:03:21.000000000 +0000
+@@ -0,0 +1,48 @@
++/*
++ * Driver model for leds and led triggers
++ *
++ * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
++ * Copyright (C) 2005 Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++struct device;
++struct class_device;
++/*
++ * LED Core
++ */
++
++enum led_brightness {
++	LED_OFF = 0,
++	LED_HALF = 127,
++	LED_FULL = 255,
++};
++
++struct led_classdev {
++	const char *name;
++	int brightness;
++	int flags;
++#define LED_SUSPENDED       (1 << 0)
++
++	/* A function to set the brightness of the led */
++	void (*brightness_set)(struct led_classdev *led_cdev, enum led_brightness brightness);
++
++	struct class_device *class_dev;
++	/* LED Device linked list */
++	struct list_head node;
++
++	/* Trigger data */
++	char *default_trigger;
++
++	/* This protects the data in this structure */
++	rwlock_t lock;
++};
++
++extern int led_classdev_register(struct device *parent, struct led_classdev *led_cdev);
++extern void led_classdev_unregister(struct led_classdev *led_cdev);
++extern void led_classdev_suspend(struct led_classdev *led_cdev);
++extern void led_classdev_resume(struct led_classdev *led_cdev);
+Index: linux-2.6.15/arch/arm/Kconfig
+===================================================================
+--- linux-2.6.15.orig/arch/arm/Kconfig	2006-01-29 14:37:31.000000000 +0000
++++ linux-2.6.15/arch/arm/Kconfig	2006-01-29 16:02:15.000000000 +0000
+@@ -774,6 +774,8 @@
+ 
+ source "drivers/mfd/Kconfig"
+ 
++source "drivers/leds/Kconfig"
++
+ source "drivers/media/Kconfig"
+ 
+ source "drivers/video/Kconfig"
+Index: linux-2.6.15/drivers/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/Makefile	2006-01-29 14:42:52.000000000 +0000
++++ linux-2.6.15/drivers/Makefile	2006-01-29 14:43:11.000000000 +0000
+@@ -68,6 +68,7 @@
+ obj-$(CONFIG_EISA)		+= eisa/
+ obj-$(CONFIG_CPU_FREQ)		+= cpufreq/
+ obj-$(CONFIG_MMC)		+= mmc/
++obj-$(CONFIG_NEW_LEDS)		+= leds/
+ obj-$(CONFIG_INFINIBAND)	+= infiniband/
+ obj-$(CONFIG_SGI_IOC4)		+= sn/
+ obj-y				+= firmware/
+Index: linux-2.6.15/drivers/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/Kconfig	2006-01-29 14:42:51.000000000 +0000
++++ linux-2.6.15/drivers/Kconfig	2006-01-29 14:43:11.000000000 +0000
+@@ -64,6 +64,8 @@
+ 
+ source "drivers/mmc/Kconfig"
+ 
++source "drivers/leds/Kconfig"
++
+ source "drivers/infiniband/Kconfig"
+ 
+ source "drivers/sn/Kconfig"
+Index: linux-2.6.15/drivers/leds/leds.h
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds.h	2006-01-29 16:02:38.000000000 +0000
+@@ -0,0 +1,26 @@
++/*
++ * LED Core
++ *
++ * Copyright 2005 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++/* led_cdev->lock must be held as write */
++static inline void led_set_brightness(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value > LED_FULL)
++		value = LED_FULL;
++	led_cdev->brightness = value;
++	if (!(led_cdev->flags & LED_SUSPENDED))
++		led_cdev->brightness_set(led_cdev, value);
++}
++
++extern rwlock_t leds_list_lock;
++extern struct list_head leds_list;
++
+Index: linux-2.6.15/drivers/leds/led-class.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/led-class.c	2006-01-29 16:02:38.000000000 +0000
+@@ -0,0 +1,150 @@
++/*
++ * LED Class Core
++ *
++ * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
++ * Copyright (C) 2005-2006 Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ */
++
++#include <linux/config.h>
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/list.h>
++#include <linux/spinlock.h>
++#include <linux/device.h>
++#include <linux/sysdev.h>
++#include <linux/timer.h>
++#include <linux/err.h>
++#include <linux/leds.h>
++#include "leds.h"
++
++static struct class *leds_class;
++
++static ssize_t led_brightness_show(struct class_device *dev, char *buf)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	ssize_t ret = 0;
++
++	/* no lock needed for this */
++	sprintf(buf, "%u\n", led_cdev->brightness);
++	ret = strlen(buf) + 1;
++
++	return ret;
++}
++
++static ssize_t led_brightness_store(struct class_device *dev, const char *buf, size_t size)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	ssize_t ret = -EINVAL;
++	char *after;
++
++	unsigned long state = simple_strtoul(buf, &after, 10);
++	if (after - buf > 0) {
++		ret = after - buf;
++		write_lock(&led_cdev->lock);
++		led_set_brightness(led_cdev, state);
++		write_unlock(&led_cdev->lock);
++	}
++
++	return ret;
++}
++
++static CLASS_DEVICE_ATTR(brightness, 0644, led_brightness_show, led_brightness_store);
++
++
++/**
++ * led_classdev_suspend - suspend an led_classdev.
++ * @led_cdev: the led_classdev to suspend.
++ */
++void led_classdev_suspend(struct led_classdev *led_cdev)
++{
++	write_lock(&led_cdev->lock);
++	led_cdev->flags |= LED_SUSPENDED;
++	led_cdev->brightness_set(led_cdev, 0);
++	write_unlock(&led_cdev->lock);
++}
++
++/**
++ * led_classdev_resume - resume an led_classdev.
++ * @led_cdev: the led_classdev to resume.
++ */
++void led_classdev_resume(struct led_classdev *led_cdev)
++{
++	write_lock(&led_cdev->lock);
++	led_cdev->flags &= ~LED_SUSPENDED;
++	led_cdev->brightness_set(led_cdev, led_cdev->brightness);
++	write_unlock(&led_cdev->lock);
++}
++
++/**
++ * led_classdev_register - register a new object of led_classdev class.
++ * @dev: The device to register.
++ * @led_cdev: the led_classdev structure for this device.
++ */
++int led_classdev_register(struct device *parent, struct led_classdev *led_cdev)
++{
++	led_cdev->class_dev = class_device_create(leds_class, NULL, 0, parent, "%s", led_cdev->name);
++	if (unlikely(IS_ERR(led_cdev->class_dev)))
++		return PTR_ERR(led_cdev->class_dev);
++
++	rwlock_init(&led_cdev->lock);
++	led_cdev->class_dev->class_data = led_cdev;
++
++	/* register the attributes */
++	class_device_create_file(led_cdev->class_dev, &class_device_attr_brightness);
++
++	/* add to the list of leds */
++	write_lock(&leds_list_lock);
++	list_add_tail(&led_cdev->node, &leds_list);
++	write_unlock(&leds_list_lock);
++
++	printk(KERN_INFO "Registered led device: %s\n", led_cdev->class_dev->class_id);
++
++	return 0;
++}
++
++/**
++ * led_classdev_unregister - unregisters a object of led_properties class.
++ * @led_cdev: the led device to unreigister
++ *
++ * Unregisters a previously registered via led_classdev_register object.
++ */
++void led_classdev_unregister(struct led_classdev *led_cdev)
++{
++	class_device_remove_file(led_cdev->class_dev, &class_device_attr_brightness);
++
++	class_device_unregister(led_cdev->class_dev);
++
++	write_lock(&leds_list_lock);
++	list_del(&led_cdev->node);
++	write_unlock(&leds_list_lock);
++}
++
++EXPORT_SYMBOL_GPL(led_classdev_suspend);
++EXPORT_SYMBOL_GPL(led_classdev_resume);
++EXPORT_SYMBOL_GPL(led_classdev_register);
++EXPORT_SYMBOL_GPL(led_classdev_unregister);
++
++static int __init leds_init(void)
++{
++	leds_class = class_create(THIS_MODULE, "leds");
++	if (IS_ERR(leds_class))
++		return PTR_ERR(leds_class);
++	return 0;
++}
++
++static void __exit leds_exit(void)
++{
++	class_destroy(leds_class);
++}
++
++subsys_initcall(leds_init);
++module_exit(leds_exit);
++
++MODULE_AUTHOR("John Lenz, Richard Purdie");
++MODULE_LICENSE("GPL");
++MODULE_DESCRIPTION("LED Class Interface");
+Index: linux-2.6.15/drivers/leds/led-core.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/led-core.c	2006-01-29 14:43:11.000000000 +0000
+@@ -0,0 +1,24 @@
++/*
++ * LED Class Core
++ *
++ * Copyright 2005-2006 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/module.h>
++#include <linux/spinlock.h>
++#include <linux/leds.h>
++#include "leds.h"
++
++rwlock_t leds_list_lock = RW_LOCK_UNLOCKED;
++LIST_HEAD(leds_list);
++
++EXPORT_SYMBOL_GPL(leds_list);
+Add support for LED triggers to the LED subsystem. "Triggers" are events 
+which change the state of an LED. Two kinds of trigger are available,
+simple ones which can be added to exising code with minimum disruption
+and complex ones for implementing new or more complex functionality.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Kconfig	2006-01-29 15:52:16.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-29 16:02:35.000000000 +0000
+@@ -14,5 +14,13 @@
+ 	  This option enables the led sysfs class in /sys/class/leds.  You'll
+ 	  need this to do anything useful with LEDs.  If unsure, say N.
+ 
++config LEDS_TRIGGERS
++	bool "LED Trigger support"
++	depends NEW_LEDS
++	help
++	  This option enables trigger support for the leds class.
++	  These triggers allow kernel events to drive the LEDs and can
++	  be configured via sysfs. If unsure, say Y.
++
+ endmenu
+ 
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Makefile	2006-01-29 15:52:16.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-29 16:02:35.000000000 +0000
+@@ -2,3 +2,4 @@
+ # LED Core
+ obj-$(CONFIG_NEW_LEDS)			+= led-core.o
+ obj-$(CONFIG_LEDS_CLASS)		+= led-class.o
++obj-$(CONFIG_LEDS_TRIGGERS)		+= led-triggers.o
+Index: linux-2.6.15/drivers/leds/leds.h
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/leds.h	2006-01-29 15:54:46.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds.h	2006-01-29 15:55:02.000000000 +0000
+@@ -24,3 +24,13 @@
+ extern rwlock_t leds_list_lock;
+ extern struct list_head leds_list;
+ 
++#ifdef CONFIG_LEDS_TRIGGERS
++void led_trigger_set_default(struct led_classdev *led_cdev);
++void led_trigger_set(struct led_classdev *led_cdev, struct led_trigger *trigger);
++#else
++#define led_trigger_set_default(x) do {} while(0)
++#define led_trigger_set(x, y) do {} while(0)
++#endif
++
++ssize_t led_trigger_store(struct class_device *dev, const char *buf, size_t count);
++ssize_t led_trigger_show(struct class_device *dev, char *buf);
+Index: linux-2.6.15/include/linux/leds.h
+===================================================================
+--- linux-2.6.15.orig/include/linux/leds.h	2006-01-29 15:52:16.000000000 +0000
++++ linux-2.6.15/include/linux/leds.h	2006-01-29 15:55:02.000000000 +0000
+@@ -38,6 +38,11 @@
+ 
+ 	/* Trigger data */
+ 	char *default_trigger;
++#ifdef CONFIG_LEDS_TRIGGERS
++	struct led_trigger *trigger;
++	struct list_head trig_list;
++	void *trigger_data;
++#endif
+ 
+ 	/* This protects the data in this structure */
+ 	rwlock_t lock;
+@@ -47,3 +52,47 @@
+ extern void led_classdev_unregister(struct led_classdev *led_cdev);
+ extern void led_classdev_suspend(struct led_classdev *led_cdev);
+ extern void led_classdev_resume(struct led_classdev *led_cdev);
++
++
++/*
++ * LED Triggers
++ */
++#ifdef CONFIG_LEDS_TRIGGERS
++
++#define TRIG_NAME_MAX 50
++
++struct led_trigger {
++	/* Trigger Properties */
++	const char *name;
++	void (*activate)(struct led_classdev *led_cdev);
++	void (*deactivate)(struct led_classdev *led_cdev);
++
++	/* LEDs under control by this trigger (for simple triggers) */
++	rwlock_t leddev_list_lock;
++	struct list_head led_cdevs;
++
++	/* Link to next registered trigger */
++	struct list_head next_trig;
++};
++
++/* Registration functions for complex triggers */
++int led_trigger_register(struct led_trigger *trigger);
++void led_trigger_unregister(struct led_trigger *trigger);
++
++/* Registration functions for simple triggers */
++#define INIT_LED_TRIGGER(x)		static struct led_trigger *x;
++#define INIT_LED_TRIGGER_GLOBAL(x)	struct led_trigger *x;
++void led_trigger_register_simple(const char *name, struct led_trigger **trigger);
++void led_trigger_unregister_simple(struct led_trigger *trigger);
++void led_trigger_event(struct led_trigger *trigger, enum led_brightness event);
++
++#else
++
++/* Triggers aren't active - null macros */
++#define INIT_LED_TRIGGER(x)
++#define INIT_LED_TRIGGER_GLOBAL(x)
++#define led_trigger_register_simple(x, y) do {} while(0)
++#define led_trigger_unregister_simple(x) do {} while(0)
++#define led_trigger_event(x, y) do {} while(0)
++
++#endif
+Index: linux-2.6.15/drivers/leds/led-class.c
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/led-class.c	2006-01-29 15:54:02.000000000 +0000
++++ linux-2.6.15/drivers/leds/led-class.c	2006-01-29 15:55:02.000000000 +0000
+@@ -55,6 +55,9 @@
+ 
+ static CLASS_DEVICE_ATTR(brightness, 0644, led_brightness_show, led_brightness_store);
+ 
++#ifdef CONFIG_LEDS_TRIGGERS
++static CLASS_DEVICE_ATTR(trigger, 0644, led_trigger_show, led_trigger_store);
++#endif
+ 
+ /**
+  * led_classdev_suspend - suspend an led_classdev.
+@@ -96,12 +99,17 @@
+ 
+ 	/* register the attributes */
+ 	class_device_create_file(led_cdev->class_dev, &class_device_attr_brightness);
++#ifdef CONFIG_LEDS_TRIGGERS
++	class_device_create_file(led_cdev->class_dev, &class_device_attr_trigger);
++#endif
+ 
+ 	/* add to the list of leds */
+ 	write_lock(&leds_list_lock);
+ 	list_add_tail(&led_cdev->node, &leds_list);
+ 	write_unlock(&leds_list_lock);
+ 
++	led_trigger_set_default(led_cdev);
++
+ 	printk(KERN_INFO "Registered led device: %s\n", led_cdev->class_dev->class_id);
+ 
+ 	return 0;
+@@ -116,6 +124,12 @@
+ void led_classdev_unregister(struct led_classdev *led_cdev)
+ {
+ 	class_device_remove_file(led_cdev->class_dev, &class_device_attr_brightness);
++#ifdef CONFIG_LEDS_TRIGGERS
++	class_device_remove_file(led_cdev->class_dev, &class_device_attr_trigger);
++#endif
++
++	if (led_cdev->trigger)
++		led_trigger_set(led_cdev, NULL);
+ 
+ 	class_device_unregister(led_cdev->class_dev);
+ 
+Index: linux-2.6.15/drivers/leds/led-triggers.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/led-triggers.c	2006-01-29 15:56:15.000000000 +0000
+@@ -0,0 +1,236 @@
++/*
++ * LED Triggers Core
++ *
++ * Copyright 2005-2006 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/list.h>
++#include <linux/spinlock.h>
++#include <linux/device.h>
++#include <linux/sysdev.h>
++#include <linux/timer.h>
++#include <linux/leds.h>
++#include "leds.h"
++
++static rwlock_t triggers_list_lock = RW_LOCK_UNLOCKED;
++static LIST_HEAD(trigger_list);
++
++ssize_t led_trigger_store(struct class_device *dev, const char *buf, size_t count)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	char trigger_name[TRIG_NAME_MAX];
++	struct led_trigger *trig;
++	size_t len;
++
++	trigger_name[sizeof(trigger_name) - 1] = '\0';
++	strncpy(trigger_name, buf, sizeof(trigger_name) - 1);
++	len = strlen(trigger_name);
++
++	if (len && trigger_name[len - 1] == '\n')
++		trigger_name[len - 1] = '\0';
++
++	if (!strcmp(trigger_name, "none")) {
++		write_lock(&led_cdev->lock);
++		led_trigger_set(led_cdev, NULL);
++		write_unlock(&led_cdev->lock);
++		return count;
++	}
++
++	read_lock(&triggers_list_lock);
++	list_for_each_entry(trig, &trigger_list, next_trig) {
++		if (!strcmp(trigger_name, trig->name)) {
++			write_lock(&led_cdev->lock);
++			led_trigger_set(led_cdev, trig);
++			write_unlock(&led_cdev->lock);
++
++			read_unlock(&triggers_list_lock);
++			return count;
++		}
++	}
++	read_unlock(&triggers_list_lock);
++
++	return -EINVAL;
++}
++
++
++ssize_t led_trigger_show(struct class_device *dev, char *buf)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	struct led_trigger *trig;
++	int len = 0;
++
++	read_lock(&led_cdev->lock);
++
++	if (!led_cdev->trigger)
++		len += sprintf(buf+len, "[none] ");
++	else
++		len += sprintf(buf+len, "none ");
++
++	read_lock(&triggers_list_lock);
++	list_for_each_entry(trig, &trigger_list, next_trig) {
++		if (led_cdev->trigger && !strcmp(led_cdev->trigger->name,  trig->name))
++			len += sprintf(buf+len, "[%s] ", trig->name);
++		else
++			len += sprintf(buf+len, "%s ", trig->name);
++	}
++	read_unlock(&triggers_list_lock);
++	read_unlock(&led_cdev->lock);
++
++	len += sprintf(len+buf, "\n");
++	return len;
++}
++
++void led_trigger_event(struct led_trigger *trigger, enum led_brightness brightness)
++{
++	struct list_head *entry;
++
++	if (!trigger)
++		return;
++
++	read_lock(&trigger->leddev_list_lock);
++	list_for_each(entry, &trigger->led_cdevs) {
++		struct led_classdev *led_cdev;
++
++		led_cdev = list_entry(entry, struct led_classdev, trig_list);
++		write_lock(&led_cdev->lock);
++		led_set_brightness(led_cdev, brightness);
++		write_unlock(&led_cdev->lock);
++	}
++	read_unlock(&trigger->leddev_list_lock);
++}
++
++/* Caller must ensure led_cdev->lock held for write */
++void led_trigger_set(struct led_classdev *led_cdev, struct led_trigger *trigger)
++{
++	/* Remove any existing trigger */
++	if (led_cdev->trigger) {
++		write_lock(&led_cdev->trigger->leddev_list_lock);
++		list_del(&led_cdev->trig_list);
++		write_unlock(&led_cdev->trigger->leddev_list_lock);
++		if (led_cdev->trigger->deactivate)
++			led_cdev->trigger->deactivate(led_cdev);
++
++	}
++	if (trigger) {
++		write_lock(&trigger->leddev_list_lock);
++		list_add_tail(&led_cdev->trig_list, &trigger->led_cdevs);
++		write_unlock(&trigger->leddev_list_lock);
++		if (trigger->activate)
++			trigger->activate(led_cdev);
++	}
++	led_cdev->trigger = trigger;
++}
++
++void led_trigger_set_default(struct led_classdev *led_cdev)
++{
++	struct led_trigger *trig;
++
++	if (!led_cdev->default_trigger)
++		return;
++
++	write_lock(&led_cdev->lock);
++	read_lock(&triggers_list_lock);
++	list_for_each_entry(trig, &trigger_list, next_trig) {
++		if (!strcmp(led_cdev->default_trigger, trig->name))
++			led_trigger_set(led_cdev, trig);
++	}
++	read_unlock(&triggers_list_lock);
++	write_unlock(&led_cdev->lock);
++}
++
++int led_trigger_register(struct led_trigger *trigger)
++{
++	struct led_classdev *led_cdev;
++
++	rwlock_init(&trigger->leddev_list_lock);
++	INIT_LIST_HEAD(&trigger->led_cdevs);
++
++	/* Add to the list of led triggers */
++	write_lock(&triggers_list_lock);
++		list_add_tail(&trigger->next_trig, &trigger_list);
++	write_unlock(&triggers_list_lock);
++
++	/* Register with any LEDs that have this as a default trigger */
++	read_lock(&leds_list);
++	list_for_each_entry(led_cdev, &leds_list, node) {
++		write_lock(&led_cdev->lock);
++		if (!led_cdev->trigger && led_cdev->default_trigger &&
++				!strcmp(led_cdev->default_trigger, trigger->name))
++			led_trigger_set(led_cdev, trigger);
++		write_unlock(&led_cdev->lock);
++	}
++	read_unlock(&leds_list);
++
++	return 0;
++}
++
++void led_trigger_register_simple(const char *name, struct led_trigger **tp)
++{
++        struct led_trigger *trigger;
++
++	trigger = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
++
++	if (trigger) {
++		trigger->name = name;
++		led_trigger_register(trigger);
++	}
++	*tp = trigger;
++}
++
++
++void led_trigger_unregister(struct led_trigger *trigger)
++{
++	struct led_classdev *led_cdev;
++
++	/* Remove from the list of led triggers */
++	write_lock(&triggers_list_lock);
++		list_del(&trigger->next_trig);
++	write_unlock(&triggers_list_lock);
++
++	/* Remove anyone actively using this trigger */
++	read_lock(&leds_list);
++	list_for_each_entry(led_cdev, &leds_list, node) {
++		write_lock(&led_cdev->lock);
++		if (led_cdev->trigger == trigger)
++			led_trigger_set(led_cdev, NULL);
++		write_unlock(&led_cdev->lock);
++	}
++	read_unlock(&leds_list);
++}
++
++void led_trigger_unregister_simple(struct led_trigger *trigger)
++{
++	led_trigger_unregister(trigger);
++	kfree(trigger);
++}
++
++/* Used by LED Class */
++EXPORT_SYMBOL_GPL(led_trigger_set);
++EXPORT_SYMBOL_GPL(led_trigger_set_default);
++EXPORT_SYMBOL_GPL(led_trigger_show);
++EXPORT_SYMBOL_GPL(led_trigger_store);
++
++/* LED Trigger Interface */
++EXPORT_SYMBOL_GPL(led_trigger_register);
++EXPORT_SYMBOL_GPL(led_trigger_unregister);
++
++/* Simple LED Tigger Interface */
++EXPORT_SYMBOL_GPL(led_trigger_register_simple);
++EXPORT_SYMBOL_GPL(led_trigger_unregister_simple);
++EXPORT_SYMBOL_GPL(led_trigger_event);
++
++MODULE_AUTHOR("Richard Purdie");
++MODULE_LICENSE("GPL");
++MODULE_DESCRIPTION("LED Triggers Core");
++
+Add an example of a complex LED trigger in the form of a generic timer 
+which triggers the LED its attached to at a user specified frequency
+and duty cycle.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Kconfig	2006-01-29 16:13:48.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-29 20:32:16.000000000 +0000
+@@ -22,5 +22,12 @@
+ 	  These triggers allow kernel events to drive the LEDs and can
+ 	  be configured via sysfs. If unsure, say Y.
+ 
++config LEDS_TRIGGER_TIMER
++	tristate "LED Timer Trigger"
++	depends LEDS_TRIGGERS
++	help
++	  This allows LEDs to be controlled by a programmable timer
++	  via sysfs. If unsure, say Y.
++
+ endmenu
+ 
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Makefile	2006-01-29 16:13:48.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-29 20:32:16.000000000 +0000
+@@ -3,3 +3,6 @@
+ obj-$(CONFIG_NEW_LEDS)			+= led-core.o
+ obj-$(CONFIG_LEDS_CLASS)		+= led-class.o
+ obj-$(CONFIG_LEDS_TRIGGERS)		+= led-triggers.o
++
++# LED Triggers
++obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
+Index: linux-2.6.15/drivers/leds/ledtrig-timer.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/ledtrig-timer.c	2006-01-29 17:40:11.000000000 +0000
+@@ -0,0 +1,205 @@
++/*
++ * LED Kernel Timer Trigger
++ *
++ * Copyright 2005-2006 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/list.h>
++#include <linux/spinlock.h>
++#include <linux/device.h>
++#include <linux/sysdev.h>
++#include <linux/timer.h>
++#include <linux/leds.h>
++#include "leds.h"
++
++struct timer_trig_data {
++	unsigned long duty; /* duty cycle, as a percentage */
++	unsigned long frequency; /* frequency of blinking, in Hz */
++	unsigned long delay_on; /* milliseconds on */
++	unsigned long delay_off; /* milliseconds off */
++	struct timer_list timer;
++};
++
++static void led_timer_function(unsigned long data)
++{
++	struct led_classdev *led_cdev = (struct led_classdev *) data;
++	struct timer_trig_data *timer_data = led_cdev->trigger_data;
++	unsigned long brightness = LED_OFF;
++	unsigned long delay = timer_data->delay_off;
++
++	write_lock(&led_cdev->lock);
++
++	if (!timer_data->frequency) {
++		led_set_brightness(led_cdev, LED_OFF);
++		write_unlock(&led_cdev->lock);
++		return;
++	}
++
++	if (!led_cdev->brightness) {
++		brightness = LED_FULL;
++		delay = timer_data->delay_on;
++	}
++
++	led_set_brightness(led_cdev, brightness);
++
++	mod_timer(&timer_data->timer, jiffies + msecs_to_jiffies(delay));
++	write_unlock(&led_cdev->lock);
++}
++
++/* led_cdev write lock needs to be held */
++static int led_timer_setdata(struct led_classdev *led_cdev, unsigned long duty, unsigned long frequency)
++{
++	struct timer_trig_data *timer_data = led_cdev->trigger_data;
++
++	if (frequency > 500)
++		return -EINVAL;
++
++	if (duty > 100)
++		return -EINVAL;
++
++	timer_data->duty = duty;
++	timer_data->frequency = frequency;
++	if (frequency != 0) {
++		timer_data->delay_on = duty * 1000 / 50 / frequency / 2;
++		timer_data->delay_off = (100 - duty) * 1000 / 50 / frequency / 2;
++	}
++
++	mod_timer(&timer_data->timer, jiffies + 1);
++
++	return 0;
++}
++
++static ssize_t led_duty_show(struct class_device *dev, char *buf)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	struct timer_trig_data *timer_data;
++
++	read_lock(&led_cdev->lock);
++	timer_data = led_cdev->trigger_data;
++	sprintf(buf, "%lu\n", timer_data->duty);
++	read_unlock(&led_cdev->lock);
++
++	return strlen(buf) + 1;
++}
++
++static ssize_t led_duty_store(struct class_device *dev, const char *buf, size_t size)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	struct timer_trig_data *timer_data;
++	int ret = -EINVAL;
++	char *after;
++
++	unsigned long state = simple_strtoul(buf, &after, 10);
++	if (after - buf > 0) {
++		write_lock(&led_cdev->lock);
++		timer_data = led_cdev->trigger_data;
++		ret = led_timer_setdata(led_cdev, state, timer_data->frequency);
++		if (!ret)
++			ret = after - buf;			
++		write_unlock(&led_cdev->lock);
++	}
++
++	return ret;
++}
++
++
++static ssize_t led_frequency_show(struct class_device *dev, char *buf)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	struct timer_trig_data *timer_data;
++
++	read_lock(&led_cdev->lock);
++	timer_data = led_cdev->trigger_data;
++	sprintf(buf, "%lu\n", timer_data->frequency);
++	read_unlock(&led_cdev->lock);
++
++	return strlen(buf) + 1;
++}
++
++static ssize_t led_frequency_store(struct class_device *dev, const char *buf, size_t size)
++{
++	struct led_classdev *led_cdev = dev->class_data;
++	struct timer_trig_data *timer_data;
++	int ret = -EINVAL;
++	char *after;
++
++	unsigned long state = simple_strtoul(buf, &after, 10);
++	if (after - buf > 0) {
++		write_lock(&led_cdev->lock);
++		timer_data = led_cdev->trigger_data;
++		ret = led_timer_setdata(led_cdev, timer_data->duty, state);
++		if (!ret)
++			ret = after - buf;			
++		write_unlock(&led_cdev->lock);
++	}
++
++	return ret;
++}
++
++static CLASS_DEVICE_ATTR(duty, 0644, led_duty_show, led_duty_store);
++static CLASS_DEVICE_ATTR(frequency, 0644, led_frequency_show, led_frequency_store);
++
++static void timer_trig_activate(struct led_classdev *led_cdev)
++{
++	struct timer_trig_data *timer_data;
++
++	timer_data = kzalloc(sizeof(struct timer_trig_data), GFP_KERNEL);
++	if (!timer_data)
++		return;
++
++	led_cdev->trigger_data = timer_data;
++
++	init_timer(&timer_data->timer);
++	timer_data->timer.function = led_timer_function;
++	timer_data->timer.data = (unsigned long) led_cdev;
++
++	timer_data->duty = 50;
++
++	class_device_create_file(led_cdev->class_dev, &class_device_attr_duty);
++	class_device_create_file(led_cdev->class_dev, &class_device_attr_frequency);
++}
++
++static void timer_trig_deactivate(struct led_classdev *led_cdev)
++{
++	struct timer_trig_data *timer_data = led_cdev->trigger_data;
++	if (timer_data) {
++		class_device_remove_file(led_cdev->class_dev, &class_device_attr_duty);
++		class_device_remove_file(led_cdev->class_dev, &class_device_attr_frequency);
++		del_timer_sync(&timer_data->timer);
++		kfree(timer_data);
++	}
++}
++
++static struct led_trigger timer_led_trigger = {
++	.name     = "timer",
++	.activate = timer_trig_activate,
++	.deactivate = timer_trig_deactivate,
++};
++
++static int __init timer_trig_init(void)
++{
++	return led_trigger_register(&timer_led_trigger);
++}
++
++static void __exit timer_trig_exit (void)
++{
++	led_trigger_unregister(&timer_led_trigger);
++}
++
++module_init(timer_trig_init);
++module_exit(timer_trig_exit);
++
++MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>");
++MODULE_DESCRIPTION("Timer LED trigger");
++MODULE_LICENSE("GPL");
+Adds LED drivers for LEDs found on the Sharp Zaurus c7x0 (corgi, 
+shepherd, husky) and cxx00 (akita, spitz, borzoi) models.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/arch/arm/mach-pxa/corgi.c
+===================================================================
+--- linux-2.6.15.orig/arch/arm/mach-pxa/corgi.c	2006-01-29 16:02:30.000000000 +0000
++++ linux-2.6.15/arch/arm/mach-pxa/corgi.c	2006-01-29 16:11:47.000000000 +0000
+@@ -165,6 +165,15 @@
+ 
+ 
+ /*
++ * Corgi LEDs
++ */
++static struct platform_device corgiled_device = {
++	.name		= "corgi-led",
++	.id		= -1,
++};
++
++
++/*
+  * Corgi Touch Screen Device
+  */
+ static struct resource corgits_resources[] = {
+@@ -298,6 +307,7 @@
+ 	&corgikbd_device,
+ 	&corgibl_device,
+ 	&corgits_device,
++	&corgiled_device,
+ };
+ 
+ static void __init corgi_init(void)
+Index: linux-2.6.15/arch/arm/mach-pxa/spitz.c
+===================================================================
+--- linux-2.6.15.orig/arch/arm/mach-pxa/spitz.c	2006-01-29 16:02:30.000000000 +0000
++++ linux-2.6.15/arch/arm/mach-pxa/spitz.c	2006-01-29 16:11:48.000000000 +0000
+@@ -243,6 +243,15 @@
+ 
+ 
+ /*
++ * Spitz LEDs
++ */
++static struct platform_device spitzled_device = {
++	.name		= "spitz-led",
++	.id		= -1,
++};
++
++
++/*
+  * Spitz Touch Screen Device
+  */
+ static struct resource spitzts_resources[] = {
+@@ -419,6 +428,7 @@
+ 	&spitzkbd_device,
+ 	&spitzts_device,
+ 	&spitzbl_device,
++	&spitzled_device,
+ };
+ 
+ static void __init common_init(void)
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Kconfig	2006-01-29 16:04:20.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-29 16:11:54.000000000 +0000
+@@ -22,6 +22,20 @@
+ 	  These triggers allow kernel events to drive the LEDs and can
+ 	  be configured via sysfs. If unsure, say Y.
+ 
++config LEDS_CORGI
++	tristate "LED Support for the Sharp SL-C7x0 series"
++	depends LEDS_CLASS && PXA_SHARP_C7xx
++	help
++	  This option enables support for the LEDs on Sharp Zaurus
++	  SL-C7x0 series (C700, C750, C760, C860).
++
++config LEDS_SPITZ
++	tristate "LED Support for the Sharp SL-Cxx00 series"
++	depends LEDS_CLASS && PXA_SHARP_Cxx00
++	help
++	  This option enables support for the LEDs on Sharp Zaurus
++	  SL-Cxx00 series (C1000, C3000, C3100).
++
+ config LEDS_TRIGGER_TIMER
+ 	tristate "LED Timer Trigger"
+ 	depends LEDS_TRIGGERS
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Makefile	2006-01-29 16:04:20.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-29 16:11:54.000000000 +0000
+@@ -4,5 +4,9 @@
+ obj-$(CONFIG_LEDS_CLASS)		+= led-class.o
+ obj-$(CONFIG_LEDS_TRIGGERS)		+= led-triggers.o
+ 
++# LED Platform Drivers
++obj-$(CONFIG_LEDS_CORGI)		+= leds-corgi.o
++obj-$(CONFIG_LEDS_SPITZ)		+= leds-spitz.o
++
+ # LED Triggers
+ obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
+Index: linux-2.6.15/drivers/leds/leds-corgi.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds-corgi.c	2006-01-29 16:08:42.000000000 +0000
+@@ -0,0 +1,121 @@
++/*
++ * LED Triggers Core
++ *
++ * Copyright 2005-2006 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/leds.h>
++#include <asm/mach-types.h>
++#include <asm/arch/corgi.h>
++#include <asm/arch/hardware.h>
++#include <asm/arch/pxa-regs.h>
++#include <asm/hardware/scoop.h>
++
++static void corgiled_amber_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		GPSR0 = GPIO_bit(CORGI_GPIO_LED_ORANGE);
++	else
++		GPCR0 = GPIO_bit(CORGI_GPIO_LED_ORANGE);
++}
++
++static void corgiled_green_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		set_scoop_gpio(&corgiscoop_device.dev, CORGI_SCP_LED_GREEN);
++	else
++		reset_scoop_gpio(&corgiscoop_device.dev, CORGI_SCP_LED_GREEN);
++}
++
++static struct led_classdev corgi_amber_led = {
++	.name			= "corgi:amber",
++	.default_trigger	= "sharpsl-charge",
++	.brightness_set		= corgiled_amber_set,
++};
++
++static struct led_classdev corgi_green_led = {
++	.name			= "corgi:green",
++	.default_trigger	= "nand-disk",
++	.brightness_set		= corgiled_green_set,
++};
++
++#ifdef CONFIG_PM
++static int corgiled_suspend(struct platform_device *dev, pm_message_t state)
++{
++#ifdef CONFIG_LEDS_TRIGGERS
++	if (corgi_amber_led.trigger && strcmp(corgi_amber_led.trigger->name, "sharpsl-charge"))
++#endif
++		led_classdev_suspend(&corgi_amber_led);
++	led_classdev_suspend(&corgi_green_led);
++	return 0;
++}
++
++static int corgiled_resume(struct platform_device *dev)
++{
++	led_classdev_resume(&corgi_amber_led);
++	led_classdev_resume(&corgi_green_led);
++	return 0;
++}
++#endif
++
++static int corgiled_probe(struct platform_device *pdev)
++{
++	int ret;
++
++	ret = led_classdev_register(&pdev->dev, &corgi_amber_led);
++	if (ret < 0)
++		return ret;
++
++	ret = led_classdev_register(&pdev->dev, &corgi_green_led);
++	if (ret < 0)
++		led_classdev_unregister(&corgi_amber_led);
++
++	return ret;
++}
++
++static int corgiled_remove(struct platform_device *pdev)
++{
++	led_classdev_unregister(&corgi_amber_led);
++	led_classdev_unregister(&corgi_green_led);
++	return 0;
++}
++
++static struct platform_driver corgiled_driver = {
++	.probe		= corgiled_probe,
++	.remove		= corgiled_remove,
++#ifdef CONFIG_PM
++	.suspend	= corgiled_suspend,
++	.resume		= corgiled_resume,
++#endif
++	.driver		= {
++		.name		= "corgi-led",
++	},
++};
++
++static int __devinit corgiled_init(void)
++{
++	return platform_driver_register(&corgiled_driver);
++}
++
++static void corgiled_exit(void)
++{
++ 	platform_driver_unregister(&corgiled_driver);
++}
++
++module_init(corgiled_init);
++module_exit(corgiled_exit);
++
++MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>");
++MODULE_DESCRIPTION("Corgi LED driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.15/drivers/leds/leds-spitz.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds-spitz.c	2006-01-29 16:08:09.000000000 +0000
+@@ -0,0 +1,125 @@
++/*
++ * LED Triggers Core
++ *
++ * Copyright 2005-2006 Openedhand Ltd.
++ *
++ * Author: Richard Purdie <rpurdie@openedhand.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/leds.h>
++#include <asm/hardware/scoop.h>
++#include <asm/mach-types.h>
++#include <asm/arch/hardware.h>
++#include <asm/arch/pxa-regs.h>
++#include <asm/arch/spitz.h>
++
++static void spitzled_amber_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE);
++	else
++		reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE);
++}
++
++static void spitzled_green_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN);
++	else
++		reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN);
++}
++
++static struct led_classdev spitz_amber_led = {
++	.name			= "spitz:amber",
++	.default_trigger	= "sharpsl-charge",
++	.brightness_set		= spitzled_amber_set,
++};
++
++static struct led_classdev spitz_green_led = {
++	.name			= "spitz:green",
++	.default_trigger	= "ide-disk",
++	.brightness_set		= spitzled_green_set,
++};
++
++#ifdef CONFIG_PM
++static int spitzled_suspend(struct platform_device *dev, pm_message_t state)
++{
++#ifdef CONFIG_LEDS_TRIGGERS
++	if (spitz_amber_led.trigger && strcmp(spitz_amber_led.trigger->name, "sharpsl-charge"))
++#endif
++		led_classdev_suspend(&spitz_amber_led);
++	led_classdev_suspend(&spitz_green_led);
++	return 0;
++}
++
++static int spitzled_resume(struct platform_device *dev)
++{
++	led_classdev_resume(&spitz_amber_led);
++	led_classdev_resume(&spitz_green_led);
++	return 0;
++}
++#endif
++
++static int spitzled_probe(struct platform_device *pdev)
++{
++	int ret;
++
++	if (machine_is_akita())
++		spitz_green_led.default_trigger = "nand-disk";
++
++	ret = led_classdev_register(&pdev->dev, &spitz_amber_led);
++	if (ret < 0)
++		return ret;
++
++	ret = led_classdev_register(&pdev->dev, &spitz_green_led);
++	if (ret < 0)
++		led_classdev_unregister(&spitz_amber_led);
++
++	return ret;
++}
++
++static int spitzled_remove(struct platform_device *pdev)
++{
++	led_classdev_unregister(&spitz_amber_led);
++	led_classdev_unregister(&spitz_green_led);
++
++	return 0;
++}
++
++static struct platform_driver spitzled_driver = {
++	.probe		= spitzled_probe,
++	.remove		= spitzled_remove,
++#ifdef CONFIG_PM
++	.suspend	= spitzled_suspend,
++	.resume		= spitzled_resume,
++#endif
++	.driver		= {
++		.name		= "spitz-led",
++	},
++};
++
++static int __devinit spitzled_init(void)
++{
++	return platform_driver_register(&spitzled_driver);
++}
++
++static void spitzled_exit(void)
++{
++ 	platform_driver_unregister(&spitzled_driver);
++}
++
++module_init(spitzled_init);
++module_exit(spitzled_exit);
++
++MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>");
++MODULE_DESCRIPTION("Spitz LED driver");
++MODULE_LICENSE("GPL");
+Adds an LED driver for LEDs exported by the Sharp LOCOMO chip as found on
+some models of Sharp Zaurus.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Kconfig	2006-01-29 16:04:22.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-29 16:04:23.000000000 +0000
+@@ -29,6 +29,13 @@
+ 	  This option enables support for the LEDs on Sharp Zaurus
+ 	  SL-C7x0 series (C700, C750, C760, C860).
+ 
++config LEDS_LOCOMO
++	tristate "LED Support for Locomo device"
++	depends LEDS_CLASS && SHARP_LOCOMO
++	help
++	  This option enables support for the LEDs on Sharp Locomo.
++	  Zaurus models SL-5500 and SL-5600.
++
+ config LEDS_SPITZ
+ 	tristate "LED Support for the Sharp SL-Cxx00 series"
+ 	depends LEDS_CLASS && PXA_SHARP_Cxx00
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Makefile	2006-01-29 16:04:22.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-29 16:04:23.000000000 +0000
+@@ -6,6 +6,7 @@
+ 
+ # LED Platform Drivers
+ obj-$(CONFIG_LEDS_CORGI)		+= leds-corgi.o
++obj-$(CONFIG_LEDS_LOCOMO)		+= leds-locomo.o
+ obj-$(CONFIG_LEDS_SPITZ)		+= leds-spitz.o
+ 
+ # LED Triggers
+Index: linux-2.6.15/drivers/leds/leds-locomo.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds-locomo.c	2006-01-29 16:09:46.000000000 +0000
+@@ -0,0 +1,91 @@
++/*
++ * linux/drivers/leds/locomo.c
++ *
++ * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ */
++
++#include <linux/config.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/device.h>
++#include <linux/leds.h>
++
++#include <asm/hardware.h>
++#include <asm/hardware/locomo.h>
++
++static void locomoled_brightness_set(struct led_classdev *led_cdev, enum led_brightness value, int offset)
++{
++	struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->class_dev->dev);
++	unsigned long flags;
++
++	local_irq_save(flags);
++	if (value)
++		locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);
++	else
++		locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);
++	local_irq_restore(flags);
++}
++
++static void locomoled_brightness_set0(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);
++}
++
++static void locomoled_brightness_set1(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);
++}
++
++static struct led_classdev locomo_led0 = {
++	.name			= "locomo:amber",
++	.brightness_set		= locomoled_brightness_set0,
++};
++
++static struct led_classdev locomo_led1 = {
++	.name			= "locomo:green",
++	.brightness_set		= locomoled_brightness_set1,
++};
++
++static int locomoled_probe(struct locomo_dev *ldev)
++{
++	int ret;
++
++	ret = led_classdev_register(&ldev->dev, &locomo_led0);
++	if (ret < 0)
++		return ret;
++
++	ret = led_classdev_register(&ldev->dev, &locomo_led1);
++	if (ret < 0)
++		led_classdev_unregister(&locomo_led0);
++
++	return ret;
++}
++
++static int locomoled_remove(struct locomo_dev *dev)
++{
++	led_classdev_unregister(&locomo_led0);
++	led_classdev_unregister(&locomo_led1);
++	return 0;
++}
++
++static struct locomo_driver locomoled_driver = {
++	.drv = {
++		.name = "locomoled"
++	},
++	.devid	= LOCOMO_DEVID_LED,
++	.probe	= locomoled_probe,
++	.remove	= locomoled_remove,
++};
++
++static int __init locomoled_init(void) {
++	return locomo_driver_register(&locomoled_driver);
++}
++module_init(locomoled_init);
++
++MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
++MODULE_DESCRIPTION("Locomo LED driver");
++MODULE_LICENSE("GPL");
+From: John Bowler <jbowler@acm.org>
+
+NEW_LEDS support for ixp4xx boards where LEDs are connected
+to the GPIO lines.
+
+This includes a new generic ixp4xx driver (leds-ixp4xx-gpio.c
+name "IXP4XX-GPIO-LED")
+
+Signed-off-by: John Bowler <jbowler@acm.org>
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+--- linux-2.6.15/drivers/leds/Kconfig	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	1970-01-01 00:00:00.000000000 +0000
+@@ -43,6 +43,15 @@ config LEDS_SPITZ
+ 	  This option enables support for the LEDs on Sharp Zaurus
+ 	  SL-Cxx00 series (C1000, C3000, C3100).
+ 
++config LEDS_IXP4XX
++	tristate "LED Support for GPIO connected LEDs on IXP4XX processors"
++	depends LEDS_CLASS && ARCH_IXP4XX
++	help
++	  This option enables support for the LEDs connected to GPIO
++	  outputs of the Intel IXP4XX processors.  To be useful the
++	  particular board must have LEDs and they must be connected
++	  to the GPIO lines.  If unsure, say Y.
++
+ config LEDS_TRIGGER_TIMER
+ 	tristate "LED Timer Trigger"
+ 	depends LEDS_TRIGGERS
+--- linux-2.6.15/drivers/leds/Makefile	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	1970-01-01 00:00:00.000000000 +0000
+@@ -8,6 +8,7 @@ obj-$(CONFIG_LEDS_TRIGGERS)		+= led-trig
+ obj-$(CONFIG_LEDS_CORGI)		+= leds-corgi.o
+ obj-$(CONFIG_LEDS_LOCOMO)		+= leds-locomo.o
+ obj-$(CONFIG_LEDS_SPITZ)		+= leds-spitz.o
++obj-$(CONFIG_LEDS_IXP4XX)		+= leds-ixp4xx-gpio.o
+ 
+ # LED Triggers
+ obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
+--- linux-2.6.15/drivers/leds/leds-ixp4xx-gpio.c	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds-ixp4xx-gpio.c	1970-01-01 00:00:00.000000000 +0000
+@@ -0,0 +1,209 @@
++/*
++ * IXP4XX GPIO driver LED driver
++ *
++ * Author: John Bowler <jbowler@acm.org>
++ *
++ * Copyright (c) 2006 John Bowler
++ *
++ * Permission is hereby granted, free of charge, to any
++ * person obtaining a copy of this software and associated
++ * documentation files (the "Software"), to deal in the
++ * Software without restriction, including without
++ * limitation the rights to use, copy, modify, merge,
++ * publish, distribute, sublicense, and/or sell copies of
++ * the Software, and to permit persons to whom the
++ * Software is furnished to do so, subject to the
++ * following conditions:
++ *
++ * The above copyright notice and this permission notice
++ * shall be included in all copies or substantial portions
++ * of the Software.
++ *
++ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF
++ * ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED
++ * TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A
++ * PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT
++ * SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR
++ * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
++ * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
++ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
++ * OTHER DEALINGS IN THE SOFTWARE.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/spinlock.h>
++#include <linux/leds.h>
++#include <asm/arch/hardware.h>
++
++extern spinlock_t gpio_lock;
++
++/* Up to 16 gpio lines are possible. */
++#define GPIO_MAX 16
++static struct ixp4xxgpioled_device {
++	struct led_classdev ancestor;
++	int               flags;
++} ixp4xxgpioled_devices[GPIO_MAX];
++
++void ixp4xxgpioled_brightness_set(struct led_classdev *pled, enum led_brightness value)
++{
++	const struct ixp4xxgpioled_device *const ixp4xx_dev =
++		container_of(pled, struct ixp4xxgpioled_device, ancestor);
++	const u32 gpio_pin = ixp4xx_dev - ixp4xxgpioled_devices;
++
++	if (gpio_pin < GPIO_MAX && ixp4xx_dev->ancestor.name != 0) {
++		/* Set or clear the 'gpio_pin' bit according to the style
++		 * and the required setting (value > 0 == on)
++		 */
++		const int gpio_value =
++			(value > 0) == (ixp4xx_dev->flags != IXP4XX_GPIO_LOW) ?
++				IXP4XX_GPIO_HIGH : IXP4XX_GPIO_LOW;
++
++		{
++			unsigned long flags;
++			spin_lock_irqsave(&gpio_lock, flags);
++			gpio_line_set(gpio_pin, gpio_value);
++			spin_unlock_irqrestore(&gpio_lock, flags);
++		}
++	}
++}
++
++/* LEDs are described in resources, the following iterates over the valid
++ * LED resources.
++ */
++#define for_all_leds(i, pdev) \
++	for (i=0; i<pdev->num_resources; ++i) \
++		if (pdev->resource[i].start < GPIO_MAX && \
++			pdev->resource[i].name != 0)
++
++/* The following applies 'operation' to each LED from the given platform,
++ * the function always returns 0 to allow tail call elimination.
++ */
++static int apply_to_all_leds(struct platform_device *pdev,
++	void (*operation)(struct led_classdev *pled)) {
++	int i;
++	for_all_leds(i, pdev)
++		operation(&ixp4xxgpioled_devices[pdev->resource[i].start].ancestor);
++	return 0;
++}
++
++#ifdef CONFIG_PM
++static int ixp4xxgpioled_suspend(struct platform_device *pdev, pm_message_t state)
++{
++	return apply_to_all_leds(pdev, led_classdev_suspend);
++}
++
++static int ixp4xxgpioled_resume(struct platform_device *pdev)
++{
++	return apply_to_all_leds(pdev, led_classdev_resume);
++}
++#endif
++
++static void ixp4xxgpioled_remove_one_led(struct led_classdev *pled) {
++	led_classdev_unregister(pled);
++	pled->name = 0;
++}
++
++static int ixp4xxgpioled_remove(struct platform_device *pdev)
++{
++	return apply_to_all_leds(pdev, ixp4xxgpioled_remove_one_led);
++}
++
++static int ixp4xxgpioled_probe(struct platform_device *pdev)
++{
++	/* The board level has to tell the driver where the
++	 * LEDs are connected - there is no way to find out
++	 * electrically.  It must also say whether the GPIO
++	 * lines are active high or active low.
++	 *
++	 * To do this read the num_resources (the number of
++	 * LEDs) and the struct resource (the data for each
++	 * LED).  The name comes from the resource, and it
++	 * isn't copied.
++	 */
++	int i;
++	for_all_leds(i, pdev) {
++		const u8 gpio_pin = pdev->resource[i].start;
++		int      rc;
++
++		if (ixp4xxgpioled_devices[gpio_pin].ancestor.name == 0) {
++			unsigned long flags;
++
++			spin_lock_irqsave(&gpio_lock, flags);
++			gpio_line_config(gpio_pin, IXP4XX_GPIO_OUT);
++			/* The config can, apparently, reset the state,
++			 * I suspect the gpio line may be an input and
++			 * the config may cause the line to be latched,
++			 * so the setting depends on how the LED is
++			 * connected to the line (which affects how it
++			 * floats if not driven).
++			 */
++			gpio_line_set(gpio_pin, IXP4XX_GPIO_HIGH);
++			spin_unlock_irqrestore(&gpio_lock, flags);
++
++			ixp4xxgpioled_devices[gpio_pin].flags =
++				pdev->resource[i].flags & IORESOURCE_BITS;
++
++			ixp4xxgpioled_devices[gpio_pin].ancestor.name =
++				pdev->resource[i].name;
++
++			/* This is how a board manufacturer makes the LED
++			 * come on on reset - the GPIO line will be high, so
++			 * make the LED light when the line is low...
++			 */
++			if (ixp4xxgpioled_devices[gpio_pin].flags != IXP4XX_GPIO_LOW)
++				ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 100;
++			else
++				ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 0;
++
++			ixp4xxgpioled_devices[gpio_pin].ancestor.flags = 0;
++				
++			ixp4xxgpioled_devices[gpio_pin].ancestor.brightness_set =
++				ixp4xxgpioled_brightness_set;
++
++			ixp4xxgpioled_devices[gpio_pin].ancestor.default_trigger = 0;
++		}
++
++		rc = led_classdev_register(&pdev->dev,
++				&ixp4xxgpioled_devices[gpio_pin].ancestor);
++		if (rc < 0) {
++			ixp4xxgpioled_devices[gpio_pin].ancestor.name = 0;
++			ixp4xxgpioled_remove(pdev);
++			return rc;
++		}
++	}
++
++	return 0;
++}
++
++static struct platform_driver ixp4xxgpioled_driver = {
++	.probe   = ixp4xxgpioled_probe,
++	.remove  = ixp4xxgpioled_remove,
++#ifdef CONFIG_PM
++	.suspend = ixp4xxgpioled_suspend,
++	.resume  = ixp4xxgpioled_resume,
++#endif
++	.driver  = {
++		.name = "IXP4XX-GPIO-LED",
++	},
++};
++
++static int __devinit ixp4xxgpioled_init(void)
++{
++	return platform_driver_register(&ixp4xxgpioled_driver);
++}
++
++static void ixp4xxgpioled_exit(void)
++{
++	platform_driver_unregister(&ixp4xxgpioled_driver);
++}
++
++module_init(ixp4xxgpioled_init);
++module_exit(ixp4xxgpioled_exit);
++
++MODULE_AUTHOR("John Bowler <jbowler@acm.org>");
++MODULE_DESCRIPTION("IXP4XX GPIO LED driver");
++MODULE_LICENSE("MIT");
+From: Dirk Opfer <dirk@opfer-online.de>
+
+Adds LED drivers for LEDs found on the Sharp Zaurus c6000 model (tosa).
+
+Signed-off-by: Dirk Opfer <dirk@opfer-online.de>
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/leds/Kconfig
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Kconfig	2006-01-30 00:25:28.000000000 +0000
++++ linux-2.6.15/drivers/leds/Kconfig	2006-01-30 00:25:52.000000000 +0000
+@@ -52,6 +52,13 @@
+ 	  particular board must have LEDs and they must be connected
+ 	  to the GPIO lines.  If unsure, say Y.
+ 
++config LEDS_TOSA
++	tristate "LED Support for the Sharp SL-6000 series"
++	depends LEDS_CLASS && PXA_SHARPSL
++	help
++	  This option enables support for the LEDs on Sharp Zaurus
++	  SL-6000 series.
++
+ config LEDS_TRIGGER_TIMER
+ 	tristate "LED Timer Trigger"
+ 	depends LEDS_TRIGGERS
+Index: linux-2.6.15/drivers/leds/Makefile
+===================================================================
+--- linux-2.6.15.orig/drivers/leds/Makefile	2006-01-30 00:25:28.000000000 +0000
++++ linux-2.6.15/drivers/leds/Makefile	2006-01-30 00:26:48.000000000 +0000
+@@ -9,6 +9,7 @@
+ obj-$(CONFIG_LEDS_LOCOMO)		+= leds-locomo.o
+ obj-$(CONFIG_LEDS_SPITZ)		+= leds-spitz.o
+ obj-$(CONFIG_LEDS_IXP4XX)		+= leds-ixp4xx-gpio.o
++obj-$(CONFIG_LEDS_TOSA)			+= leds-tosa.o
+ 
+ # LED Triggers
+ obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
+Index: linux-2.6.15/drivers/leds/leds-tosa.c
+===================================================================
+--- /dev/null	1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.15/drivers/leds/leds-tosa.c	2006-01-30 00:28:15.000000000 +0000
+@@ -0,0 +1,123 @@
++/*
++ * LED Triggers Core
++ *
++ * Copyright 2005 Dirk Opfer
++ *
++ * Author: Dirk Opfer <Dirk@Opfer-Online.de>
++ *	based on spitz.c
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ */
++
++#include <linux/config.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/leds.h>
++#include <asm/hardware/scoop.h>
++#include <asm/mach-types.h>
++#include <asm/arch/hardware.h>
++#include <asm/arch/pxa-regs.h>
++#include <asm/arch/tosa.h>
++
++static void tosaled_amber_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		set_scoop_gpio(&tosascoop_jc_device.dev, TOSA_SCOOP_JC_CHRG_ERR_LED);
++	else
++		reset_scoop_gpio(&tosascoop_jc_device.dev, TOSA_SCOOP_JC_CHRG_ERR_LED);
++}
++
++static void tosaled_green_set(struct led_classdev *led_cdev, enum led_brightness value)
++{
++	if (value)
++		set_scoop_gpio(&tosascoop_jc_device.dev, TOSA_SCOOP_JC_NOTE_LED);
++	else
++		reset_scoop_gpio(&tosascoop_jc_device.dev, TOSA_SCOOP_JC_NOTE_LED);
++}
++
++static struct led_classdev tosa_amber_led = {
++	.name			= "tosa:amber",
++	.default_trigger	= "sharpsl-charge",
++	.brightness_set		= tosaled_amber_set,
++};
++
++static struct led_classdev tosa_green_led = {
++	.name			= "tosa:green",
++	.default_trigger	= "nand-disk",
++	.brightness_set		= tosaled_green_set,
++};
++
++#ifdef CONFIG_PM
++static int tosaled_suspend(struct platform_device *dev, pm_message_t state)
++{
++#ifdef CONFIG_LEDS_TRIGGERS
++	if (tosa_amber_led.trigger && strcmp(tosa_amber_led.trigger->name, "sharpsl-charge"))
++#endif
++		led_classdev_suspend(&tosa_amber_led);
++	led_classdev_suspend(&tosa_green_led);
++	return 0;
++}
++
++static int tosaled_resume(struct platform_device *dev)
++{
++	led_classdev_resume(&tosa_amber_led);
++	led_classdev_resume(&tosa_green_led);
++	return 0;
++}
++#endif
++
++static int tosaled_probe(struct platform_device *pdev)
++{
++	int ret;
++
++	ret = led_classdev_register(&pdev->dev, &tosa_amber_led);
++	if (ret < 0)
++		return ret;
++
++	ret = led_classdev_register(&pdev->dev, &tosa_green_led);
++	if (ret < 0)
++		led_classdev_unregister(&tosa_amber_led);
++
++	return ret;
++}
++
++static int tosaled_remove(struct platform_device *pdev)
++{
++	led_classdev_unregister(&tosa_amber_led);
++	led_classdev_unregister(&tosa_green_led);
++
++	return 0;
++}
++
++static struct platform_driver tosaled_driver = {
++	.probe		= tosaled_probe,
++	.remove		= tosaled_remove,
++#ifdef CONFIG_PM
++	.suspend	= tosaled_suspend,
++	.resume		= tosaled_resume,
++#endif
++	.driver		= {
++		.name		= "tosa-led",
++	},
++};
++
++static int __devinit tosaled_init(void)
++{
++	return platform_driver_register(&tosaled_driver);
++}
++
++static void tosaled_exit(void)
++{
++ 	platform_driver_unregister(&tosaled_driver);
++}
++
++module_init(tosaled_init);
++module_exit(tosaled_exit);
++
++MODULE_AUTHOR("Dirk Opfer <Dirk@Opfer-Online.de>");
++MODULE_DESCRIPTION("Tosa LED driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.15/arch/arm/mach-pxa/tosa.c
+===================================================================
+--- linux-2.6.15.orig/arch/arm/mach-pxa/tosa.c	2006-01-03 03:21:10.000000000 +0000
++++ linux-2.6.15/arch/arm/mach-pxa/tosa.c	2006-01-30 00:29:25.000000000 +0000
+@@ -252,10 +252,19 @@
+ 	.id		= -1,
+ };
+ 
++/*
++ * Tosa LEDs
++ */
++static struct platform_device tosaled_device = {
++    .name   = "tosa-led",
++    .id     = -1,
++};
++		  
+ static struct platform_device *devices[] __initdata = {
+ 	&tosascoop_device,
+ 	&tosascoop_jc_device,
+ 	&tosakbd_device,
++	&tosaled_device,
+ };
+ 
+ static void __init tosa_init(void)
+Add an LED trigger for IDE disk activity to the IDE subsystem.
+
+Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
+
+Index: linux-2.6.15/drivers/ide/ide-disk.c
+===================================================================
+--- linux-2.6.15.orig/drivers/ide/ide-disk.c	2006-02-04 13:35:37.000000000 +0000
++++ linux-2.6.15/drivers/ide/ide-disk.c	2006-02-04 15:17:18.000000000 +0000
+@@ -60,6 +60,7 @@
+ #include <linux/genhd.h>
+ #include <linux/slab.h>
+ #include <linux/delay.h>
++#include <linux/leds.h>
+ 
+ #define _IDE_DISK
+ 
+@@ -80,6 +81,8 @@
+ 
+ static DECLARE_MUTEX(idedisk_ref_sem);
+ 
++INIT_LED_TRIGGER(ide_led_trigger);
++
+ #define to_ide_disk(obj) container_of(obj, struct ide_disk_obj, kref)
+ 
+ #define ide_disk_g(disk) \
+@@ -311,10 +314,12 @@
+ 
+ 	if (!blk_fs_request(rq)) {
+ 		blk_dump_rq_flags(rq, "ide_do_rw_disk - bad command");
+-		ide_end_request(drive, 0, 0);
++		ide_end_rw_disk(drive, 0, 0);
+ 		return ide_stopped;
+ 	}
+ 
++	led_trigger_event(ide_led_trigger, LED_FULL);
++
+ 	pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n",
+ 		 drive->name, rq_data_dir(rq) == READ ? "read" : "writ",
+ 		 block, rq->nr_sectors, (unsigned long)rq->buffer);
+@@ -325,6 +330,12 @@
+ 	return __ide_do_rw_disk(drive, rq, block);
+ }
+ 
++static int ide_end_rw_disk(ide_drive_t *drive, int uptodate, int nr_sectors)
++{
++	led_trigger_event(ide_led_trigger, LED_OFF);
++	ide_end_request(drive, uptodate, nr_sectors);
++}
++
+ /*
+  * Queries for true maximum capacity of the drive.
+  * Returns maximum LBA address (> 0) of the drive, 0 if failed.
+@@ -1097,7 +1108,7 @@
+ 	.media			= ide_disk,
+ 	.supports_dsc_overlap	= 0,
+ 	.do_request		= ide_do_rw_disk,
+-	.end_request		= ide_end_request,
++	.end_request		= ide_end_rw_disk,
+ 	.error			= __ide_error,
+ 	.abort			= __ide_abort,
+ 	.proc			= idedisk_proc,
+@@ -1259,11 +1270,13 @@
+ 
+ static void __exit idedisk_exit (void)
+ {
++	led_trigger_unregister_simple(ide_led_trigger);
+ 	driver_unregister(&idedisk_driver.gen_driver);
+ }
+ 
+ static int __init idedisk_init(void)
+ {
++	led_trigger_register_simple("ide-disk", &ide_led_trigger);
+ 	return driver_register(&idedisk_driver.gen_driver);
+ }
+ 
+Index: linux-2.6.15/drivers/mtd/nand/nand_base.c
+===================================================================
+--- linux-2.6.15.orig/drivers/mtd/nand/nand_base.c	2006-01-29 14:37:20.000000000 +0000
++++ linux-2.6.15/drivers/mtd/nand/nand_base.c	2006-01-29 15:25:11.000000000 +0000
+@@ -80,6 +80,7 @@
+ #include <linux/mtd/compatmac.h>
+ #include <linux/interrupt.h>
+ #include <linux/bitops.h>
++#include <linux/leds.h>
+ #include <asm/io.h>
+ 
+ #ifdef CONFIG_MTD_PARTITIONS
+@@ -515,6 +516,8 @@
+ 	return nand_isbad_bbt (mtd, ofs, allowbbt);
+ }
+ 
++INIT_LED_TRIGGER(nand_led_trigger);
++
+ /*
+  * Wait for the ready pin, after a command
+  * The timeout is catched later.
+@@ -524,12 +527,14 @@
+ 	struct nand_chip *this = mtd->priv;
+ 	unsigned long	timeo = jiffies + 2;
+ 
++	led_trigger_event(nand_led_trigger, LED_FULL);
+ 	/* wait until command is processed or timeout occures */
+ 	do {
+ 		if (this->dev_ready(mtd))
+-			return;
++			break;
+ 		touch_softlockup_watchdog();
+ 	} while (time_before(jiffies, timeo));
++	led_trigger_event(nand_led_trigger, LED_OFF);
+ }
+ 
+ /**
+@@ -817,6 +822,8 @@
+ 	else
+ 		 timeo += (HZ * 20) / 1000;
+ 
++	led_trigger_event(nand_led_trigger, LED_FULL);
++
+ 	/* Apply this short delay always to ensure that we do wait tWB in
+ 	 * any case on any machine. */
+ 	ndelay (100);
+@@ -840,6 +847,8 @@
+ 		}
+ 		cond_resched();
+ 	}
++	led_trigger_event(nand_led_trigger, LED_OFF);
++	
+ 	status = (int) this->read_byte(mtd);
+ 	return status;
+ }
+@@ -2724,6 +2733,21 @@
+ EXPORT_SYMBOL_GPL (nand_scan);
+ EXPORT_SYMBOL_GPL (nand_release);
+ 
++
++static int __init nand_base_init(void)
++{
++	led_trigger_register_simple("nand-disk", &nand_led_trigger);
++	return 0;
++}
++    
++static void nand_base_exit(void)
++{
++	led_trigger_unregister_simple(nand_led_trigger);
++}
++
++module_init(nand_base_init);
++module_exit(nand_base_exit);
++
+ MODULE_LICENSE ("GPL");
+ MODULE_AUTHOR ("Steven J. Hill <sjhill@realitydiluted.com>, Thomas Gleixner <tglx@linutronix.de>");
+ MODULE_DESCRIPTION ("Generic NAND flash driver code");
diff --git a/packages/linux/ixp4xx-kernel/2.6.16/patch-2.6.16-rc4-ide1 b/packages/linux/ixp4xx-kernel/2.6.16/patch-2.6.16-rc4-ide1
new file mode 100644
index 0000000000..7e2561c0f9
--- /dev/null
+++ b/packages/linux/ixp4xx-kernel/2.6.16/patch-2.6.16-rc4-ide1
@@ -0,0 +1,18260 @@
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/arch/i386/pci/fixup.c linux-2.6.16-rc4/arch/i386/pci/fixup.c
+--- linux.vanilla-2.6.16-rc4/arch/i386/pci/fixup.c	2006-02-20 11:22:15.000000000 +0000
++++ linux-2.6.16-rc4/arch/i386/pci/fixup.c	2006-02-01 14:49:17.000000000 +0000
+@@ -74,52 +74,6 @@
+ }
+ DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C810, pci_fixup_ncr53c810);
+ 
+-static void __devinit pci_fixup_ide_bases(struct pci_dev *d)
+-{
+-	int i;
+-
+-	/*
+-	 * PCI IDE controllers use non-standard I/O port decoding, respect it.
+-	 */
+-	if ((d->class >> 8) != PCI_CLASS_STORAGE_IDE)
+-		return;
+-	DBG("PCI: IDE base address fixup for %s\n", pci_name(d));
+-	for(i=0; i<4; i++) {
+-		struct resource *r = &d->resource[i];
+-		if ((r->start & ~0x80) == 0x374) {
+-			r->start |= 2;
+-			r->end = r->start;
+-		}
+-	}
+-}
+-DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, pci_fixup_ide_bases);
+-
+-static void __devinit  pci_fixup_ide_trash(struct pci_dev *d)
+-{
+-	int i;
+-
+-	/*
+-	 * Runs the fixup only for the first IDE controller
+-	 * (Shai Fultheim - shai@ftcon.com)
+-	 */
+-	static int called = 0;
+-	if (called)
+-		return;
+-	called = 1;
+-
+-	/*
+-	 * There exist PCI IDE controllers which have utter garbage
+-	 * in first four base registers. Ignore that.
+-	 */
+-	DBG("PCI: IDE base address trash cleared for %s\n", pci_name(d));
+-	for(i=0; i<4; i++)
+-		d->resource[i].start = d->resource[i].end = d->resource[i].flags = 0;
+-}
+-DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_5513, pci_fixup_ide_trash);
+-DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801CA_10, pci_fixup_ide_trash);
+-DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801CA_11, pci_fixup_ide_trash);
+-DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801DB_9, pci_fixup_ide_trash);
+-
+ static void __devinit  pci_fixup_latency(struct pci_dev *d)
+ {
+ 	/*
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/pci/probe.c linux-2.6.16-rc4/drivers/pci/probe.c
+--- linux.vanilla-2.6.16-rc4/drivers/pci/probe.c	2006-02-20 11:22:17.000000000 +0000
++++ linux-2.6.16-rc4/drivers/pci/probe.c	2006-02-01 15:56:28.000000000 +0000
+@@ -627,6 +627,7 @@
+ static int pci_setup_device(struct pci_dev * dev)
+ {
+ 	u32 class;
++	u16 cmd;
+ 
+ 	sprintf(pci_name(dev), "%04x:%02x:%02x.%d", pci_domain_nr(dev->bus),
+ 		dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn));
+@@ -654,6 +655,31 @@
+ 		pci_read_bases(dev, 6, PCI_ROM_ADDRESS);
+ 		pci_read_config_word(dev, PCI_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
+ 		pci_read_config_word(dev, PCI_SUBSYSTEM_ID, &dev->subsystem_device);
++
++		/*
++		 *	Do the ugly legacy mode stuff here rather than broken chip
++		 *	quirk code. Legacy mode ATA controllers have fixed
++		 *	addresses. These are not always echoed in BAR0-3, and
++		 *	BAR0-3 in a few cases contain junk!
++		 */
++		if (class == PCI_CLASS_STORAGE_IDE) {
++			u8 progif;
++			pci_read_config_byte(dev, PCI_CLASS_PROG, &progif);
++			if ((progif & 5) != 5) {
++				dev->resource[0].start = 0x1F0;
++				dev->resource[0].end = 0x1F7;
++				dev->resource[0].flags = IORESOURCE_IO;
++				dev->resource[1].start = 0x3F6;
++				dev->resource[1].end = 0x3F6;
++				dev->resource[1].flags = IORESOURCE_IO;
++				dev->resource[2].start = 0x170;
++				dev->resource[2].end = 0x177;
++				dev->resource[2].flags = IORESOURCE_IO;
++				dev->resource[3].start = 0x376;
++				dev->resource[3].end = 0x376;
++				dev->resource[3].flags = IORESOURCE_IO;
++			}
++		}
+ 		break;
+ 
+ 	case PCI_HEADER_TYPE_BRIDGE:		    /* bridge header */
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/ata_generic.c linux-2.6.16-rc4/drivers/scsi/ata_generic.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/ata_generic.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/ata_generic.c	2006-02-16 15:35:41.000000000 +0000
+@@ -0,0 +1,241 @@
++/*
++ *  ata_generic.c - Generic PATA/SATA controller driver.
++ *  Copyright 2005 Red Hat Inc <alan@redhat.com>, all rights reserved.
++ *
++ *  Elements from ide/pci/generic.c 
++ *	    Copyright (C) 2001-2002	Andre Hedrick <andre@linux-ide.org>
++ *	    Portions (C) Copyright 2002  Red Hat Inc <alan@redhat.com>
++ *
++ *  May be copied or modified under the terms of the GNU General Public License
++ *  
++ *  Driver for PCI IDE interfaces implementing the standard bus mastering
++ *  interface functionality. This assumes the BIOS did the drive set up and
++ *  tuning for us. By default we do not grab all IDE class devices as they
++ *  may have other drivers or need fixups to avoid problems. Instead we keep
++ *  a default list of stuff without documentation/driver that appears to
++ *  work.  
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include "scsi.h"
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "generic"
++#define DRV_VERSION "0.1"
++
++/*
++ *	A generic parallel ATA driver using libata
++ */
++ 
++static void genpata_phy_reset(struct ata_port *ap)
++{
++	/* We know the BIOS already did the mode work. Don't tempt any
++	   one else to "fix" things */
++	ap->cbl = ATA_CBL_PATA80;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	genpata_set_mode	-	mode setting
++ *	@ap: interface to set up
++ *
++ *	Use a non standard set_mode function. We don't want to be tuned.
++ *	The BIOS configured everything. Our job is not to fiddle. We
++ *	read the dma enabled bits from the PCI configuration of the device
++ *	and respect them. 
++ */
++ 
++static void genpata_set_mode(struct ata_port *ap)
++{
++	int dma_enabled;
++	int i;
++
++	/* Bits 5 and 6 indicate if DMA is active on master/slave */
++	dma_enabled = inb(ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
++	
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *dev = &ap->device[i];
++		if (ata_dev_present(dev)) {
++			/* We don't really care */
++			dev->pio_mode = XFER_PIO_0;
++			dev->dma_mode = XFER_MW_DMA_0;
++			/* We do need the right mode information for DMA or PIO 
++			   and this comes from the current configuration flags */
++			/* FIXME: at some point in the future this should become
++			   a library helper which reads the disk modes from the
++			   disk as well */
++			if (dma_enabled & (1 << (5 + i))) {
++				dev->xfer_mode = XFER_MW_DMA_0;
++				dev->xfer_shift = ATA_SHIFT_MWDMA;
++				dev->flags &= ~ATA_DFLAG_PIO;
++			} else {
++				dev->xfer_mode = XFER_PIO_0;
++				dev->xfer_shift = ATA_SHIFT_PIO;
++				dev->flags |= ATA_DFLAG_PIO;
++			}
++		}
++	}
++}
++
++static struct scsi_host_template genpata_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations genpata_port_ops = {
++	.set_mode	= genpata_set_mode,
++	
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= genpata_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++	
++	.data_xfer	= ata_pio_data_xfer,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++	
++static int ide_generic_all;		/* Set to claim all devices */
++
++static int __init ide_generic_all_on(char *unused)
++{
++	ide_generic_all = 1;
++	printk(KERN_INFO "ATA generic will claim all unknown PCI IDE class storage controllers.\n");
++	return 1;
++}
++
++__setup("all-generic-ide", ide_generic_all_on);
++
++/**
++ *	pata_generic_init		-	attach generic IDE
++ *	@dev: PCI device found
++ *	@id: match entry
++ *
++ *	Called each time a matching IDE interface is found. We check if the
++ *	interface is one we wish to claim and if so we perform any chip 
++ *	specific hacks then let the ATA layer do the heavy lifting.
++ */
++ 
++static int pata_generic_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	u16 command;
++	static struct ata_port_info info = {
++		.sht = &genpata_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_IRQ_MASK,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &genpata_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++		
++	/* Don't use the generic entry unless instructed to do so */
++	if (id->driver_data == 1 && ide_generic_all == 0)
++		return -ENODEV;
++
++	/* Devices that need care */
++	if (dev->vendor == PCI_VENDOR_ID_UMC &&
++	    dev->device == PCI_DEVICE_ID_UMC_UM8886A &&
++	    (!(PCI_FUNC(dev->devfn) & 1)))
++		return -ENODEV;
++
++	if (dev->vendor == PCI_VENDOR_ID_OPTI &&
++	    dev->device == PCI_DEVICE_ID_OPTI_82C558 &&
++	    (!(PCI_FUNC(dev->devfn) & 1)))
++		return -ENODEV;
++
++	/* Don't re-enable devices in generic mode or we will break some
++	   motherboards with disabled and unused IDE controllers */
++	pci_read_config_word(dev, PCI_COMMAND, &command);
++	if (!(command & PCI_COMMAND_IO))
++		return -ENODEV;
++		
++	if (dev->vendor == PCI_VENDOR_ID_AL)
++	    	ata_pci_clear_simplex(dev);
++
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id pata_generic[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_PCTECH, PCI_DEVICE_ID_PCTECH_SAMURAI_IDE), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_HOLTEK, PCI_DEVICE_ID_HOLTEK_6565), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_UMC,    PCI_DEVICE_ID_UMC_UM8673F), }, 
++	{ PCI_DEVICE(PCI_VENDOR_ID_UMC,    PCI_DEVICE_ID_UMC_UM8886A), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_UMC,    PCI_DEVICE_ID_UMC_UM8886BF), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_HINT,   PCI_DEVICE_ID_HINT_VXPROII_IDE), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_VIA,    PCI_DEVICE_ID_VIA_82C561), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_OPTI,   PCI_DEVICE_ID_OPTI_82C558), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_1), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA,PCI_DEVICE_ID_TOSHIBA_PICCOLO_2),  },
++	/* Must come last. If you add entries adjust this table appropriately */
++	{ PCI_ANY_ID,		PCI_ANY_ID,			   PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_STORAGE_IDE << 8, 0xFFFFFF00UL, 1},
++	{ 0, },
++};
++
++static struct pci_driver pata_generic_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= pata_generic,
++	.probe 		= pata_generic_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init pata_generic_init(void)
++{
++	return pci_module_init(&pata_generic_pci_driver);
++}
++
++
++static void __exit pata_generic_exit(void)
++{
++	pci_unregister_driver(&pata_generic_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for generic ATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, pata_generic);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(pata_generic_init);
++module_exit(pata_generic_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/ata_piix.c linux-2.6.16-rc4/drivers/scsi/ata_piix.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/ata_piix.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/ata_piix.c	2006-02-16 15:35:51.000000000 +0000
+@@ -91,9 +91,10 @@
+ #include <linux/device.h>
+ #include <scsi/scsi_host.h>
+ #include <linux/libata.h>
++#include <linux/ata.h>
+ 
+ #define DRV_NAME	"ata_piix"
+-#define DRV_VERSION	"1.05"
++#define DRV_VERSION	"1.05-ac1"
+ 
+ enum {
+ 	PIIX_IOCFG		= 0x54, /* IDE I/O configuration register */
+@@ -122,6 +123,17 @@
+ 	piix4_pata		= 2,
+ 	ich6_sata		= 3,
+ 	ich6_sata_ahci		= 4,
++	ich0_pata		= 5,
++	ich2_pata		= 6,
++	ich3_pata		= 7,
++	ich4_pata		= 8,
++	cich_pata		= 9,
++	piix3_pata		= 10,
++	esb_pata		= 11,
++	ich_pata		= 12,
++	ich6_pata		= 13,
++	ich7_pata		= 14,
++	esb2_pata		= 15,
+ 
+ 	PIIX_AHCI_DEVICE	= 6,
+ };
+@@ -130,20 +142,69 @@
+ 				    const struct pci_device_id *ent);
+ 
+ static void piix_pata_phy_reset(struct ata_port *ap);
++static void ich_pata_phy_reset(struct ata_port *ap);
+ static void piix_sata_phy_reset(struct ata_port *ap);
+ static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev);
+ static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev);
++static void ich_set_dmamode (struct ata_port *ap, struct ata_device *adev);
+ 
+ static unsigned int in_module_init = 1;
+ 
+ static const struct pci_device_id piix_pci_tbl[] = {
+ #ifdef ATA_ENABLE_PATA
++#if 0
++	/* Neptune and earlier are simple PIO */
++	/* 430HX and friends. MWDMA */
++	{ 0x8086, 0x122e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix3_pata },
++	{ 0x8086, 0x1230, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix3_pata },
++	/* Intel PIIX3 */
++	{ 0x8086, 0x7010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix3_pata },
++#endif	
++	/* Intel PIIX4 for the 430TX/440BX/MX chipset: UDMA 33 */
++	/* Also PIIX4E (fn3 rev 2) and PIIX4M (fn3 rev 3) */
+ 	{ 0x8086, 0x7111, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata },
+ 	{ 0x8086, 0x24db, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata },
+ 	{ 0x8086, 0x25a2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata },
++	/* Intel PIIX4 */
++	{ 0x8086, 0x7199, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata },
++	/* Intel PIIX4 */
++	{ 0x8086, 0x7601, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata },
++	/* Intel PIIX */
++	{ 0x8086, 0x84CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata },
++	/* Intel ICH (i810, i815, i840) UDMA 66*/
++	{ 0x8086, 0x2411, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata },
++	/* Intel ICH0 : UDMA 33*/
++	{ 0x8086, 0x2421, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich0_pata },
++	/* Intel ICH2M */
++	{ 0x8086, 0x244A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich2_pata },
++	/* Intel ICH2 (i810E2, i845, 850, 860) UDMA 100 */
++	{ 0x8086, 0x244B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich2_pata },
++	/*  Intel ICH3M */
++	{ 0x8086, 0x248A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich3_pata },
++	/* Intel ICH3 (E7500/1) UDMA 100 */
++	{ 0x8086, 0x248B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich3_pata },
++#if 0	
++	{ 0x8086, 0x24C1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, dunno_pata },
++#endif	
++	/* Intel ICH4 (i845GV, i845E, i852, i855) UDMA 100 */
++	{ 0x8086, 0x24CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich4_pata },
++	{ 0x8086, 0x24CB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich4_pata },
++	/* Intel ICH5 */
++	{ 0x8086, 0x24DB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata },
++	/* C-ICH (i810E2) */
++	{ 0x8086, 0x245B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, cich_pata },
++	/* ESB (855GME/875P + 6300ESB) UDMA 100  */	
++	{ 0x8086, 0x25A2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, esb_pata },
++	/* ICH6 (and 6) (i915) UDMA 100 */
++	{ 0x8086, 0x266F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_pata },
++	/* ICH7/7-R (i945, i975) UDMA 100*/
++	{ 0x8086, 0x27DF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich7_pata },
++	{ 0x8086, 0x269E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, esb2_pata },
+ #endif
+-
+-	/* NOTE: The following PCI ids must be kept in sync with the
++	/*
++	 * SATA ports
++	 *
++	 * NOTE: The following PCI ids must be kept in sync with the
+ 	 * list in drivers/pci/quirks.c.
+ 	 */
+ 
+@@ -213,6 +274,40 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations ich_pata_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= piix_set_piomode,
++	.set_dmamode		= ich_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= ich_pata_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++
++	.data_xfer		= ata_pio_data_xfer,
+ 
+ 	.eng_timeout		= ata_eng_timeout,
+ 
+@@ -242,6 +337,8 @@
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
+ 
++	.data_xfer		= ata_pio_data_xfer,
++
+ 	.eng_timeout		= ata_eng_timeout,
+ 
+ 	.irq_handler		= ata_interrupt,
+@@ -259,13 +356,9 @@
+ 		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST |
+ 				  PIIX_FLAG_CHECKINTR,
+ 		.pio_mask	= 0x1f,	/* pio0-4 */
+-#if 0
+ 		.mwdma_mask	= 0x06, /* mwdma1-2 */
+-#else
+-		.mwdma_mask	= 0x00, /* mwdma broken */
+-#endif
+ 		.udma_mask	= 0x3f, /* udma0-5 */
+-		.port_ops	= &piix_pata_ops,
++		.port_ops	= &ich_pata_ops,
+ 	},
+ 
+ 	/* ich5_sata */
+@@ -284,11 +377,7 @@
+ 		.sht		= &piix_sht,
+ 		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
+ 		.pio_mask	= 0x1f,	/* pio0-4 */
+-#if 0
+ 		.mwdma_mask	= 0x06, /* mwdma1-2 */
+-#else
+-		.mwdma_mask	= 0x00, /* mwdma broken */
+-#endif
+ 		.udma_mask	= ATA_UDMA_MASK_40C,
+ 		.port_ops	= &piix_pata_ops,
+ 	},
+@@ -316,6 +405,116 @@
+ 		.udma_mask	= 0x7f,	/* udma0-6 */
+ 		.port_ops	= &piix_sata_ops,
+ 	},
++
++	/* ich0_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* MWDMA0 is broken on chip */
++		.udma_mask	= 0x07, /* UDMA33 only */
++		.port_ops	= &ich_pata_ops,
++	},
++	
++	/* ich2_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* MWDMA0 is broken on chip */
++		.udma_mask	= 0x1f, /* UDMA100 */
++		.port_ops	= &ich_pata_ops,
++	},
++	
++	/* ich3_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* MWDMA0 is broken on chip */
++		.udma_mask	= 0x1f, /* UDMA100 */
++		.port_ops	= &ich_pata_ops,
++	},
++	
++	/* ich4_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x1f, /* UDMA100 */
++		.port_ops	= &ich_pata_ops,
++	},
++
++	/* cich_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x1f, /* UDMA100 */
++		.port_ops	= &ich_pata_ops,
++	},
++
++	/* piix3_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma1-2 */
++		.udma_mask	= ATA_UDMA_MASK_40C,
++		.port_ops	= &piix_pata_ops,
++	},
++
++	/* esb_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x1f, /* UDMA100 */
++		.port_ops	= &piix_pata_ops,
++	},
++
++	/* ich_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x07, /* UDMA66 */
++		.port_ops	= &ich_pata_ops,
++	},
++
++	/* ich6_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x3f, /* UDMA133 */
++		.port_ops	= &ich_pata_ops,
++	},
++
++	/* ich7_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x3f, /* UDMA133 */
++		.port_ops	= &ich_pata_ops,
++	},
++
++	/* esb2_pata */
++	{
++		.sht		= &piix_sht,
++		.host_flags	= ATA_FLAG_SRST | ATA_FLAG_SLAVE_POSS,
++		.pio_mask 	= 0x1f,	/* pio 0-4 */
++		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
++		.udma_mask	= 0x1f, /* UDMA100  -- CHECKME --*/
++		.port_ops	= &ich_pata_ops,
++	},
+ };
+ 
+ static struct pci_bits piix_enable_bits[] = {
+@@ -339,7 +538,7 @@
+  *	LOCKING:
+  *	None (inherited from caller).
+  */
+-static void piix_pata_cbl_detect(struct ata_port *ap)
++static void ich_pata_cbl_detect(struct ata_port *ap)
+ {
+ 	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
+ 	u8 tmp, mask;
+@@ -366,8 +565,9 @@
+  *	piix_pata_phy_reset - Probe specified port on PATA host controller
+  *	@ap: Port to probe
+  *
+- *	Probe PATA phy.
+- *
++ *	Probe PATA phy. Unlike the ICH we have no IOCFG register and
++ *	don't do UDMA66+ anyway.
++
+  *	LOCKING:
+  *	None (inherited from caller).
+  */
+@@ -381,11 +581,34 @@
+ 		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
+ 		return;
+ 	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
+ 
+-	piix_pata_cbl_detect(ap);
+ 
+-	ata_port_probe(ap);
++/**
++ *	ich_pata_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	Probe PATA phy.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void ich_pata_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
+ 
++	if (!pci_test_config_bits(pdev, &piix_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++
++	ich_pata_cbl_detect(ap);
++	ata_port_probe(ap);
+ 	ata_bus_reset(ap);
+ }
+ 
+@@ -481,6 +704,13 @@
+ 	unsigned int slave_port	= 0x44;
+ 	u16 master_data;
+ 	u8 slave_data;
++	u8 udma_enable;
++	int control = 0;
++	
++	/*
++	 *	See Intel Document 298600-004 for the timing programing rules
++	 *	for ICH controllers.
++	 */
+ 
+ 	static const	 /* ISP  RTC */
+ 	u8 timings[][2]	= { { 0, 0 },
+@@ -489,20 +719,30 @@
+ 			    { 2, 1 },
+ 			    { 2, 3 }, };
+ 
++	if (pio > 2)
++		control |= 1;	/* TIME1 enable */
++	if (ata_pio_need_iordy(adev))
++		control |= 2;	/* IE enable */
++
++	/* Intel specifies that the PPE functionality is for disk only */	   
++	if (adev->class == ATA_DEV_ATA)
++		control |= 4;	/* PPE enable */
++		
+ 	pci_read_config_word(dev, master_port, &master_data);
+ 	if (is_slave) {
++		/* Enable SITRE (seperate slave timing register) */
+ 		master_data |= 0x4000;
+-		/* enable PPE, IE and TIME */
+-		master_data |= 0x0070;
++		/* enable PPE1, IE1 and TIME1 as needed */
++		master_data |= (control << 4);
+ 		pci_read_config_byte(dev, slave_port, &slave_data);
+ 		slave_data &= (ap->hard_port_no ? 0x0f : 0xf0);
+-		slave_data |=
+-			(timings[pio][0] << 2) |
+-			(timings[pio][1] << (ap->hard_port_no ? 4 : 0));
++		/* Load the timing nibble for this slave */
++		slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->hard_port_no ? 4 : 0);
+ 	} else {
++		/* Master keeps the bits in a different format */
+ 		master_data &= 0xccf8;
+-		/* enable PPE, IE and TIME */
+-		master_data |= 0x0007;
++		/* Enable PPE, IE and TIME as appropriate */
++		master_data |= control;
+ 		master_data |=
+ 			(timings[pio][0] << 12) |
+ 			(timings[pio][1] << 8);
+@@ -510,84 +750,165 @@
+ 	pci_write_config_word(dev, master_port, master_data);
+ 	if (is_slave)
+ 		pci_write_config_byte(dev, slave_port, slave_data);
++
++	/* Ensure the UDMA bit is off - it will be turned back on if
++	   UDMA is selected */
++	   
++	if (ap->udma_mask) {
++		pci_read_config_byte(dev, 0x48, &udma_enable);
++		udma_enable &= ~(1 << (2 * ap->hard_port_no + adev->devno));
++		pci_write_config_byte(dev, 0x48, udma_enable);
++	}
+ }
+ 
+ /**
+- *	piix_set_dmamode - Initialize host controller PATA PIO timings
++ *	do_piix_set_dmamode - Initialize host controller PATA PIO timings
+  *	@ap: Port whose timings we are configuring
+- *	@adev: um
+- *	@udma: udma mode, 0 - 6
++ *	@adev: device to configure
++ *	@isich: True if the device is an ICH and has IOCFG registers
+  *
+- *	Set UDMA mode for device, in host controller PCI config space.
++ *	Set MW/UDMA mode for device, in host controller PCI config space.
++ *	Note: We know the caller has already set the PIO mode. In doing
++ *	so it has correctly set PPE, SITRE, IORDY and TIME1. We rely on that.
+  *
+  *	LOCKING:
+  *	None (inherited from caller).
+  */
+ 
+-static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++static void do_pata_set_dmamode (struct ata_port *ap, struct ata_device *adev, int isich)
+ {
+-	unsigned int udma	= adev->dma_mode; /* FIXME: MWDMA too */
+ 	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
+-	u8 maslave		= ap->hard_port_no ? 0x42 : 0x40;
+-	u8 speed		= udma;
+-	unsigned int drive_dn	= (ap->hard_port_no ? 2 : 0) + adev->devno;
+-	int a_speed		= 3 << (drive_dn * 4);
+-	int u_flag		= 1 << drive_dn;
+-	int v_flag		= 0x01 << drive_dn;
+-	int w_flag		= 0x10 << drive_dn;
+-	int u_speed		= 0;
+-	int			sitre;
+-	u16			reg4042, reg4a;
+-	u8			reg48, reg54, reg55;
+-
+-	pci_read_config_word(dev, maslave, &reg4042);
+-	DPRINTK("reg4042 = 0x%04x\n", reg4042);
+-	sitre = (reg4042 & 0x4000) ? 1 : 0;
+-	pci_read_config_byte(dev, 0x48, &reg48);
+-	pci_read_config_word(dev, 0x4a, &reg4a);
+-	pci_read_config_byte(dev, 0x54, &reg54);
+-	pci_read_config_byte(dev, 0x55, &reg55);
+-
+-	switch(speed) {
+-		case XFER_UDMA_4:
+-		case XFER_UDMA_2:	u_speed = 2 << (drive_dn * 4); break;
+-		case XFER_UDMA_6:
+-		case XFER_UDMA_5:
+-		case XFER_UDMA_3:
+-		case XFER_UDMA_1:	u_speed = 1 << (drive_dn * 4); break;
+-		case XFER_UDMA_0:	u_speed = 0 << (drive_dn * 4); break;
+-		case XFER_MW_DMA_2:
+-		case XFER_MW_DMA_1:	break;
+-		default:
+-			BUG();
+-			return;
+-	}
++	u8 master_port		= ap->hard_port_no ? 0x42 : 0x40;
++	u16 master_data;
++	u8 speed		= adev->dma_mode;
++	int devid		= adev->devno + 2 * ap->hard_port_no;
++	u8 udma_enable;
++	
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
+ 
++	pci_read_config_word(dev, master_port, &master_data);
++	pci_read_config_byte(dev, 0x48, &udma_enable);
++	
+ 	if (speed >= XFER_UDMA_0) {
+-		if (!(reg48 & u_flag))
+-			pci_write_config_byte(dev, 0x48, reg48 | u_flag);
+-		if (speed == XFER_UDMA_5) {
+-			pci_write_config_byte(dev, 0x55, (u8) reg55|w_flag);
+-		} else {
+-			pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag);
++		unsigned int udma	= adev->dma_mode - XFER_UDMA_0;
++		u16 udma_timing;
++		u16 ideconf;
++		int u_clock, u_speed;
++		
++		/*
++	 	 * UDMA is handled by a combination of clock switching and
++		 * selection of dividers 
++		 *  
++		 * Handy rule: Odd modes are UDMATIMx 01, even are 02
++		 *	       except UDMA0 which is 00 
++		 */
++		u_speed = min(2 - (udma & 1), udma);
++		if (udma == 5)
++			u_clock = 0x1000;	/* 100Mhz */
++		else if (udma > 2)
++			u_clock = 1;		/* 66Mhz */
++		else
++			u_clock = 0;		/* 33Mhz */
++			
++		udma_enable |= (1 << devid);
++			
++		/* Load the CT/RP selection */
++		pci_read_config_word(dev, 0x4A, &udma_timing);
++		udma_timing &= ~(3 << (4 * devid));
++		udma_timing |= u_speed << (4 * devid);
++		pci_write_config_word(dev, 0x4A, udma_timing);
++
++		if (isich) {		
++			/* Select a 33/66/100Mhz clock */
++			pci_read_config_word(dev, 0x54, &ideconf);
++			ideconf &= ~(0x1001 << devid);
++			ideconf |= u_clock << devid;
++			/* For ICH or later we should set bit 10 for better
++			   performance (WR_PingPong_En) */
++			pci_write_config_word(dev, 0x54, ideconf);
+ 		}
+-		if ((reg4a & a_speed) != u_speed)
+-			pci_write_config_word(dev, 0x4a, (reg4a & ~a_speed) | u_speed);
+-		if (speed > XFER_UDMA_2) {
+-			if (!(reg54 & v_flag))
+-				pci_write_config_byte(dev, 0x54, reg54 | v_flag);
+-		} else
+-			pci_write_config_byte(dev, 0x54, reg54 & ~v_flag);
+ 	} else {
+-		if (reg48 & u_flag)
+-			pci_write_config_byte(dev, 0x48, reg48 & ~u_flag);
+-		if (reg4a & a_speed)
+-			pci_write_config_word(dev, 0x4a, reg4a & ~a_speed);
+-		if (reg54 & v_flag)
+-			pci_write_config_byte(dev, 0x54, reg54 & ~v_flag);
+-		if (reg55 & w_flag)
+-			pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag);
++		/*
++		 * MWDMA is driven by the PIO timings. We must also enable
++		 * IORDY unconditionally along with TIME1. PPE has already
++		 * been set when the PIO timing was set.
++		 */
++		unsigned int mwdma	= adev->dma_mode - XFER_MW_DMA_0;
++		unsigned int control;
++		u8 slave_data;
++		const unsigned int needed_pio[3] = {
++			XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
++		};
++		int pio = needed_pio[mwdma] - XFER_PIO_0;
++		
++		control = 3;	/* IORDY|TIME1 */
++		
++		/* If the drive MWDMA is faster than it can do PIO then
++		   we must force PIO into PIO0 */
++		   
++		if (adev->pio_mode < needed_pio[mwdma])
++			/* Enable DMA timing only */
++			control |= 8;	/* PIO cycles in PIO0 */
++
++		if (adev->devno) {	/* Slave */
++			master_data &= 0xFF4F;  /* Mask out IORDY|TIME1|DMAONLY */
++			master_data |= control << 4;
++			pci_read_config_byte(dev, 0x44, &slave_data);
++			slave_data &= (0x0F + 0xE1 * ap->hard_port_no);
++			/* Load the matching timing */
++			slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->hard_port_no ? 4 : 0);
++			pci_write_config_byte(dev, 0x44, slave_data);
++		} else { 	/* Master */
++			master_data &= 0xCCF4;	/* Mask out IORDY|TIME1|DMAONLY 
++						   and master timing bits */
++			master_data |= control;
++			master_data |=
++				(timings[pio][0] << 12) |
++				(timings[pio][1] << 8);
++		}
++		udma_enable &= ~(1 << devid);
++		pci_write_config_word(dev, master_port, master_data);
+ 	}
++	/* Don't scribble on 0x48 if the controller does not support UDMA */
++	if (ap->udma_mask)
++		pci_write_config_byte(dev, 0x48, udma_enable);
++}
++
++/**
++ *	piix_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set MW/UDMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	do_pata_set_dmamode(ap, adev, 0);
++}
++
++/**
++ *	ich_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set MW/UDMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void ich_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	do_pata_set_dmamode(ap, adev, 1);
+ }
+ 
+ #define AHCI_PCI_BAR 5
+@@ -646,15 +967,15 @@
+ 		pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
+ 		pci_read_config_word(pdev, 0x41, &cfg);
+ 		/* Only on the original revision: IDE DMA can hang */
+-		if(rev == 0x00)
++		if (rev == 0x00)
+ 			no_piix_dma = 1;
+ 		/* On all revisions below 5 PXB bus lock must be disabled for IDE */
+-		else if(cfg & (1<<14) && rev < 5)
++		else if (cfg & (1<<14) && rev < 5)
+ 			no_piix_dma = 2;
+ 	}
+-	if(no_piix_dma)
++	if (no_piix_dma)
+ 		dev_printk(KERN_WARNING, &ata_dev->dev, "450NX errata present, disabling IDE DMA.\n");
+-	if(no_piix_dma == 2)
++	if (no_piix_dma == 2)
+ 		dev_printk(KERN_WARNING, &ata_dev->dev, "A BIOS update may resolve this.\n");
+ 	return no_piix_dma;
+ }		
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/Kconfig linux-2.6.16-rc4/drivers/scsi/Kconfig
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/Kconfig	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/Kconfig	2006-02-17 18:22:18.000000000 +0000
+@@ -599,6 +599,316 @@
+ 	depends on IDE=y && !BLK_DEV_IDE_SATA && (SCSI_SATA_AHCI || SCSI_ATA_PIIX)
+ 	default y
+ 
++config SCSI_PATA_ALI
++	tristate "ALi PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the ALi ATA interfaces
++	  found on the many ALi chipsets.
++
++	  If unsure, say N.
++
++config SCSI_PATA_AMD
++	tristate "AMD/NVidia PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the AMD and NVidia PATA
++	  interfaces found on the chipsets for Athlon/Athlon64.
++
++	  If unsure, say N.
++
++config SCSI_PATA_ARTOP
++	tristate "ARTOP 6210/6260 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for ARTOP PATA controllers.
++
++	  If unsure, say N.
++
++config SCSI_PATA_ATIIXP
++	tristate "ATI PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the ATI ATA interfaces
++	  found on the many ATI chipsets.
++
++	  If unsure, say N.
++
++config SCSI_PATA_CMD64X
++	tristate "CMD64x PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the CMD64x series chips
++	  except for the CMD640.
++
++	  If unsure, say N.
++
++config SCSI_PATA_CS5520
++	tristate "CS5510/5520 PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the Cyrix 5510/5520
++	  companion chip used with the MediaGX/Geode processor family.
++
++	  If unsure, say N.
++
++config SCSI_PATA_CS5530
++	tristate "CS5530 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the Cyrix/NatSemi/AMD CS5530
++	  companion chip used with the MediaGX/Geode processor family.
++
++	  If unsure, say N.
++
++config SCSI_PATA_CS5535
++	tristate "CS5535 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && X86 && !X86_64 && EXPERIMENTAL
++	help
++	  This option enables support for the NatSemi/AMD CS5535
++	  companion chip used with the Geode processor family.
++
++	  If unsure, say N.
++
++config SCSI_PATA_CYPRESS
++	tristate "Cypress CY82C693 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the Cypress/Contaq CY82C693
++	  chipset found in some Alpha systems
++
++	  If unsure, say N.
++
++config SCSI_PATA_EFAR
++	tristate "EFAR SLC90E66 support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the EFAR SLC90E66
++	  IDE controller found on some older machines.
++
++	  If unsure, say N.
++
++config SCSI_ATA_GENERIC
++	tristate "Generic PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for generic BIOS configured
++	  PATA controllers via the new ATA layer
++
++	  If unsure, say N.
++
++config SCSI_PATA_HPT37X
++	tristate "HPT 370/370A/371/372/374/302 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the majority of the later HPT
++	  PATA controllers via the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_HPT3X2N
++	tristate "HPT 372N/302N PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the N variant HPT PATA
++	  controllers via the new ATA layer
++
++	  If unsure, say N.
++
++config SCSI_PATA_HPT3X3
++	tristate "HPT 343/363 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the HPT 343/363
++	  PATA controllers via the new ATA layer
++
++	  If unsure, say N.
++
++config SCSI_PATA_ISAPNP
++	tristate "ISA Plug and Play PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && EXPERIMENTAL
++	help
++	  This option enables support for ISA plug & play ATA
++	  controllers such as those found on old soundcards.
++
++	  If unsure, say N.
++
++config SCSI_PATA_IT8172
++	tristate "IT8172 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the ITE 8172 PATA controller
++	  via the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_IT821X
++	tristate "IT821x PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the ITE 8211 and 8212
++	  PATA controllers via the new ATA layer, including RAID
++	  mode.
++
++	  If unsure, say N.
++
++config SCSI_PATA_LEGACY
++	tristate "Legacy ISA PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for ISA bus legacy PATA
++	  interfaces on ide2-5 and allows them to be accessed via
++	  the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_MPIIX
++	tristate "Intel PATA MPIIX support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for MPIIX PATA support.
++
++	  If unsure, say N.
++
++config SCSI_PATA_NETCELL
++	tristate "NETCELL Revolution RAID support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the Netcell Revolution RAID
++	  PATA controller.
++
++	  If unsure, say N.
++
++config SCSI_PATA_NS87410
++	tristate "Nat Semi NS87410 PATA support (Experimental)"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the National Semiconductor
++	  NS87410 PCI-IDE controller.
++
++	  If unsure, say N.
++
++config SCSI_PATA_OLDPIIX
++	tristate "Intel PATA old PIIX support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for early PIIX PATA interfaces.
++
++	  If unsure, say N.
++
++config SCSI_PATA_OPTI
++	tristate "OPTI621/6215 PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables full PIO support for the early Opti ATA
++	  controllers found on some old motherboards.
++
++	  If unsure, say N.
++
++config SCSI_PATA_PCMCIA
++	tristate "PCMCIA PATA support (Raving Lunatic)"
++	depends on SCSI_SATA
++	help
++	  This option enables support for PCMCIA ATA interfaces, including
++	  compact flash card adapters via the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_PDC_OLD
++	tristate "Older Promise PATA controller support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the Promise 20246, 20262, 20263,
++	  20265 and 20267 adapters.
++
++	  If unsure, say N.
++
++config SCSI_PATA_QDI
++	tristate "QDI VLB PATA support"
++	depends on SCSI_SATA
++	help
++	  Support for QDI 6500 and 6580 PATA controllers on VESA local bus.
++
++config SCSI_PATA_RADISYS
++	tristate "RADISYS 82600 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the RADISYS 82600
++	  PATA controllers via the new ATA layer
++
++	  If unsure, say N.
++
++config SCSI_PATA_RZ1000
++	tristate "PC Tech RZ1000 PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables basic support for the PC Tech RZ1000/1
++	  PATA controllers via the new ATA layer
++
++	  If unsure, say N.
++
++config SCSI_PATA_SC1200
++	tristate "SC1200 PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the NatSemi/AMD SC1200 SoC
++	  companion chip used with the Geode processor family.
++
++	  If unsure, say N.
++
++config SCSI_PATA_SERVERWORKS
++	tristate "SERVERWORKS OSB4/CSB5/CSB6 PATA support (Experimental)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for the Serverworks OSB4/CSB5 and
++	  CSB6 IDE controllers, via the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_SIL680
++	tristate "CMD / Silicon Image 680 PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for CMD / Silicon Image 680 PATA.
++
++	  If unsure, say N.
++
++config SCSI_PATA_SIS
++	tristate "SiS PATA support (Experimental)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  This option enables support for SiS PATA controllers
++
++	  If unsure, say N.
++
++config SCSI_PATA_TRIFLEX
++	tristate "Compaq Triflex PATA support (Raving Lunatic)"
++	depends on SCSI_SATA && PCI && EXPERIMENTAL
++	help
++	  Enable support for the Compaq 'Triflex' IDE controller as found
++	  on many Compaq Pentium-Pro systems, via the new ATA layer.
++
++	  If unsure, say N.
++
++config SCSI_PATA_VIA
++	tristate "VIA PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for the VIA PATA interfaces
++	  found on the many VIA chipsets.
++
++	  If unsure, say N.
++
++config SCSI_PATA_WINBOND
++	tristate "Winbond SL82C105 PATA support"
++	depends on SCSI_SATA && PCI
++	help
++	  This option enables support for SL82C105 PATA devices found in the
++	  Netwinder and some other systems
++
++	  If unsure, say N.
++
++
+ config SCSI_BUSLOGIC
+ 	tristate "BusLogic SCSI support"
+ 	depends on (PCI || ISA || MCA) && SCSI && ISA_DMA_API
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/libata-core.c linux-2.6.16-rc4/drivers/scsi/libata-core.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/libata-core.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/libata-core.c	2006-02-20 11:28:03.000000000 +0000
+@@ -68,9 +68,10 @@
+ static void ata_dev_init_params(struct ata_port *ap, struct ata_device *dev);
+ static void ata_set_mode(struct ata_port *ap);
+ static void ata_dev_set_xfermode(struct ata_port *ap, struct ata_device *dev);
+-static unsigned int ata_get_mode_mask(const struct ata_port *ap, int shift);
++static unsigned int ata_get_mode_mask(const struct ata_port *ap, struct ata_device *adev, int shift);
+ static int fgb(u32 bitmap);
+ static int ata_choose_xfer_mode(const struct ata_port *ap,
++				struct ata_device *adev,
+ 				u8 *xfer_mode_out,
+ 				unsigned int *xfer_shift_out);
+ static void __ata_qc_complete(struct ata_queued_cmd *qc);
+@@ -1205,6 +1206,48 @@
+ 	return 0;
+ }
+ 
++static void ata_dev_check_hpa(struct ata_port *ap, struct ata_device *dev)
++{
++	struct ata_taskfile tf;
++	unsigned long long true_size;
++	unsigned int err_mask;
++
++	if (!ata_id_has_hpa(dev->id) || !ata_id_hpa_enabled(dev->id))
++		return;
++
++	/* Issue a query for HPA */
++	ata_dev_select(ap, dev->devno, 1, 1);
++	ata_tf_init(ap, &tf, dev->devno);
++
++	if (dev->flags & ATA_DFLAG_LBA48) {
++		tf.command = ATA_CMD_READ_NATIVE_MAX_EXT;
++		tf.device |= 0x40;
++		err_mask = ata_exec_internal(ap, dev, &tf, DMA_NONE, NULL, 0);
++		if (err_mask)
++			return;
++		/* Ok HPA is live */
++		true_size = (tf.hob_lbah << 16) | (tf.hob_lbam << 8) | (tf.hob_lbal);
++		true_size <<= 24;
++		true_size |= (tf.lbah << 16) | (tf.lbam << 8) | tf.lbal;
++	} else {
++		tf.command = ATA_CMD_READ_NATIVE_MAX;
++		tf.device |= 0x40;
++		err_mask = ata_exec_internal(ap, dev, &tf, DMA_NONE, NULL, 0);
++		if (err_mask)
++			return;
++		/* Ok HPA is live */
++		true_size = ((tf.device & 0x0F) << 24) |
++			    (tf.lbah << 16) |
++			    (tf.lbam << 8) |
++			    tf.lbal;
++	}
++	dev->flags |= ATA_DFLAG_HPA;
++	/* Should save the HPA value and expose it for dmraid then
++	   remove the clipping */
++	printk(KERN_INFO "HPA present: true size %lld sectors.\n",
++		true_size + 1);
++}
++
+ /**
+  *	ata_dev_identify - obtain IDENTIFY x DEVICE page
+  *	@ap: port on which device we wish to probe resides
+@@ -1328,7 +1371,7 @@
+ 
+ 	/* ATA-specific feature tests */
+ 	if (dev->class == ATA_DEV_ATA) {
+-		if (!ata_id_is_ata(dev->id))	/* sanity check */
++		if (!ata_id_is_ata(dev->id) && !ata_id_is_cfa(dev->id))	/* sanity check */
+ 			goto err_out_nosup;
+ 
+ 		/* get major version */
+@@ -1400,6 +1443,13 @@
+ 		}
+ 
+ 		ap->host->max_cmd_len = 16;
++		
++		/*
++		 *	See if we have the HPA misfeature on the drive
++		 */
++#if 0		/* TESTING */
++		ata_dev_check_hpa(ap, dev);
++#endif
+ 	}
+ 
+ 	/* ATAPI-specific feature tests */
+@@ -1485,10 +1535,23 @@
+ 	ap->ops->phy_reset(ap);
+ 	if (ap->flags & ATA_FLAG_PORT_DISABLED)
+ 		goto err_out;
++		
++	/* The reset means we are in PIO 0, but the controller may not
++	   yet be correctly set up and may have old BIOS settings, or just
++	   no settings at all. Set all the devices to PIO 0 */
++
++	for (i = 0; i < ATA_MAX_DEVICES; i++)
++		ap->device[i].pio_mode = XFER_PIO_0;
+ 
+ 	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *adev = & ap->device[i];
++
++		/* Set up the controller on this port for PIO 0. We must not
++		   send the drive speed setting commands at this point */
++		ap->ops->set_piomode(ap, adev);
++
+ 		ata_dev_identify(ap, i);
+-		if (ata_dev_present(&ap->device[i])) {
++		if (ata_dev_present(adev)) {
+ 			found = 1;
+ 			ata_dev_config(ap,i);
+ 		}
+@@ -1497,7 +1560,11 @@
+ 	if ((!found) || (ap->flags & ATA_FLAG_PORT_DISABLED))
+ 		goto err_out_disable;
+ 
+-	ata_set_mode(ap);
++	if(ap->ops->set_mode)
++		ap->ops->set_mode(ap);
++	else
++		ata_set_mode(ap);
++
+ 	if (ap->flags & ATA_FLAG_PORT_DISABLED)
+ 		goto err_out_disable;
+ 
+@@ -1612,6 +1679,23 @@
+ }
+ 
+ /**
++ *	ata_dev_pair		-	return other device on cable
++ *	@ap: port
++ *	@adev: device
++ *
++ *	Obtain the other device on the same cable, or if none is
++ *	present NULL is returned
++ */
++ 
++struct ata_device *ata_dev_pair(struct ata_port *ap, struct ata_device *adev)
++{
++	struct ata_device *pair = &ap->device[1 - adev->devno];
++	if (!ata_dev_present(pair))
++		return NULL;
++	return pair;
++}
++
++/**
+  *	ata_port_disable - Disable port.
+  *	@ap: Port to be disabled.
+  *
+@@ -1824,16 +1908,19 @@
+ 		ap->id, dev->devno, xfer_mode_str[idx]);
+ }
+ 
+-static int ata_host_set_pio(struct ata_port *ap)
++static int ata_host_set_pio(struct ata_port *ap, struct ata_device *adev)
+ {
+ 	unsigned int mask;
+-	int x, i;
++	int x;
+ 	u8 base, xfer_mode;
+ 
+-	mask = ata_get_mode_mask(ap, ATA_SHIFT_PIO);
++	if (!ata_dev_present(adev))
++		return 0;
++
++	mask = ata_get_mode_mask(ap, adev, ATA_SHIFT_PIO);
+ 	x = fgb(mask);
+ 	if (x < 0) {
+-		printk(KERN_WARNING "ata%u: no PIO support\n", ap->id);
++		printk(KERN_WARNING "ata%u: no PIO support for device %d.\n", ap->id, adev->devno);
+ 		return -1;
+ 	}
+ 
+@@ -1843,34 +1930,24 @@
+ 	DPRINTK("base 0x%x xfer_mode 0x%x mask 0x%x x %d\n",
+ 		(int)base, (int)xfer_mode, mask, x);
+ 
+-	for (i = 0; i < ATA_MAX_DEVICES; i++) {
+-		struct ata_device *dev = &ap->device[i];
+-		if (ata_dev_present(dev)) {
+-			dev->pio_mode = xfer_mode;
+-			dev->xfer_mode = xfer_mode;
+-			dev->xfer_shift = ATA_SHIFT_PIO;
+-			if (ap->ops->set_piomode)
+-				ap->ops->set_piomode(ap, dev);
+-		}
+-	}
++	adev->pio_mode = xfer_mode;
++	adev->xfer_mode = xfer_mode;
++	adev->xfer_shift = ATA_SHIFT_PIO;
++	if (ap->ops->set_piomode)
++		ap->ops->set_piomode(ap, adev);
+ 
+ 	return 0;
+ }
+ 
+-static void ata_host_set_dma(struct ata_port *ap, u8 xfer_mode,
+-			    unsigned int xfer_shift)
++static void ata_host_set_dma(struct ata_port *ap, struct ata_device *adev, 
++			     u8 xfer_mode, unsigned int xfer_shift)
+ {
+-	int i;
+-
+-	for (i = 0; i < ATA_MAX_DEVICES; i++) {
+-		struct ata_device *dev = &ap->device[i];
+-		if (ata_dev_present(dev)) {
+-			dev->dma_mode = xfer_mode;
+-			dev->xfer_mode = xfer_mode;
+-			dev->xfer_shift = xfer_shift;
+-			if (ap->ops->set_dmamode)
+-				ap->ops->set_dmamode(ap, dev);
+-		}
++	if (ata_dev_present(adev)) {
++		adev->dma_mode = xfer_mode;
++		adev->xfer_mode = xfer_mode;
++		adev->xfer_shift = xfer_shift;
++		if (ap->ops->set_dmamode)
++			ap->ops->set_dmamode(ap, adev);
+ 	}
+ }
+ 
+@@ -1886,32 +1963,64 @@
+  */
+ static void ata_set_mode(struct ata_port *ap)
+ {
+-	unsigned int xfer_shift;
+-	u8 xfer_mode;
++	unsigned int xfer_shift[ATA_MAX_DEVICES];
++	u8 xfer_mode[ATA_MAX_DEVICES];
+ 	int rc;
++	int i;
++	int used_dma = 0;	/* Track if DMA was used for this setup */
+ 
+-	/* step 1: always set host PIO timings */
+-	rc = ata_host_set_pio(ap);
+-	if (rc)
+-		goto err_out;
++	/* We need to set timings individually for each device */
+ 
+-	/* step 2: choose the best data xfer mode */
+-	xfer_mode = xfer_shift = 0;
+-	rc = ata_choose_xfer_mode(ap, &xfer_mode, &xfer_shift);
+-	if (rc)
+-		goto err_out;
++	/* Compute the timings first so that when we ask the device to do
++	   speed configuration it can see all the intended device state in 
++	   full */
+ 
+-	/* step 3: if that xfer mode isn't PIO, set host DMA timings */
+-	if (xfer_shift != ATA_SHIFT_PIO)
+-		ata_host_set_dma(ap, xfer_mode, xfer_shift);
+-
+-	/* step 4: update devices' xfer mode */
+-	ata_dev_set_mode(ap, &ap->device[0]);
+-	ata_dev_set_mode(ap, &ap->device[1]);
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *adev = &ap->device[i];
++		/* Choose the best data xfer mode */
++		xfer_mode[i] = xfer_shift[i] = 0;
++		rc = ata_choose_xfer_mode(ap, adev, &xfer_mode[i], &xfer_shift[i]);
++		if (rc)
++			goto err_out;
++
++	}
++	
++	/* Now set the mode tables we have computed */
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *adev = &ap->device[i];
++		/* step 1: always set host PIO timings */
++		rc = ata_host_set_pio(ap, adev);
++		if (rc)
++			goto err_out;
++
++		/* step 2: if that xfer mode isn't PIO, set host DMA timings */
++		if (xfer_shift[i] != ATA_SHIFT_PIO) {
++			ata_host_set_dma(ap, adev, xfer_mode[i], xfer_shift[i]);
++			used_dma = 1;
++		}
++
++                /* In some cases the DMA mode will cause the driver to 
++                   update the pio mode to match chip limits. */
++                   
++		/* step 3: update devices' xfer mode */
++		ata_dev_set_mode(ap, adev);
++	}
+ 
+ 	if (ap->flags & ATA_FLAG_PORT_DISABLED)
+ 		return;
+ 
++	/*
++	 *	Record simplex status. If we selected DMA then the other
++	 *	host channels are not permitted to do so.
++	 */
++
++	if (used_dma && (ap->host_set->host_set_flags & ATA_HOST_SIMPLEX))
++		ap->host_set->simplex_claimed = 1;
++
++	/*
++	 *	Chip specific finalisation
++	 */
++
+ 	if (ap->ops->post_set_mode)
+ 		ap->ops->post_set_mode(ap);
+ 
+@@ -2256,76 +2365,57 @@
+ 	return 0;
+ }
+ 
+-static unsigned int ata_get_mode_mask(const struct ata_port *ap, int shift)
++static unsigned int ata_get_mode_mask(const struct ata_port *ap, struct ata_device *adev, int shift)
+ {
+-	const struct ata_device *master, *slave;
+ 	unsigned int mask;
++	struct ata_host_set *hs = ap->host_set;
+ 
+-	master = &ap->device[0];
+-	slave = &ap->device[1];
++	if (!ata_dev_present(adev))
++		return 0xFF;	/* Drive isn't limiting anything */
++		
++	if (shift == ATA_SHIFT_PIO) {
++		u16 tmp_mode = ata_pio_modes(adev);
++		mask = ap->pio_mask;
++		mask &= tmp_mode;
++	}
+ 
+-	assert (ata_dev_present(master) || ata_dev_present(slave));
++	/*
++	 *	Enforce simplex rules if host is simplex
++	 */
++
++        if (hs->host_set_flags & ATA_HOST_SIMPLEX) {
++		if (hs->simplex_claimed) {
++			if (shift != ATA_SHIFT_PIO)
++				return 0;
++		}
++	}
+ 
+ 	if (shift == ATA_SHIFT_UDMA) {
+ 		mask = ap->udma_mask;
+-		if (ata_dev_present(master)) {
+-			mask &= (master->id[ATA_ID_UDMA_MODES] & 0xff);
+-			if (ata_dma_blacklisted(master)) {
+-				mask = 0;
+-				ata_pr_blacklisted(ap, master);
+-			}
+-		}
+-		if (ata_dev_present(slave)) {
+-			mask &= (slave->id[ATA_ID_UDMA_MODES] & 0xff);
+-			if (ata_dma_blacklisted(slave)) {
+-				mask = 0;
+-				ata_pr_blacklisted(ap, slave);
+-			}
++		mask &= (adev->id[ATA_ID_UDMA_MODES] & 0xff);
++		if (ata_dma_blacklisted(adev)) {
++			mask = 0;
++			ata_pr_blacklisted(ap, adev);
+ 		}
+ 	}
+ 	else if (shift == ATA_SHIFT_MWDMA) {
+ 		mask = ap->mwdma_mask;
+-		if (ata_dev_present(master)) {
+-			mask &= (master->id[ATA_ID_MWDMA_MODES] & 0x07);
+-			if (ata_dma_blacklisted(master)) {
+-				mask = 0;
+-				ata_pr_blacklisted(ap, master);
+-			}
+-		}
+-		if (ata_dev_present(slave)) {
+-			mask &= (slave->id[ATA_ID_MWDMA_MODES] & 0x07);
+-			if (ata_dma_blacklisted(slave)) {
+-				mask = 0;
+-				ata_pr_blacklisted(ap, slave);
+-			}
++		mask &= (adev->id[ATA_ID_MWDMA_MODES] & 0x07);
++		if (ata_dma_blacklisted(adev)) {
++			mask = 0;
++			ata_pr_blacklisted(ap, adev);
+ 		}
+-	}
+-	else if (shift == ATA_SHIFT_PIO) {
+-		mask = ap->pio_mask;
+-		if (ata_dev_present(master)) {
+-			/* spec doesn't return explicit support for
+-			 * PIO0-2, so we fake it
+-			 */
+-			u16 tmp_mode = master->id[ATA_ID_PIO_MODES] & 0x03;
+-			tmp_mode <<= 3;
+-			tmp_mode |= 0x7;
+-			mask &= tmp_mode;
+-		}
+-		if (ata_dev_present(slave)) {
+-			/* spec doesn't return explicit support for
+-			 * PIO0-2, so we fake it
+-			 */
+-			u16 tmp_mode = slave->id[ATA_ID_PIO_MODES] & 0x03;
+-			tmp_mode <<= 3;
+-			tmp_mode |= 0x7;
+-			mask &= tmp_mode;
+-		}
+-	}
+-	else {
++	} else if (shift != ATA_SHIFT_PIO) {
+ 		mask = 0xffffffff; /* shut up compiler warning */
+ 		BUG();
+ 	}
+ 
++	/*
++	 *	Allow the controller to see the proposed mode and
++	 *	device data to do any custom filtering rules.
++	 */
++	if(ap->ops->mode_filter)
++		mask = ap->ops->mode_filter(ap, adev, mask, shift);
+ 	return mask;
+ }
+ 
+@@ -2345,6 +2435,7 @@
+ /**
+  *	ata_choose_xfer_mode - attempt to find best transfer mode
+  *	@ap: Port for which an xfer mode will be selected
++ *	@adev: ATA device for which xfer mode is being selected
+  *	@xfer_mode_out: (output) SET FEATURES - XFER MODE code
+  *	@xfer_shift_out: (output) bit shift that selects this mode
+  *
+@@ -2359,6 +2450,7 @@
+  */
+ 
+ static int ata_choose_xfer_mode(const struct ata_port *ap,
++				struct ata_device *adev,
+ 				u8 *xfer_mode_out,
+ 				unsigned int *xfer_shift_out)
+ {
+@@ -2367,7 +2459,7 @@
+ 
+ 	for (i = 0; i < ARRAY_SIZE(xfer_mode_classes); i++) {
+ 		shift = xfer_mode_classes[i].shift;
+-		mask = ata_get_mode_mask(ap, shift);
++		mask = ata_get_mode_mask(ap, adev, shift);
+ 
+ 		x = fgb(mask);
+ 		if (x >= 0) {
+@@ -3000,6 +3092,7 @@
+ /**
+  *	ata_mmio_data_xfer - Transfer data by MMIO
+  *	@ap: port to read/write
++ *	@adev: device to target
+  *	@buf: data buffer
+  *	@buflen: buffer length
+  *	@write_data: read/write
+@@ -3010,8 +3103,8 @@
+  *	Inherited from caller.
+  */
+ 
+-static void ata_mmio_data_xfer(struct ata_port *ap, unsigned char *buf,
+-			       unsigned int buflen, int write_data)
++void ata_mmio_data_xfer(struct ata_port *ap, struct ata_device *adev,
++			unsigned char *buf, unsigned int buflen, int write_data)
+ {
+ 	unsigned int i;
+ 	unsigned int words = buflen >> 1;
+@@ -3045,6 +3138,7 @@
+ /**
+  *	ata_pio_data_xfer - Transfer data by PIO
+  *	@ap: port to read/write
++ *	@adev: device to target
+  *	@buf: data buffer
+  *	@buflen: buffer length
+  *	@write_data: read/write
+@@ -3055,11 +3149,11 @@
+  *	Inherited from caller.
+  */
+ 
+-static void ata_pio_data_xfer(struct ata_port *ap, unsigned char *buf,
+-			      unsigned int buflen, int write_data)
++void ata_pio_data_xfer(struct ata_port *ap, struct ata_device *adev,
++			unsigned char *buf, unsigned int buflen, int write_data)
+ {
+ 	unsigned int words = buflen >> 1;
+-
++	
+ 	/* Transfer multiple of 2 bytes */
+ 	if (write_data)
+ 		outsw(ap->ioaddr.data_addr, buf, words);
+@@ -3082,36 +3176,55 @@
+ }
+ 
+ /**
+- *	ata_data_xfer - Transfer data from/to the data register.
++ *	ata_pio_data_xfer_noirq - Transfer data from/to the data register.
+  *	@ap: port to read/write
++ *	@adev: device to target
+  *	@buf: data buffer
+  *	@buflen: buffer length
+  *	@do_write: read/write
+  *
+- *	Transfer data from/to the device data register.
++ *	Transfer data from/to the device data register. This variant
++ *	ensures local IRQs do not interrupt the data stream and this
++ *	is needed for some controllers.
+  *
+  *	LOCKING:
+  *	Inherited from caller.
+  */
+ 
+-static void ata_data_xfer(struct ata_port *ap, unsigned char *buf,
+-			  unsigned int buflen, int do_write)
++void ata_pio_data_xfer_noirq(struct ata_port *ap, struct ata_device *adev,
++			     unsigned char *buf, unsigned int buflen, int do_write)
+ {
+ 	/* Make the crap hardware pay the costs not the good stuff */
+-	if (unlikely(ap->flags & ATA_FLAG_IRQ_MASK)) {
+-		unsigned long flags;
+-		local_irq_save(flags);
+-		if (ap->flags & ATA_FLAG_MMIO)
+-			ata_mmio_data_xfer(ap, buf, buflen, do_write);
+-		else
+-			ata_pio_data_xfer(ap, buf, buflen, do_write);
+-		local_irq_restore(flags);
+-	} else {
+-		if (ap->flags & ATA_FLAG_MMIO)
+-			ata_mmio_data_xfer(ap, buf, buflen, do_write);
+-		else
+-			ata_pio_data_xfer(ap, buf, buflen, do_write);
+-	}
++	unsigned long flags;
++	local_irq_save(flags);
++	ata_pio_data_xfer(ap, adev, buf, buflen, do_write);
++	local_irq_restore(flags);
++}
++
++/**
++ *	ata_mmio_data_xfer_noirq - Transfer data from/to the data register.
++ *	@ap: address to read/write
++ *	@adev: device to target
++ *	@buf: data buffer
++ *	@buflen: buffer length
++ *	@do_write: read/write
++ *
++ *	Transfer data from/to the device data register. This variant
++ *	ensures local IRQs do not interrupt the data stream and this
++ *	is needed for some controllers.
++ *
++ *	LOCKING:
++ *	Inherited from caller.
++ */
++
++void ata_mmio_data_xfer_noirq(struct ata_port *ap, struct ata_device *adev,
++			      unsigned char *buf, unsigned int buflen, int do_write)
++{
++	/* Make the crap hardware pay the costs not the good stuff */
++	unsigned long flags;
++	local_irq_save(flags);
++	ata_mmio_data_xfer(ap, adev, buf, buflen, do_write);
++	local_irq_restore(flags);
+ }
+ 
+ /**
+@@ -3157,7 +3270,7 @@
+ 
+ 	/* do the actual data transfer */
+ 	do_write = (qc->tf.flags & ATA_TFLAG_WRITE);
+-	ata_data_xfer(ap, buf, ATA_SECT_SIZE, do_write);
++	ap->ops->data_xfer(ap, qc->dev, buf, ATA_SECT_SIZE, do_write);
+ 
+ 	kunmap(page);
+ }
+@@ -3204,7 +3317,7 @@
+ 			       ap->id, bytes);
+ 
+ 		for (i = 0; i < words; i++)
+-			ata_data_xfer(ap, (unsigned char*)pad_buf, 2, do_write);
++			ap->ops->data_xfer(ap, qc->dev, (unsigned char*)pad_buf, 2, do_write);
+ 
+ 		ap->hsm_task_state = HSM_ST_LAST;
+ 		return;
+@@ -3239,7 +3352,7 @@
+ 	DPRINTK("data %s\n", qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read");
+ 
+ 	/* do the actual data transfer */
+-	ata_data_xfer(ap, buf, count, do_write);
++	ap->ops->data_xfer(ap, qc->dev, buf, count, do_write);
+ 
+ 	kunmap(page);
+ 
+@@ -3948,14 +4061,15 @@
+ 
+ void ata_bmdma_irq_clear(struct ata_port *ap)
+ {
+-    if (ap->flags & ATA_FLAG_MMIO) {
+-        void __iomem *mmio = ((void __iomem *) ap->ioaddr.bmdma_addr) + ATA_DMA_STATUS;
+-        writeb(readb(mmio), mmio);
+-    } else {
+-        unsigned long addr = ap->ioaddr.bmdma_addr + ATA_DMA_STATUS;
+-        outb(inb(addr), addr);
+-    }
+-
++	if (ap->ioaddr.bmdma_addr) {
++		if (ap->flags & ATA_FLAG_MMIO) {
++			void __iomem *mmio = ((void __iomem *) ap->ioaddr.bmdma_addr) + ATA_DMA_STATUS;
++			writeb(readb(mmio), mmio);
++		} else {
++			unsigned long addr = ap->ioaddr.bmdma_addr + ATA_DMA_STATUS;
++			outb(inb(addr), addr);
++		}
++	}
+ }
+ 
+ 
+@@ -4194,12 +4308,12 @@
+ 		 */
+ 		spin_lock_irqsave(&ap->host_set->lock, flags);
+ 		ap->flags &= ~ATA_FLAG_NOINTR;
+-		ata_data_xfer(ap, qc->cdb, ap->cdb_len, 1);
++		ap->ops->data_xfer(ap, qc->dev, qc->cdb, ap->cdb_len, 1);
+ 		if (qc->tf.protocol == ATA_PROT_ATAPI_DMA)
+ 			ap->ops->bmdma_start(qc);	/* initiate bmdma */
+ 		spin_unlock_irqrestore(&ap->host_set->lock, flags);
+ 	} else {
+-		ata_data_xfer(ap, qc->cdb, ap->cdb_len, 1);
++		ap->ops->data_xfer(ap, qc->dev, qc->cdb, ap->cdb_len, 1);
+ 
+ 		/* PIO commands are handled by polling */
+ 		ap->hsm_task_state = HSM_ST;
+@@ -4505,7 +4619,7 @@
+  *	Number of ports registered.  Zero on error (no ports registered).
+  */
+ 
+-int ata_device_add(const struct ata_probe_ent *ent)
++int ata_device_add(struct ata_probe_ent *ent)
+ {
+ 	unsigned int count = 0, i;
+ 	struct device *dev = ent->dev;
+@@ -4525,6 +4639,9 @@
+ 	host_set->mmio_base = ent->mmio_base;
+ 	host_set->private_data = ent->private_data;
+ 	host_set->ops = ent->port_ops;
++	host_set->host_set_flags = ent->host_set_flags;
++
++	ent->host_set = host_set;
+ 
+ 	/* register each port bound to this device */
+ 	for (i = 0; i < ent->n_ports; i++) {
+@@ -4536,6 +4653,14 @@
+ 			goto err_out;
+ 
+ 		host_set->ports[i] = ap;
++
++		/* Tidy up if we have no bus master base
++		   Not sure this is the right spot to do it */
++		if (ap->ioaddr.bmdma_addr == 0) {
++			ap->udma_mask = 0;
++			ap->mwdma_mask = 0;
++		}
++
+ 		xfer_mode_mask =(ap->udma_mask << ATA_SHIFT_UDMA) |
+ 				(ap->mwdma_mask << ATA_SHIFT_MWDMA) |
+ 				(ap->pio_mask << ATA_SHIFT_PIO);
+@@ -4552,6 +4677,7 @@
+ 	       		ent->irq);
+ 
+ 		ata_chk_status(ap);
++		/* This last call probably should be conditional on bmdma */
+ 		host_set->ops->irq_clear(ap);
+ 		count++;
+ 	}
+@@ -4605,7 +4731,8 @@
+ 		ata_scsi_scan_host(ap);
+ 	}
+ 
+-	dev_set_drvdata(dev, host_set);
++	if(dev)
++		dev_set_drvdata(dev, host_set);
+ 
+ 	VPRINTK("EXIT, returning %u\n", ent->n_ports);
+ 	return ent->n_ports; /* success */
+@@ -4779,6 +4906,7 @@
+ {
+ 	struct ata_probe_ent *probe_ent =
+ 		ata_probe_ent_alloc(pci_dev_to_dev(pdev), port[0]);
++	unsigned long bmdma;
+ 	int p = 0;
+ 
+ 	if (!probe_ent)
+@@ -4793,7 +4921,13 @@
+ 		probe_ent->port[p].altstatus_addr =
+ 		probe_ent->port[p].ctl_addr =
+ 			pci_resource_start(pdev, 1) | ATA_PCI_CTL_OFS;
+-		probe_ent->port[p].bmdma_addr = pci_resource_start(pdev, 4);
++		bmdma = pci_resource_start(pdev, 4);
++
++		if (bmdma) {
++			if (inb(bmdma + 2) & 0x80)
++				probe_ent->host_set_flags |= ATA_HOST_SIMPLEX;
++			probe_ent->port[p].bmdma_addr = bmdma;
++		}
+ 		ata_std_ports(&probe_ent->port[p]);
+ 		p++;
+ 	}
+@@ -4803,7 +4937,14 @@
+ 		probe_ent->port[p].altstatus_addr =
+ 		probe_ent->port[p].ctl_addr =
+ 			pci_resource_start(pdev, 3) | ATA_PCI_CTL_OFS;
+-		probe_ent->port[p].bmdma_addr = pci_resource_start(pdev, 4) + 8;
++		bmdma = pci_resource_start(pdev, 4);
++
++		if (bmdma) {
++			bmdma += 8;
++			if(inb(bmdma + 2) & 0x80)
++				probe_ent->host_set_flags |= ATA_HOST_SIMPLEX;
++			probe_ent->port[p].bmdma_addr = bmdma;
++		}
+ 		ata_std_ports(&probe_ent->port[p]);
+ 		p++;
+ 	}
+@@ -4815,6 +4956,7 @@
+ static struct ata_probe_ent *ata_pci_init_legacy_port(struct pci_dev *pdev, struct ata_port_info *port, int port_num)
+ {
+ 	struct ata_probe_ent *probe_ent;
++	unsigned long bmdma;
+ 
+ 	probe_ent = ata_probe_ent_alloc(pci_dev_to_dev(pdev), port);
+ 	if (!probe_ent)
+@@ -4840,7 +4982,13 @@
+ 			probe_ent->port[0].ctl_addr = 0x376;
+ 			break;
+ 	}
+-	probe_ent->port[0].bmdma_addr = pci_resource_start(pdev, 4) + 8 * port_num;
++	bmdma = pci_resource_start(pdev, 4);
++	if(bmdma != 0) {
++		bmdma += 8 * port_num;
++		probe_ent->port[0].bmdma_addr = bmdma;
++		if (inb(bmdma + 2) & 0x80)
++			probe_ent->host_set_flags |= ATA_HOST_SIMPLEX;
++	}
+ 	ata_std_ports(&probe_ent->port[0]);
+ 	return probe_ent;
+ }
+@@ -5081,6 +5229,33 @@
+ 	pci_set_master(pdev);
+ 	return 0;
+ }
++
++/**
++ *	ata_pci_clear_simplex	-	attempt to kick device out of simplex
++ *	@pdev: PCI device
++ *
++ *	Some PCI ATA devices report simplex mode but in fact can be told to
++ *	enter non simplex mode. This implements the neccessary logic to 
++ *	perform the task on such devices. Calling it on other devices will
++ *	have -undefined- behaviour.
++ */
++
++int ata_pci_clear_simplex(struct pci_dev *pdev)
++{
++	unsigned long bmdma = pci_resource_start(pdev, 4);
++	u8 simplex;
++
++	if (bmdma == 0)
++		return -ENOENT;
++
++	simplex = inb(bmdma + 0x02);
++	outb(simplex & 0x60, bmdma + 0x02);
++	simplex = inb(bmdma + 0x02);
++	if (simplex & 0x80)
++		return -EOPNOTSUPP;
++	return 0;
++}
++
+ #endif /* CONFIG_PCI */
+ 
+ 
+@@ -5158,6 +5333,10 @@
+ EXPORT_SYMBOL_GPL(ata_bmdma_irq_clear);
+ EXPORT_SYMBOL_GPL(ata_bmdma_status);
+ EXPORT_SYMBOL_GPL(ata_bmdma_stop);
++EXPORT_SYMBOL_GPL(ata_mmio_data_xfer);
++EXPORT_SYMBOL_GPL(ata_pio_data_xfer);
++EXPORT_SYMBOL_GPL(ata_mmio_data_xfer_noirq);
++EXPORT_SYMBOL_GPL(ata_pio_data_xfer_noirq);
+ EXPORT_SYMBOL_GPL(ata_port_probe);
+ EXPORT_SYMBOL_GPL(sata_phy_reset);
+ EXPORT_SYMBOL_GPL(__sata_phy_reset);
+@@ -5175,6 +5354,7 @@
+ EXPORT_SYMBOL_GPL(ata_dev_config);
+ EXPORT_SYMBOL_GPL(ata_scsi_simulate);
+ 
++EXPORT_SYMBOL_GPL(ata_dev_pair);
+ EXPORT_SYMBOL_GPL(ata_pio_need_iordy);
+ EXPORT_SYMBOL_GPL(ata_timing_compute);
+ EXPORT_SYMBOL_GPL(ata_timing_merge);
+@@ -5187,6 +5367,8 @@
+ EXPORT_SYMBOL_GPL(ata_pci_remove_one);
+ EXPORT_SYMBOL_GPL(ata_pci_device_suspend);
+ EXPORT_SYMBOL_GPL(ata_pci_device_resume);
++EXPORT_SYMBOL_GPL(ata_pci_clear_simplex);
++
+ #endif /* CONFIG_PCI */
+ 
+ EXPORT_SYMBOL_GPL(ata_device_suspend);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/Makefile linux-2.6.16-rc4/drivers/scsi/Makefile
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/Makefile	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/Makefile	2006-02-17 18:20:44.000000000 +0000
+@@ -139,6 +139,42 @@
+ obj-$(CONFIG_SCSI_SATA_MV)	+= libata.o sata_mv.o
+ obj-$(CONFIG_SCSI_PDC_ADMA)	+= libata.o pdc_adma.o
+ 
++obj-$(CONFIG_SCSI_PATA_ALI)	+= libata.o pata_ali.o
++obj-$(CONFIG_SCSI_PATA_AMD)	+= libata.o pata_amd.o
++obj-$(CONFIG_SCSI_PATA_ARTOP)	+= libata.o pata_artop.o
++obj-$(CONFIG_SCSI_PATA_ATIIXP)	+= libata.o pata_atiixp.o
++obj-$(CONFIG_SCSI_PATA_CMD64X)	+= libata.o pata_cmd64x.o
++obj-$(CONFIG_SCSI_PATA_CS5520)	+= libata.o pata_cs5520.o
++obj-$(CONFIG_SCSI_PATA_CS5530)	+= libata.o pata_cs5530.o
++obj-$(CONFIG_SCSI_PATA_CS5535)	+= libata.o pata_cs5535.o
++obj-$(CONFIG_SCSI_PATA_CYPRESS)	+= libata.o pata_cypress.o
++obj-$(CONFIG_SCSI_PATA_EFAR)	+= libata.o pata_efar.o
++obj-$(CONFIG_SCSI_PATA_ISAPNP)	+= libata.o pata_isapnp.o
++obj-$(CONFIG_SCSI_PATA_HPT37X)	+= libata.o pata_hpt37x.o
++obj-$(CONFIG_SCSI_PATA_HPT3X2N)	+= libata.o pata_hpt3x2n.o
++obj-$(CONFIG_SCSI_PATA_HPT3X3)	+= libata.o pata_hpt34x.o
++obj-$(CONFIG_SCSI_PATA_IT8172)	+= libata.o pata_it8172.o
++obj-$(CONFIG_SCSI_PATA_IT821X)	+= libata.o pata_it821x.o
++obj-$(CONFIG_SCSI_PATA_MPIIX)	+= libata.o pata_mpiix.o
++obj-$(CONFIG_SCSI_PATA_NETCELL)	+= libata.o pata_netcell.o
++obj-$(CONFIG_SCSI_PATA_NS87410)	+= libata.o pata_ns87410.o
++obj-$(CONFIG_SCSI_PATA_OLDPIIX)	+= libata.o pata_oldpiix.o
++obj-$(CONFIG_SCSI_PATA_OPTI)	+= libata.o pata_opti.o
++obj-$(CONFIG_SCSI_PATA_PCMCIA)	+= libata.o pata_pcmcia.o
++obj-$(CONFIG_SCSI_PATA_PDC_OLD)	+= libata.o pata_pdc202xx_old.o
++obj-$(CONFIG_SCSI_PATA_QDI)	+= libata.o pata_qdi.o
++obj-$(CONFIG_SCSI_PATA_RADISYS)	+= libata.o pata_radisys.o
++obj-$(CONFIG_SCSI_PATA_RZ1000)	+= libata.o pata_rz1000.o
++obj-$(CONFIG_SCSI_PATA_SERVERWORKS) += libata.o pata_serverworks.o
++obj-$(CONFIG_SCSI_PATA_SC1200)	+= libata.o pata_sc1200.o
++obj-$(CONFIG_SCSI_PATA_SIL680)	+= libata.o pata_sil680.o
++obj-$(CONFIG_SCSI_PATA_SIS)	+= libata.o pata_sis.o
++obj-$(CONFIG_SCSI_PATA_TRIFLEX)	+= libata.o pata_triflex.o
++obj-$(CONFIG_SCSI_PATA_VIA)	+= libata.o pata_via.o
++obj-$(CONFIG_SCSI_PATA_WINBOND)	+= libata.o pata_sl82c105.o
++obj-$(CONFIG_SCSI_ATA_GENERIC)	+= libata.o ata_generic.o
++obj-$(CONFIG_SCSI_PATA_LEGACY)	+= libata.o pata_legacy.o
++
+ obj-$(CONFIG_ARM)		+= arm/
+ 
+ obj-$(CONFIG_CHR_DEV_ST)	+= st.o
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_ali.c linux-2.6.16-rc4/drivers/scsi/pata_ali.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_ali.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_ali.c	2006-02-20 12:28:04.000000000 +0000
+@@ -0,0 +1,606 @@
++/*
++ * ata-ali.c 	- ALI 15x3 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * TODO
++ *	MWDMA timings
++ *
++ * based in part upon
++ * linux/drivers/ide/pci/alim15x3.c		Version 0.17	2003/01/02
++ *
++ *  Copyright (C) 1998-2000 Michel Aubry, Maintainer
++ *  Copyright (C) 1998-2000 Andrzej Krzysztofowicz, Maintainer
++ *  Copyright (C) 1999-2000 CJ, cjtsai@ali.com.tw, Maintainer
++ *
++ *  Copyright (C) 1998-2000 Andre Hedrick (andre@linux-ide.org)
++ *  May be copied or modified under the terms of the GNU General Public License
++ *  Copyright (C) 2002 Alan Cox <alan@redhat.com>
++ *  ALi (now ULi M5228) support by Clear Zhang <Clear.Zhang@ali.com.tw>
++ *
++ *  Documentation
++ *	Chipset documentation available under NDA only
++ *
++ *  TODO
++ *	Cannot have ATAPI on both master & slave for rev < c2 but
++ *	otherwise should do atapi DMA. 
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "ali"
++#define DRV_VERSION "0.2.2"
++
++/**
++ *	ali_c2_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection for C2 and later revisions
++ */
++ 
++static int ali_c2_cable_detect(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 ata66;
++	
++	/* Certain laptops use short but suitable cables and don't
++	   implement the detect logic */
++	   
++	/* Fujitsu P2000 */
++	if (pdev->subsystem_vendor == 0x10CF && pdev->subsystem_device == 0x10AF)
++	   	return ATA_CBL_PATA80;
++	   	
++	/* Host view cable detect 0x4A bit 0 primary bit 1 secondary
++	   Bit set for 40 pin */
++	pci_read_config_byte(pdev, 0x4A, &ata66);
++	if (ata66 & (1 << ap->hard_port_no))
++		return ATA_CBL_PATA40;
++	else
++		return ATA_CBL_PATA80;
++}
++
++/**
++ *	ali_early_phy_reset	-	reset for eary chip
++ *	@ap: ATA port
++ *
++ *	Handle the reset callback for the later chips with cable detect
++ */
++ 
++static void ali_c2_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ali_c2_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	ali_early_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection for older chipsets. This turns out to be
++ *	rather easy to implement
++ */
++ 
++static int ali_early_cable_detect(struct ata_port *ap) {
++	return ATA_CBL_PATA40;
++}
++
++/**
++ *	ali_early_phy_reset	-	reset for eary chip
++ *	@ap: ATA port
++ *
++ *	Handle the reset callback for the early (pre cable detect) chips.
++ */
++ 
++static void ali_early_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ali_early_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	ali_20_filter		-	filter for earlier ALI DMA
++ *	@ap: ALi ATA port
++ *	@adev: attached device
++ *
++ *	Ensure that we do not do DMA on CD devices. We may be able to
++ *	fix that later on. Also ensure we do not do UDMA on WDC drives
++ */
++ 
++static unsigned int ali_20_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	char model_num[40];
++	/* No DMA on CD for now */
++	if (adev->class != ATA_DEV_ATA && shift != ATA_SHIFT_PIO)
++		return 0;
++		
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++		
++	ata_dev_id_string(adev->id, model_num, ATA_ID_PROD_OFS, sizeof(model_num));
++	if (strstr(model_num, "WDC"))
++		return 0;
++	return mask;
++}
++
++/**
++ *	ali_fifo_control	-	FIFO manager
++ *	@ap: ALi channel to control
++ *	@adev: device for FIFO control
++ *	@on: 0 for off 1 for on
++ *
++ *	Enable or disable the FIFO on a given device. Because of the way the
++ *	ALi FIFO works it provides a boost on ATA disk but can be confused by
++ *	ATAPI and we must therefore manage it.
++ */
++ 
++static void ali_fifo_control(struct ata_port *ap, struct ata_device *adev, int on)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int pio_fifo = 0x54 + ap->hard_port_no;
++	u8 fifo;
++	int shift = 4 * adev->devno;
++
++	/* Bits 3:2 (7:6 for slave) control the PIO. 00 is off 01
++	   is on. The FIFO must not be used for ATAPI. We preserve
++	   BIOS set thresholds */	
++	pci_read_config_byte(pdev, pio_fifo, &fifo);
++	fifo &= ~(0x0C << shift);
++	if (on)
++		fifo |= (0x04 << shift);
++	pci_write_config_byte(pdev, pio_fifo, fifo);
++}
++
++/**
++ *	ali_program_modes	-	load mode registers
++ *	@ap: ALi channel to load
++ *	@adev: Device the timing is for
++ *	@cmd: Command timing
++ *	@data: Data timing
++ *	@udma: UDMA timing or zero for off
++ *
++ *	Loads the timing registers for cmd/data and disable UDMA if 
++ *	udma is zero. If udma is set then load and enable the UDMA
++ *	timing but do not touch the command/data timing.
++ */
++ 
++static void ali_program_modes(struct ata_port *ap, struct ata_device *adev, u8 cmd, u8 data, u8 ultra)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int cbt = 0x59 + 4 * ap->hard_port_no;	/* Command timing */
++	int drwt = 0x5A + 4 * ap->hard_port_no + adev->devno; /* R/W timing */
++	int udmat = 0x56 + ap->hard_port_no;	/* UDMA timing */
++	int shift = 4 * adev->devno;
++	u8 udma;
++
++	if (ultra == 0) {
++		/* FIXME: We ought to set up pcas not rely on the BIOS */
++		/* Load the command block timing register */
++		pci_write_config_byte(pdev, cbt, cmd);
++	
++		/* Load the data transfer timing register */
++		pci_write_config_byte(pdev, drwt, data);
++	}
++	
++	/* Set up the UDMA enable */
++	pci_read_config_byte(pdev, udmat, &udma);
++	udma &= ~(0x0F << shift);
++	udma |= ultra << shift;
++	pci_write_config_byte(pdev, udmat, udma);
++}
++
++/**
++ *	ali_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the ALi registers for PIO mode. FIXME: add timings for
++ *	PIO5.
++ */
++ 
++static void ali_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++	int pio = adev->pio_mode - XFER_PIO_0;
++	int cmdpio = pio;
++	
++	/* These values are from the BIOS programming guide */
++	static u8 cmd_block_timing[5] = { 0x0A, 0x03, 0x01, 0x33, 0x31 };
++	static u8 data_block_timing[5] = { 0x88, 0x58, 0x44, 0x33, 0x31 };
++	
++	if (adev->class != ATA_DEV_ATA)
++		ali_fifo_control(ap, adev, 0);
++
++	/* Command timing is shared, so pick the best we can use */
++	if (pair)
++		cmdpio = min(pair->pio_mode, adev->pio_mode) - XFER_PIO_0;
++		
++	ali_program_modes(ap, adev, cmd_block_timing[cmdpio], 
++				    data_block_timing[pio], 0);
++		
++	if (adev->class == ATA_DEV_ATA)
++		ali_fifo_control(ap, adev, 1);
++	
++}
++
++/**
++ *	ali_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	FIXME: MWDMA timings
++ */
++
++static void ali_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u8 udma_timing[7] = { 0xC, 0xB, 0xA, 0x9, 0x8, 0xF, 0xD };
++
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		ali_program_modes(ap, adev, 0, 0, udma_timing[adev->dma_mode - XFER_UDMA_0]);
++	} else {
++		/* MWDMA is not yet supported */
++		/* ali_program_modes(ap, adev, cmd, data, 0); */
++	}
++}
++
++/**
++ *	ali_lock_sectors	-	Keep older devices to 255 sector mode
++ *	@ap: ATA port
++ *	@adev: Device
++ *
++ *	Called during the bus probe for each device that is found. We use
++ *	this call to lock the sector count of the device to 255 or less on
++ *	older ALi controllers. If we didn't do this then large I/O's would
++ *	require LBA48 commands which the older ALi requires are issued by
++ *	slower PIO methods
++ */
++ 
++static void ali_lock_sectors(struct ata_port *ap, struct ata_device *adev)
++{
++	if(ap->host->max_sectors > 255) {
++		ap->host->max_sectors = 255;
++		ap->host->hostt->max_sectors = 255;
++	}
++	adev->flags |= ATA_DFLAG_LOCK_SECTORS;
++}
++
++static struct scsi_host_template ali_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	/* Keep LBA28 counts so large I/O's don't turn LBA48 and PIO
++	   with older controllers. Not locked so will grow on C5 or later */
++	.max_sectors		= 255,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++/*
++ *	Port operations for PIO only ALi
++ */
++ 
++static struct ata_port_operations ali_early_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= ali_set_piomode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= ali_early_phy_reset,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Port operations for DMA capable ALi without cable
++ *	detect
++ */
++static struct ata_port_operations ali_20_port_ops = {
++	.port_disable	= ata_port_disable,
++
++	.set_piomode	= ali_set_piomode,
++	.set_dmamode	= ali_set_dmamode,
++	.mode_filter	= ali_20_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++	.dev_config	= ali_lock_sectors,
++
++	.phy_reset	= ali_early_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Port operations for DMA capable ALi with cable detect
++ */
++static struct ata_port_operations ali_c2_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= ali_set_piomode,
++	.set_dmamode	= ali_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++	.dev_config	= ali_lock_sectors,
++
++	.phy_reset	= ali_c2_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Port operations for DMA capable ALi with cable detect and LBA48
++ */
++static struct ata_port_operations ali_c5_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= ali_set_piomode,
++	.set_dmamode	= ali_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= ali_c2_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	ali_init_one		-	discovery callback
++ *	@pdev: PCI device ID
++ *	@id: PCI table info
++ *
++ *	An ALi IDE interface has been discovered. Figure out what revision
++ *	and perform configuration work before handing it to the ATA layer
++ */
++ 
++static int ali_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info_early = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.port_ops = &ali_early_port_ops
++	};
++	/* Revision 0x20 added DMA */
++	static struct ata_port_info info_20 = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_PIO_LBA48,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &ali_20_port_ops
++	};
++	/* Revision 0x20 with support logic added UDMA */
++	static struct ata_port_info info_20_udma = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_PIO_LBA48,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x07,	/* UDMA33 */
++		.port_ops = &ali_20_port_ops
++	};
++	/* Revision 0xC2 adds UDMA66 */
++	static struct ata_port_info info_c2 = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_PIO_LBA48,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x1f,
++		.port_ops = &ali_c2_port_ops
++	};
++	/* Revision 0xC3 is UDMA100 */
++	static struct ata_port_info info_c3 = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_PIO_LBA48,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &ali_c2_port_ops
++	};
++	/* Revision 0xC4 is UDMA133 */
++	static struct ata_port_info info_c4 = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_PIO_LBA48,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &ali_c2_port_ops
++	};
++	/* Revision 0xC5 is UDMA133 with LBA48 DMA */
++	static struct ata_port_info info_c5 = {
++		.sht = &ali_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &ali_c5_port_ops
++	};
++	
++	static struct ata_port_info *port_info[2];
++	u8 rev, tmp;
++	struct pci_dev *north, *isa_bridge;
++
++        pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
++        
++        /*
++         * The chipset revision selects the driver operations and
++         * mode data.
++         */
++         
++        if (rev < 0x20) {
++        	port_info[0] = port_info[1] = &info_early;
++	} else if (rev < 0xC2) {
++		/* 1543-E/F, 1543C-C, 1543C-D, 1543C-E */
++		pci_read_config_byte(pdev, 0x4B, &tmp);
++		/* Clear CD-ROM DMA write bit */
++		tmp &= 0x7F;
++		pci_write_config_byte(pdev, 0x4B, tmp);
++        	port_info[0] = port_info[1] = &info_20;
++	} else if (rev == 0xC2) {
++        	port_info[0] = port_info[1] = &info_c2;
++	} else if (rev == 0xC3) {
++        	port_info[0] = port_info[1] = &info_c3;
++	} else if (rev == 0xC4) {
++        	port_info[0] = port_info[1] = &info_c4;
++	} else 
++        	port_info[0] = port_info[1] = &info_c5;
++	
++	if (rev >= 0xC2) {
++		/* Enable cable detection logic */
++		pci_read_config_byte(pdev, 0x4B, &tmp);
++		pci_write_config_byte(pdev, 0x4B, tmp | 0x08);
++	}
++		
++	north = pci_get_slot(pdev->bus, PCI_DEVFN(0,0));
++	isa_bridge = pci_get_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533, NULL);
++	
++	if (north && north->vendor == PCI_VENDOR_ID_AL) {
++		/* Configure the ALi bridge logic. For non ALi rely on BIOS.
++		   Set the south bridge enable bit */
++		pci_read_config_byte(isa_bridge, 0x79, &tmp);
++		if (rev == 0xC2)
++			pci_write_config_byte(isa_bridge, 0x79, tmp | 0x04);
++		else if (rev > 0xC2)
++			pci_write_config_byte(isa_bridge, 0x79, tmp | 0x02);
++	}
++	
++	if (rev >= 0x20) {
++		if (rev < 0xC2) {
++			/* Are we paired with a UDMA capable chip */
++			pci_read_config_byte(isa_bridge, 0x5E, &tmp);
++			if ((tmp & 0x1E) == 0x12)
++		        	port_info[0] = port_info[1] = &info_20_udma;
++		}
++		/*
++		 * CD_ROM DMA on (0x53 bit 0). Enable this even if we want
++		 * to use PIO. 0x53 bit 1 (rev 20 only) - enable FIFO control
++		 * via 0x54/55.
++		 */
++		pci_read_config_byte(pdev, 0x53, &tmp);
++		if (rev == 0x20)
++			tmp &= ~0x02;
++		tmp |= 0x01;
++		pci_write_config_byte(pdev, 0x53, tmp);
++	}
++	
++	pci_dev_put(isa_bridge);
++	pci_dev_put(north);
++	
++	ata_pci_clear_simplex(pdev);
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static struct pci_device_id ali[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M5228), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M5229), },
++	{ 0, },
++};
++
++static struct pci_driver ali_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= ali,
++	.probe 		= ali_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init ali_init(void)
++{
++	return pci_register_driver(&ali_pci_driver);
++}
++
++
++static void __exit ali_exit(void)
++{
++	pci_unregister_driver(&ali_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for ALi PATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, ali);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(ali_init);
++module_exit(ali_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_amd.c linux-2.6.16-rc4/drivers/scsi/pata_amd.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_amd.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_amd.c	2006-02-16 15:37:39.000000000 +0000
+@@ -0,0 +1,650 @@
++/*
++ * pata_amd.c 	- AMD PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ *  Based on pata-sil680. Errata information is taken from data sheets
++ *  and the amd74xx.c driver by Vojtech Pavlik. Nvidia SATA devices are
++ *  claimed by sata-nv.c.
++ *
++ *  TODO:
++ *	Nvidia support here or seperated ?
++ *	Debug cable detect
++ *	Variable system clock when/if it makes sense
++ *	Power management on ports
++ *
++ *
++ *  Documentation publically available.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_amd"
++#define DRV_VERSION "0.1.3"
++
++/**
++ *	timing_setup		-	shared timing computation and load
++ *	@ap: ATA port being set up
++ *	@adev: drive being configured
++ *	@offset: port offset
++ *	@speed: target speed
++ *	@clock: clock multiplier (number of times 33MHz for this part)
++ *
++ *	Perform the actual timing set up for Nvidia or AMD PATA devices.
++ *	The actual devices vary so they all call into this helper function
++ *	providing the clock multipler and offset (because AMD and Nvidia put
++ *	the ports at different locations).
++ */
++
++static void timing_setup(struct ata_port *ap, struct ata_device *adev, int offset, int speed, int clock)
++{
++	static const unsigned char amd_cyc2udma[] = {
++		6, 6, 5, 4, 0, 1, 1, 2, 2, 3, 3, 3, 3, 3, 3, 7
++	};
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct ata_device *peer = ata_dev_pair(ap, adev);
++	int dn = ap->hard_port_no * 2 + adev->devno;
++	struct ata_timing at, apeer;
++	int T, UT;
++	const int amd_clock = 33333;	/* KHz. */
++	u8 t;
++
++	T = 1000000000 / amd_clock;
++	UT = T / min_t(int, max_t(int, clock, 1), 2);
++
++	if (ata_timing_compute(adev, speed, &at, T, UT) < 0) {
++		dev_printk(KERN_ERR, &pdev->dev, "unknown mode %d.\n", speed);
++		return;
++	}
++
++	if (peer) {
++		/* This may be over conservative */
++		if (peer->dma_mode) {
++			ata_timing_compute(peer, peer->dma_mode, &apeer, T, UT);
++			ata_timing_merge(&apeer, &at, &at, ATA_TIMING_8BIT);
++		}
++		ata_timing_compute(peer, peer->pio_mode, &apeer, T, UT);
++		ata_timing_merge(&apeer, &at, &at, ATA_TIMING_8BIT);
++	}
++
++	if (speed == XFER_UDMA_5 && amd_clock <= 33333) at.udma = 1;
++	if (speed == XFER_UDMA_6 && amd_clock <= 33333) at.udma = 15;
++
++	/*
++	 *	Now do the setup work
++	 */
++
++	/* Configure the address set up timing */
++	pci_read_config_byte(pdev, offset + 0x0C, &t);
++	t = (t & ~(3 << ((3 - dn) << 1))) | ((FIT(at.setup, 1, 4) - 1) << ((3 - dn) << 1));
++	pci_write_config_byte(pdev, offset + 0x0C , t);
++
++	/* Configure the 8bit I/O timing */
++	pci_write_config_byte(pdev, offset + 0x0E + (1 - (dn >> 1)),
++		((FIT(at.act8b, 1, 16) - 1) << 4) | (FIT(at.rec8b, 1, 16) - 1));
++
++	/* Drive timing */
++	pci_write_config_byte(pdev, offset + 0x08 + (3 - dn),
++		((FIT(at.active, 1, 16) - 1) << 4) | (FIT(at.recover, 1, 16) - 1));
++
++	switch (clock) {
++		case 1:
++		t = at.udma ? (0xc0 | (FIT(at.udma, 2, 5) - 2)) : 0x03;
++		break;
++
++		case 2:
++		t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 2, 10)]) : 0x03;
++		break;
++
++		case 3:
++		t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 1, 10)]) : 0x03;
++		break;
++
++		case 4:
++		t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 1, 15)]) : 0x03;
++		break;
++
++		default:
++		return;
++	}
++
++	/* UDMA timing */
++	pci_write_config_byte(pdev, offset + 0x10 + (3 - dn), t);
++}
++
++/**
++ *	amd_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection. The BIOS stores this in PCI config
++ *	space for us.
++ */
++
++static int amd_cable_detect(struct ata_port *ap) {
++	static u32 bitmask[2] = {0x00030000, 0x00C00000};
++	u32 ata66;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++
++	pci_read_config_dword(pdev, 0x42, &ata66);
++	if (ata66 & bitmask[ap->hard_port_no])
++		return ATA_CBL_PATA80;
++	else
++		return ATA_CBL_PATA40;
++
++}
++
++static void amd_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits amd_enable_bits[] = {
++		{ 0x40, 1, 0x02, 0x02 },
++		{ 0x40, 1, 0x01, 0x01 }
++	};
++
++	if (!pci_test_config_bits(pdev, &amd_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = amd_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	amd33_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the AMD registers for PIO mode.
++ */
++
++static void amd33_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->pio_mode, 1);
++}
++
++static void amd66_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->pio_mode, 2);
++}
++
++static void amd100_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->pio_mode, 3);
++}
++
++static void amd133_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->pio_mode, 4);
++}
++
++/**
++ *	amd33_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the MWDMA/UDMA modes for the AMD and Nvidia
++ *	chipset.
++ */
++
++static void amd33_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->dma_mode, 1);
++}
++
++static void amd66_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->dma_mode, 2);
++}
++
++static void amd100_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->dma_mode, 3);
++}
++
++static void amd133_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x40, adev->dma_mode, 4);
++}
++
++
++/**
++ *	nv_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection. The BIOS stores this in PCI config
++ *	space for us.
++ */
++
++static int nv_cable_detect(struct ata_port *ap) {
++	static u32 bitmask[2] = {0x00030000, 0x00C00000};
++	u32 ata66;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++
++	pci_read_config_dword(pdev, 0x52, &ata66);
++	if (ata66 & bitmask[ap->hard_port_no])
++		return ATA_CBL_PATA80;
++	else
++		return ATA_CBL_PATA40;
++
++}
++
++static void nv_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = nv_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	nv100_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the AMD registers for PIO mode.
++ */
++
++static void nv100_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x50, adev->pio_mode, 3);
++}
++
++static void nv133_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x50, adev->pio_mode, 4);
++}
++
++/**
++ *	nv100_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the MWDMA/UDMA modes for the AMD and Nvidia
++ *	chipset.
++ */
++
++static void nv100_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x50, adev->dma_mode, 3);
++}
++
++static void nv133_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	timing_setup(ap, adev, 0x50, adev->dma_mode, 4);
++}
++
++static struct scsi_host_template amd_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations amd33_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= amd33_set_piomode,
++	.set_dmamode	= amd33_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= amd_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations amd66_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= amd66_set_piomode,
++	.set_dmamode	= amd66_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= amd_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations amd100_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= amd100_set_piomode,
++	.set_dmamode	= amd100_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= amd_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations amd133_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= amd133_set_piomode,
++	.set_dmamode	= amd133_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= amd_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations nv100_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= nv100_set_piomode,
++	.set_dmamode	= nv100_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= nv_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations nv133_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= nv133_set_piomode,
++	.set_dmamode	= nv133_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= nv_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int amd_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info[10] = {
++		{	/* 0: AMD 7401 */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,	/* No SWDMA */
++			.udma_mask = 0x07,	/* UDMA 33 */
++			.port_ops = &amd33_port_ops
++		},
++		{	/* 1: Early AMD7409 - no swdma */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x1f,	/* UDMA 66 */
++			.port_ops = &amd66_port_ops
++		},
++		{	/* 2: AMD 7409, no swdma errata */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x1f,	/* UDMA 66 */
++			.port_ops = &amd66_port_ops
++		},
++		{	/* 3: AMD 7411 */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,	/* UDMA 100 */
++			.port_ops = &amd100_port_ops
++		},
++		{	/* 4: AMD 7441 */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,	/* UDMA 100 */
++			.port_ops = &amd100_port_ops
++		},
++		{	/* 5: AMD 8111*/
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x7f,	/* UDMA 133, no swdma */
++			.port_ops = &amd133_port_ops
++		},
++		{	/* 6: AMD 8111 UDMA 100 (Serenade) */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,	/* UDMA 100, no swdma */
++			.port_ops = &amd133_port_ops
++		},
++		{	/* 7: Nvidia Nforce */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,	/* UDMA 100 */
++			.port_ops = &nv100_port_ops
++		},
++		{	/* 8: Nvidia Nforce2 and later */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x7f,	/* UDMA 133, no swdma */
++			.port_ops = &nv133_port_ops
++		},
++		{	/* 9: AMD CS5536 (Geode companion) */
++			.sht = &amd_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,	/* UDMA 100 */
++			.port_ops = &amd100_port_ops
++		}
++	};
++	static struct ata_port_info *port_info[2];
++	static int printed_version;
++	int type = id->driver_data;
++	u8 rev;
++	u8 fifo;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
++
++	pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
++	pci_read_config_byte(pdev, 0x41, &fifo);
++
++	/* Check for AMD7409 without swdma errata and if found adjust type */
++	if (type == 1 && rev > 0x7)
++		type = 2;
++
++	/* Check for AMD7411 */
++	if (type == 3)
++		/* FIFO is broken */
++		pci_write_config_byte(pdev, 0x41, fifo & 0x0F);
++	else
++		pci_write_config_byte(pdev, 0x41, fifo | 0xF0);
++
++	/* Serenade ? */
++	if (type == 5 && pdev->subsystem_vendor == PCI_VENDOR_ID_AMD &&
++			 pdev->subsystem_device == PCI_DEVICE_ID_AMD_SERENADE)
++		type = 6;	/* UDMA 100 only */
++
++	if (type < 3)
++		ata_pci_clear_simplex(pdev);
++
++	/* And fire it up */
++
++	port_info[0] = port_info[1] = &info[type];
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id amd[] = {
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_COBRA_7401,		PCI_ANY_ID, PCI_ANY_ID, 0, 0,  0 },
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_VIPER_7409,		PCI_ANY_ID, PCI_ANY_ID, 0, 0,  1 },
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_VIPER_7411,		PCI_ANY_ID, PCI_ANY_ID, 0, 0,  3 },
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_OPUS_7441,		PCI_ANY_ID, PCI_ANY_ID, 0, 0,  4 },
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_8111_IDE,		PCI_ANY_ID, PCI_ANY_ID, 0, 0,  5 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0,  7 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0,  8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2S_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0,  8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0,  8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
++	{ PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_IDE,	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
++	{ PCI_VENDOR_ID_AMD,	PCI_DEVICE_ID_AMD_CS5536_IDE,		PCI_ANY_ID, PCI_ANY_ID, 0, 0, 9 },
++	{ 0, },
++};
++
++static struct pci_driver amd_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= amd,
++	.probe 		= amd_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init amd_init(void)
++{
++	return pci_register_driver(&amd_pci_driver);
++}
++
++static void __exit amd_exit(void)
++{
++	pci_unregister_driver(&amd_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for AMD PATA IDE");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, amd);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(amd_init);
++module_exit(amd_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_artop.c linux-2.6.16-rc4/drivers/scsi/pata_artop.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_artop.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_artop.c	2006-02-07 13:41:48.000000000 +0000
+@@ -0,0 +1,497 @@
++/*
++ *    pata_artop.c - ARTOP ATA controller driver
++ *
++ *	(C) 2006 Red Hat <alan@redhat.com>
++ *
++ *    Based in part on drivers/ide/pci/aec62xx.c 
++ *	Copyright (C) 1999-2002	Andre Hedrick <andre@linux-ide.org>
++ *	865/865R fixes for Macintosh card version from a patch to the old 
++ *		driver by Thibaut VARENE <varenet@parisc-linux.org>
++ *
++ *	TODO
++ *	850 serialization once the core supports it
++ *	Investigate no_dsc on 850R
++ *	Clock detect
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_artop"
++#define DRV_VERSION	"0.2"
++
++/* 
++ *	The ARTOP has 33 Mhz and "over clocked" timing tables. Until we
++ *	get PCI bus speed functionality we leave this as 0. Its a variable
++ *	for when we get the functionality and also for folks wanting to
++ *	test stuff.
++ */
++ 
++static int clock = 0;
++
++/**
++ *	artop6210_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6210_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	const struct pci_bits artop_enable_bits[] = {
++		{ 0x4AU, 1U, 0x02UL, 0x02UL },	/* port 0 */
++		{ 0x4AU, 1U, 0x04UL, 0x04UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &artop_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	artop6260_cable_detect	-	check for 40/80 pin
++ *	@ap: Port
++ *
++ *	The ARTOP hardware reports the cable detect bits in register 0x49.
++ *	Nothing complicated needed here.
++ */
++ 
++static int artop6260_cable_detect(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 tmp;
++
++	pci_read_config_byte(pdev, 0x49, &tmp);
++	if (tmp & (1 >> ap->hard_port_no))
++		return ATA_CBL_PATA40;
++	return ATA_CBL_PATA80;
++}
++
++/**
++ *	artop6260_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6260_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	const struct pci_bits artop_enable_bits[] = {
++		{ 0x4AU, 1U, 0x02UL, 0x02UL },	/* port 0 */
++		{ 0x4AU, 1U, 0x04UL, 0x04UL },	/* port 1 */
++	};
++
++	/* Odd numbered device ids are the units with enable bits (the -R cards) */
++	if (pdev->device % 1 && !pci_test_config_bits(pdev, &artop_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = artop6260_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	artop6210_load_piomode - Load a set of PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device
++ *	@pio: PIO mode
++ *
++ *	Set PIO mode for device, in host controller PCI config space. This
++ *	is used both to set PIO timings in PIO mode and also to set the 
++ *	matching PIO clocking for UDMA, as well as the MWDMA timings.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6210_load_piomode(struct ata_port *ap, struct ata_device *adev, unsigned int pio)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int dn = adev->devno + 2 * ap->hard_port_no;
++	const u16 timing[2][5] = {
++		{ 0x0000, 0x000A, 0x0008, 0x0303, 0x0301 },
++		{ 0x0700, 0x070A, 0x0708, 0x0403, 0x0401 }
++
++	};
++	/* Load the PIO timing active/recovery bits */
++	pci_write_config_word(pdev, 0x40 + 2 * dn, timing[clock][pio]);
++}
++
++/**
++ *	artop6210_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring
++ *
++ *	Set PIO mode for device, in host controller PCI config space. For
++ *	ARTOP we must also clear the UDMA bits if we are not doing UDMA. In
++ *	the event UDMA is used the later call to set_dmamode will set the
++ *	bits as required.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6210_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int dn = adev->devno + 2 * ap->hard_port_no;
++	u8 ultra;
++	
++	artop6210_load_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
++
++	/* Clear the UDMA mode bits (set_dmamode will redo this if needed) */
++	pci_read_config_byte(pdev, 0x54, &ultra);
++	ultra &= ~(3 << (2 * dn));
++	pci_write_config_byte(pdev, 0x54, ultra);
++}
++
++/**
++ *	artop6260_load_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring
++ *	@pio: PIO mode
++ *
++ *	Set PIO mode for device, in host controller PCI config space. The
++ *	ARTOP6260 and relatives store the timing data differently.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6260_load_piomode (struct ata_port *ap, struct ata_device *adev, unsigned int pio)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int dn = adev->devno + 2 * ap->hard_port_no;
++	const u8 timing[2][5] = {
++		{ 0x00, 0x0A, 0x08, 0x33, 0x31 },
++		{ 0x70, 0x7A, 0x78, 0x43, 0x41 }
++
++	};
++	/* Load the PIO timing active/recovery bits */
++	pci_write_config_byte(pdev, 0x40 + dn, timing[clock][pio]);
++}
++
++/**
++ *	artop6260_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring
++ *
++ *	Set PIO mode for device, in host controller PCI config space. For
++ *	ARTOP we must also clear the UDMA bits if we are not doing UDMA. In
++ *	the event UDMA is used the later call to set_dmamode will set the
++ *	bits as required.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6260_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{	
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	u8 ultra;
++	
++	artop6260_load_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
++	
++	/* Clear the UDMA mode bits (set_dmamode will redo this if needed) */
++	pci_read_config_byte(pdev, 0x44 + ap->hard_port_no, &ultra);
++	ultra &= ~(7 << (4  * adev->devno));	/* One nibble per drive */
++	pci_write_config_byte(pdev, 0x44 + ap->hard_port_no, ultra);
++}
++
++/**
++ *	artop6210_set_dmamode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set DMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6210_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio;
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int dn = adev->devno + 2 * ap->hard_port_no;
++	u8 ultra;
++	
++	if (adev->dma_mode == XFER_MW_DMA_0)
++		pio = 1;
++	else
++		pio = 4;
++		
++	/* Load the PIO timing active/recovery bits */
++	artop6210_load_piomode(ap, adev, pio);
++
++	pci_read_config_byte(pdev, 0x54, &ultra);
++	ultra &= ~(3 << (2 * dn));
++	
++	/* Add ultra DMA bits if in UDMA mode */
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		u8 mode = (adev->dma_mode - XFER_UDMA_0) + 1 - clock;
++		if (mode == 0)
++			mode = 1;
++		ultra |= (mode << (2 * dn));
++	}	
++	pci_write_config_byte(pdev, 0x54, ultra);
++}
++
++/**
++ *	artop6260_set_dmamode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring
++ *
++ *	Set DMA mode for device, in host controller PCI config space. The
++ *	ARTOP6260 and relatives store the timing data differently.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void artop6260_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio	= adev->pio_mode - XFER_PIO_0;
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	u8 ultra;
++
++	if (adev->dma_mode == XFER_MW_DMA_0)
++		pio = 1;
++	else
++		pio = 4;
++		
++	/* Load the PIO timing active/recovery bits */
++	artop6260_load_piomode(ap, adev, pio);
++	
++	/* Add ultra DMA bits if in UDMA mode */
++	pci_read_config_byte(pdev, 0x44 + ap->hard_port_no, &ultra);
++	ultra &= ~(7 << (4  * adev->devno));	/* One nibble per drive */
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		u8 mode = adev->dma_mode - XFER_UDMA_0 + 1 - clock;
++		if (mode == 0)
++			mode = 1;
++		ultra |= (mode << (4 * adev->devno));
++	}
++	pci_write_config_byte(pdev, 0x44 + ap->hard_port_no, ultra);
++}
++
++static struct scsi_host_template artop_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations artop6210_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= artop6210_set_piomode,
++	.set_dmamode		= artop6210_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= artop6210_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.eng_timeout		= ata_eng_timeout,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations artop6260_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= artop6260_set_piomode,
++	.set_dmamode		= artop6260_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= artop6260_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++
++/**
++ *	artop_init_one - Register ARTOP ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in artop_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int artop_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	static int printed_version;
++	static struct ata_port_info info_6210 = {
++		.sht		= &artop_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask 	= ATA_UDMA2,
++		.port_ops	= &artop6210_ops,
++	};
++	static struct ata_port_info info_626x = {
++		.sht		= &artop_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask 	= ATA_UDMA4,
++		.port_ops	= &artop6260_ops,
++	};
++	static struct ata_port_info info_626x_fast = {
++		.sht		= &artop_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask 	= ATA_UDMA5,
++		.port_ops	= &artop6260_ops,
++	};
++	struct ata_port_info *port_info[2];
++	struct ata_port_info *info;
++	int ports = 2;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++			   
++	if (id->driver_data == 0) {	/* 6210 variant */
++		info = &info_6210;
++		/* BIOS may have left us in UDMA, clear it before libata probe */
++		pci_write_config_byte(pdev, 0x54, 0);
++		/* For the moment (also lacks dsc) */		
++		printk(KERN_WARNING "ARTOP 6210 requires serialize functionality not yet supported by libata.\n");
++		printk(KERN_WARNING "Secondary ATA ports will not be activated.\n");
++		ports = 1;
++	}
++	else if (id->driver_data == 1)	/* 6260 */
++		info = &info_626x;
++	else if (id->driver_data == 2)	{ /* 6260 or 6260 + fast */
++		unsigned long io = pci_resource_start(pdev, 4);
++		u8 reg;
++
++		info = &info_626x;
++		if (inb(io) & 0x10)
++			info = &info_626x_fast;
++		/* Mac systems come up with some registers not set as we
++		   will need them */
++
++		/* Clear reset & test bits */
++		pci_read_config_byte(pdev, 0x49, &reg);		   
++		pci_write_config_byte(pdev, 0x49, reg & ~ 0x30);
++
++		/* Enable IRQ output and burst mode */
++		pci_read_config_byte(pdev, 0x4a, &reg);
++		pci_write_config_byte(pdev, 0x4a, (reg & ~0x01) | 0x80);
++
++	}
++	port_info[0] = port_info[1] = info;
++	return ata_pci_init_one(pdev, port_info, ports);
++}
++
++static const struct pci_device_id artop_pci_tbl[] = {
++	{ 0x1191, 0x0005, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0x1191, 0x0006, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ 0x1191, 0x0007, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ 0x1191, 0x0008, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ 0x1191, 0x0009, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ }	/* terminate list */
++};
++
++static struct pci_driver artop_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= artop_pci_tbl,
++	.probe			= artop_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init artop_init(void)
++{
++	return pci_register_driver(&artop_pci_driver);
++}
++
++static void __exit artop_exit(void)
++{
++	pci_unregister_driver(&artop_pci_driver);
++}
++
++
++module_init(artop_init);
++module_exit(artop_exit);
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("SCSI low-level driver for ARTOP PATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, artop_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_atiixp.c linux-2.6.16-rc4/drivers/scsi/pata_atiixp.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_atiixp.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_atiixp.c	2006-02-07 13:42:02.000000000 +0000
+@@ -0,0 +1,299 @@
++/*
++ * pata_atiixp.c 	- ATI PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based on
++ *
++ *  linux/drivers/ide/pci/atiixp.c	Version 0.01-bart2	Feb. 26, 2004
++ *
++ *  Copyright (C) 2003 ATI Inc. <hyu@ati.com>
++ *  Copyright (C) 2004 Bartlomiej Zolnierkiewicz
++ *
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_atiixp"
++#define DRV_VERSION "0.1.1"
++
++enum {
++	ATIIXP_IDE_PIO_TIMING	= 0x40,
++	ATIIXP_IDE_MWDMA_TIMING	= 0x44,
++	ATIIXP_IDE_PIO_CONTROL	= 0x48,
++	ATIIXP_IDE_PIO_MODE	= 0x4a,
++	ATIIXP_IDE_UDMA_CONTROL	= 0x54,
++	ATIIXP_IDE_UDMA_MODE 	= 0x56
++};
++
++static void atiixp_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits atiixp_enable_bits[] = {
++		{ 0x48, 1, 0x01, 0x00 },
++		{ 0x48, 1, 0x08, 0x00 }
++	};
++
++	if (!pci_test_config_bits(pdev, &atiixp_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA80;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	atiixp_set_pio_timing	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called by both the pio and dma setup functions to set the controller
++ *	timings for PIO transfers. We must load both the mode number and 
++ *	timing values into the controller.
++ */
++ 
++static void atiixp_set_pio_timing(struct ata_port *ap, struct ata_device *adev, int pio)
++{
++	static u8 pio_timings[5] = { 0x5D, 0x47, 0x34, 0x22, 0x20 };
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int dn = 2 * ap->hard_port_no + adev->devno;
++
++	/* Check this is correct - the order is odd in both drivers */
++	int timing_shift = (16 * ap->hard_port_no) + 8 * (adev->devno ^ 1);
++	u16 pio_mode_data, pio_timing_data;
++	
++	pci_read_config_word(pdev, ATIIXP_IDE_PIO_MODE, &pio_mode_data);
++	pio_mode_data &= ~(0x7 << (4 * dn));
++	pio_mode_data |= pio << (4 * dn);
++	pci_write_config_word(pdev, ATIIXP_IDE_PIO_MODE, pio_mode_data);
++
++	pci_read_config_word(pdev, ATIIXP_IDE_PIO_TIMING, &pio_timing_data);
++	pio_mode_data &= ~(0xFF << timing_shift);
++	pio_mode_data |= (pio_timings[pio] << timing_shift);
++	pci_write_config_word(pdev, ATIIXP_IDE_PIO_TIMING, pio_timing_data);
++}
++
++/**
++ *	atiixp_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. We use a shared helper for this
++ *	as the DMA setup must also adjust the PIO timing information.
++ */
++ 
++static void atiixp_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	atiixp_set_pio_timing(ap, adev, adev->pio_mode - XFER_PIO_0);
++}
++
++/**
++ *	atiixp_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the DMA mode setup. We use timing tables for most
++ *	modes but must tune an appropriate PIO mode to match.
++ */
++ 
++static void atiixp_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u8 mwdma_timings[5] = { 0x77, 0x21, 0x20 };
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int dma = adev->dma_mode;
++	int dn = 2 * ap->hard_port_no + adev->devno;
++	int wanted_pio;
++	
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		u16 udma_mode_data;
++		
++		dma -= XFER_UDMA_0;
++		
++		pci_read_config_word(pdev, ATIIXP_IDE_UDMA_MODE, &udma_mode_data);
++		udma_mode_data &= ~(0x7 << (4 * dn));
++		udma_mode_data |= dma << (4 * dn);
++		pci_write_config_word(pdev, ATIIXP_IDE_UDMA_MODE, udma_mode_data);
++	} else {
++		u16 mwdma_timing_data;
++		/* Check this is correct - the order is odd in both drivers */
++		int timing_shift = (16 * ap->hard_port_no) + 8 * (adev->devno ^ 1);
++		
++		dma -= XFER_MW_DMA_0;
++		
++		pci_read_config_word(pdev, ATIIXP_IDE_MWDMA_TIMING, &mwdma_timing_data);
++		mwdma_timing_data &= ~(0xFF << timing_shift);
++		mwdma_timing_data |= (mwdma_timings[dma] << timing_shift);
++		pci_write_config_word(pdev, ATIIXP_IDE_MWDMA_TIMING, mwdma_timing_data);
++	}
++	/*
++	 *	We must now look at the PIO mode situation. We may need to
++	 *	adjust the PIO mode to keep the timings acceptable
++	 */
++	 if (adev->dma_mode >= XFER_MW_DMA_2)
++	 	wanted_pio = 4;
++	else if (adev->dma_mode == XFER_MW_DMA_1)
++		wanted_pio = 3;
++	else if (adev->dma_mode == XFER_MW_DMA_0)
++		wanted_pio = 0;
++	else BUG();
++	
++	if (adev->pio_mode != wanted_pio)
++		atiixp_set_pio_timing(ap, adev, wanted_pio);
++}
++
++/**
++ *	atiixp_bmdma_start	-	DMA start callback
++ *	@qc: Command in progress
++ *
++ *	When DMA begins we need to ensure that the UDMA control
++ *	register for the channel is correctly set.
++ */
++
++static void atiixp_bmdma_start(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int dn = (2 * ap->hard_port_no) + adev->devno;
++	u16 tmp16;
++	
++	pci_read_config_word(pdev, ATIIXP_IDE_UDMA_CONTROL, &tmp16);
++	if (adev->dma_mode >= XFER_UDMA_0) 
++		tmp16 |= (1 << dn);
++	else
++		tmp16 &= ~(1 << dn);
++	pci_write_config_word(pdev, ATIIXP_IDE_UDMA_CONTROL, tmp16);
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	atiixp_dma_stop	-	DMA stop callback
++ *	@qc: Command in progress
++ *
++ *	DMA has completed. Clear the UDMA flag as the next operations will
++ *	be PIO ones not UDMA data transfer.
++ */
++
++static void atiixp_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int dn = (2 * ap->hard_port_no) + qc->dev->devno;
++	u16 tmp16;
++	
++	pci_read_config_word(pdev, ATIIXP_IDE_UDMA_CONTROL, &tmp16);
++	tmp16 &= ~(1 << dn);
++	pci_write_config_word(pdev, ATIIXP_IDE_UDMA_CONTROL, tmp16);
++	ata_bmdma_stop(qc);
++}
++		
++static struct scsi_host_template atiixp_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations atiixp_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= atiixp_set_piomode,
++	.set_dmamode	= atiixp_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= atiixp_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= atiixp_bmdma_start,
++	.bmdma_stop	= atiixp_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++	
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++	
++static int atiixp_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &atiixp_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x06,	/* No MWDMA0 support */
++		.udma_mask = 0x3F,
++		.port_ops = &atiixp_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id atiixp[] = {
++	{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_IXP200_IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_IXP300_IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_IXP400_IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0, },
++};
++
++static struct pci_driver atiixp_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= atiixp,
++	.probe 		= atiixp_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init atiixp_init(void)
++{
++	return pci_register_driver(&atiixp_pci_driver);
++}
++
++
++static void __exit atiixp_exit(void)
++{
++	pci_unregister_driver(&atiixp_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for ATI IXP200/300/400");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, atiixp);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(atiixp_init);
++module_exit(atiixp_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cmd64x.c linux-2.6.16-rc4/drivers/scsi/pata_cmd64x.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cmd64x.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_cmd64x.c	2006-02-16 15:34:39.000000000 +0000
+@@ -0,0 +1,486 @@
++/*
++ * pata_cmd64x.c 	- ATI PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based upon
++ * linux/drivers/ide/pci/cmd64x.c		Version 1.30	Sept 10, 2002
++ *
++ * cmd64x.c: Enable interrupts at initialization time on Ultra/PCI machines.
++ *           Note, this driver is not used at all on other systems because
++ *           there the "BIOS" has done all of the following already.
++ *           Due to massive hardware bugs, UltraDMA is only supported
++ *           on the 646U2 and not on the 646U.
++ *
++ * Copyright (C) 1998		Eddie C. Dost  (ecd@skynet.be)
++ * Copyright (C) 1998		David S. Miller (davem@redhat.com)
++ *
++ * Copyright (C) 1999-2002	Andre Hedrick <andre@linux-ide.org>
++ *
++ * TODO
++ *	Testing work
++ *	Non x86 needs PIO 0 loading before we commence ident 
++ *		- but this belongs in libata-core
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_cmd64x"
++#define DRV_VERSION "0.1.1"
++
++/*
++ * CMD64x specific registers definition.
++ */
++ 
++enum {
++	CFR 		= 0x50,
++		CFR_INTR_CH0  = 0x02,
++	CNTRL 		= 0x51,
++		CNTRL_DIS_RA0 = 0x40,
++		CNTRL_DIS_RA1 = 0x80,
++		CNTRL_ENA_2ND = 0x08,
++	CMDTIM 		= 0x52,
++	ARTTIM0 	= 0x53,
++	DRWTIM0 	= 0x54,
++	ARTTIM1 	= 0x55,
++	DRWTIM1 	= 0x56,
++	ARTTIM23 	= 0x57,
++		ARTTIM23_DIS_RA2  = 0x04,
++		ARTTIM23_DIS_RA3  = 0x08,
++		ARTTIM23_INTR_CH1 = 0x10,
++	ARTTIM2 	= 0x57,
++	ARTTIM3 	= 0x57,
++	DRWTIM23	= 0x58,
++	DRWTIM2 	= 0x58,
++	BRST 		= 0x59,
++	DRWTIM3 	= 0x5b,
++	BMIDECR0	= 0x70,
++	MRDMODE		= 0x71,
++		MRDMODE_INTR_CH0 = 0x04,
++		MRDMODE_INTR_CH1 = 0x08,
++		MRDMODE_BLK_CH0  = 0x10,
++		MRDMODE_BLK_CH1	 = 0x20,
++	BMIDESR0	= 0x72,
++	UDIDETCR0	= 0x73,
++	DTPR0		= 0x74,
++	BMIDECR1	= 0x78,
++	BMIDECSR	= 0x79,
++	BMIDESR1	= 0x7A,
++	UDIDETCR1	= 0x7B,
++	DTPR1		= 0x7C
++};
++
++/* Phee Phy Pho Phum */
++
++static void cmd64x_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++static void cmd648_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 r;
++
++	/* Check cable detect bits */
++	pci_read_config_byte(pdev, BMIDECSR, &r);
++	if (r & (1 << ap->hard_port_no))
++		ap->cbl = ATA_CBL_PATA80;
++	else	
++		ap->cbl = ATA_CBL_PATA40;
++		
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	cmd64x_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup.
++ */
++ 
++static void cmd64x_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct ata_timing t;
++	const unsigned long T = 1000000 / 33;
++	const u8 setup_data[] = { 0x40, 0x40, 0x40, 0x80, 0x00 };
++	
++	u8 reg;
++	
++	/* Port layout is not logical so use a table */
++	const u8 arttim_port[2][2] = { 
++		{ ARTTIM0, ARTTIM1 },
++		{ ARTTIM23, ARTTIM23 }
++	};
++	const u8 drwtim_port[2][2] = {
++		{ DRWTIM0, DRWTIM1 },
++		{ DRWTIM2, DRWTIM3 }
++	};
++	
++	int arttim = arttim_port[ap->hard_port_no][adev->devno];
++	int drwtim = drwtim_port[ap->hard_port_no][adev->devno];
++	
++	
++	if (ata_timing_compute(adev, adev->pio_mode, &t, T, 0) < 0) {
++		printk(KERN_ERR DRV_NAME ": mome computation failed.\n");
++		return;
++	}
++	if (ap->hard_port_no) {
++		/* Slave has shared address setup */
++		struct ata_device *pair = ata_dev_pair(ap, adev);
++		
++		if (pair) {
++			struct ata_timing tp;
++			ata_timing_compute(pair, pair->pio_mode, &tp, T, 0);
++			ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
++		}
++	}
++	
++	printk(KERN_DEBUG DRV_NAME ": active %d recovery %d setup %d.\n",
++		t.active, t.recover, t.setup);
++	if (t.recover > 16) {
++		t.active += t.recover - 16;
++		t.recover = 16;
++	}
++	if (t.active > 16)
++		t.active = 16;
++		
++	/* Now convert the clocks into values we can actually stuff into
++	   the chip */
++	   
++	if (t.recover > 1)
++		t.recover--;
++	else
++		t.recover = 15;
++	
++	if (t.setup > 4)
++		t.setup = 0xC0;
++	else
++		t.setup = setup_data[t.setup];
++		
++	t.active &= 0x0F;	/* 0 = 16 */
++	
++	/* Load setup timing */
++	pci_read_config_byte(pdev, arttim, &reg);
++	reg &= 0x3F;
++	reg |= t.setup;
++	pci_write_config_byte(pdev, arttim, reg);
++	
++	/* Load active/recovery */
++	pci_write_config_byte(pdev, drwtim, (t.active << 4) | t.recover);	
++}
++
++/**
++ *	cmd64x_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the DMA mode setup.
++ */
++ 
++static void cmd64x_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 regU, regD;
++
++	int pciU = UDIDETCR0 + 8 * ap->hard_port_no;
++	int pciD = BMIDESR0 + 8 * ap->hard_port_no;
++	int shift = 2 * adev->devno;
++	const u8 udma_data[] = { 0x31, 0x21, 0x11, 0x25, 0x15, 0x05 };
++	const u8 mwdma_data[] = { 0x30, 0x20, 0x10 };
++	
++	pci_read_config_byte(pdev, pciD, &regD);
++	pci_read_config_byte(pdev, pciU, &regU);
++
++	regD &= ~(0x20 << shift);
++	regU &= ~(0x35 << shift);
++	
++	if (adev->dma_mode >= XFER_UDMA_0)
++		regU |= udma_data[adev->dma_mode - XFER_UDMA_0] << shift;
++	else
++		regD |= mwdma_data[adev->dma_mode - XFER_MW_DMA_0] << shift;
++
++	regD |= 0x20 << adev->devno;
++
++	pci_write_config_byte(pdev, pciU, regU);
++	pci_write_config_byte(pdev, pciD, regD);
++}
++
++/**
++ *	cmd648_dma_stop	-	DMA stop callback
++ *	@qc: Command in progress
++ *
++ *	DMA has completed.
++ */
++
++static void cmd648_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 dma_intr;
++	int dma_reg = ap->hard_port_no ? ARTTIM23_INTR_CH1 : CFR_INTR_CH0;
++	int dma_mask = ap->hard_port_no ? ARTTIM2 : CFR;
++	
++	ata_bmdma_stop(qc);
++	
++	pci_read_config_byte(pdev, dma_reg, &dma_intr);
++	pci_write_config_byte(pdev, dma_reg, dma_intr | dma_mask);
++}
++		
++/**
++ *	cmd646r1_dma_stop	-	DMA stop callback
++ *	@qc: Command in progress
++ *
++ *	Stub for now while investigating the r1 quirk in the old driver.
++ */
++
++static void cmd646r1_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	ata_bmdma_stop(qc);
++}
++		
++static struct scsi_host_template cmd64x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations cmd64x_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cmd64x_set_piomode,
++	.set_dmamode	= cmd64x_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= cmd64x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations cmd646r1_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cmd64x_set_piomode,
++	.set_dmamode	= cmd64x_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= cmd64x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= cmd646r1_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations cmd648_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cmd64x_set_piomode,
++	.set_dmamode	= cmd64x_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= cmd648_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= cmd648_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++	
++static int cmd64x_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	u32 class_rev;
++	
++	static struct ata_port_info cmd_info[6] = {
++		{	/* CMD 643 - no UDMA */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.port_ops = &cmd64x_port_ops
++		},
++		{	/* CMD 646 with broken UDMA */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.port_ops = &cmd64x_port_ops
++		},
++		{	/* CMD 646 with working UDMA */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA1,
++			.port_ops = &cmd64x_port_ops
++		},
++		{	/* CMD 646 rev 1  */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.port_ops = &cmd646r1_port_ops
++		},
++		{	/* CMD 648 */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA2,
++			.port_ops = &cmd648_port_ops
++		},
++		{	/* CMD 649 */
++			.sht = &cmd64x_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA3,
++			.port_ops = &cmd648_port_ops
++		}
++	};
++	static struct ata_port_info *port_info[2], *info;
++	u8 mrdmode;
++	
++	info = &cmd_info[id->driver_data];
++	
++	pci_read_config_dword(pdev, PCI_CLASS_REVISION, &class_rev);
++	class_rev &= 0xFF;
++	
++	if (id->driver_data == 0)	/* 643 */
++		ata_pci_clear_simplex(pdev);
++	
++	if (pdev->device == PCI_DEVICE_ID_CMD_646) {
++		/* Does UDMA work ? */
++		if (class_rev > 4)
++			info = &cmd_info[2];
++		/* Early rev with other problems ? */
++		else if (class_rev == 1)
++			info = &cmd_info[3];
++	}
++
++	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 64);
++	pci_read_config_byte(pdev, MRDMODE, &mrdmode);
++	mrdmode &= ~ 0x30;	/* IRQ set up */
++	mrdmode |= 0x02;	/* Memory read line enable */
++	pci_write_config_byte(pdev, MRDMODE, mrdmode);
++	
++	/* Force PIO 0 here.. */
++	
++	/* PPC specific fixup copied from old driver */
++#ifdef CONFIG_PPC
++	pci_write_config_byte(pdev, UDIDETCR0, 0xF0);
++#endif
++	
++	port_info[0] = port_info[1] = info;
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static struct pci_device_id cmd64x[] = {
++	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_CMD_643, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_CMD_646, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_CMD_648, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 4},
++	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_CMD_649, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 5},
++	{ 0, },
++};
++
++static struct pci_driver cmd64x_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= cmd64x,
++	.probe 		= cmd64x_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init cmd64x_init(void)
++{
++	return pci_register_driver(&cmd64x_pci_driver);
++}
++
++
++static void __exit cmd64x_exit(void)
++{
++	pci_unregister_driver(&cmd64x_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for CMD64x series PATA controllers");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, cmd64x);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(cmd64x_init);
++module_exit(cmd64x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5520.c linux-2.6.16-rc4/drivers/scsi/pata_cs5520.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5520.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_cs5520.c	2006-02-20 13:17:11.000000000 +0000
+@@ -0,0 +1,322 @@
++/*
++ *	IDE tuning and bus mastering support for the CS5510/CS5520
++ *	chipsets
++ *
++ *	The CS5510/CS5520 are slightly unusual devices. Unlike the 
++ *	typical IDE controllers they do bus mastering with the drive in
++ *	PIO mode and smarter silicon.
++ *
++ *	The practical upshot of this is that we must always tune the
++ *	drive for the right PIO mode. We must also ignore all the blacklists
++ *	and the drive bus mastering DMA information. Also to confuse matters
++ *	further we can do DMA on PIO only drives.
++ *
++ *	DMA on the 5510 also requires we disable_hlt() during DMA on early
++ *	revisions.
++ *
++ *	*** This driver is strictly experimental ***
++ *
++ *	(c) Copyright Red Hat Inc 2002
++ * 
++ * 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, 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.
++ *
++ * Documentation:
++ *	Not publically available.
++ */
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"cs5520"
++#define DRV_VERSION	"0.4"
++
++struct pio_clocks
++{
++	int address;
++	int assert;
++	int recovery;
++};
++
++static struct pio_clocks cs5520_pio_clocks[]={
++	{3, 6, 11},
++	{2, 5, 6},
++	{1, 4, 3},
++	{1, 3, 2},
++	{1, 2, 1}
++};
++
++/**
++ *	cs5520_set_timings	-	program PIO timings
++ *	@ap: ATA port
++ *	@adev: ATA device
++ *
++ *	Program the PIO mode timings for the controller according to the pio
++ *	clocking table. 
++ */
++ 
++static void cs5520_set_timings(struct ata_port *ap, struct ata_device *adev, int pio)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int slave = adev->devno;
++
++	pio -= XFER_PIO_0;
++	
++	/* Channel command timing */
++	pci_write_config_byte(pdev, 0x62 + ap->hard_port_no,
++				(cs5520_pio_clocks[pio].recovery << 4) |
++				(cs5520_pio_clocks[pio].assert));
++	/* FIXME: should these use address ? */
++	/* Read command timing */
++	pci_write_config_byte(pdev, 0x64 +  4*ap->hard_port_no + slave,
++				(cs5520_pio_clocks[pio].recovery << 4) |
++				(cs5520_pio_clocks[pio].assert));
++	/* Write command timing */
++	pci_write_config_byte(pdev, 0x66 +  4*ap->hard_port_no + slave,
++				(cs5520_pio_clocks[pio].recovery << 4) |
++				(cs5520_pio_clocks[pio].assert));
++}
++
++/**
++ *	cs5520_enable_dma	-	turn on DMA bits
++ *
++ *	Turn on the DMA bits for this disk. Needed because the BIOS probably
++ *	has not done the work for us. Belongs in the core SATA code.
++ */
++ 
++static int cs5520_enable_dma(struct ata_port *ap, struct ata_device *adev)
++{
++	/* Set the DMA enable/disable flag */
++	u8 reg = inb(ap->ioaddr.bmdma_addr + 0x02);
++	reg |= 1<<(adev->devno + 5);
++	outb(reg, ap->ioaddr.bmdma_addr + 0x02);
++}
++	
++/**
++ *	cs5520_set_dmamode	-	program DMA timings
++ *	@ap: ATA port
++ *	@adev: ATA device
++ *
++ *	Program the DMA mode timings for the controller according to the pio
++ *	clocking table. Note that this device sets the DMA timings to PIO
++ *	mode values. This may seem bizarre but the 5520 architecture talks
++ *	PIO mode to the disk and DMA mode to the controller so the underlying
++ *	transfers are PIO timed.
++ */
++ 
++static void cs5520_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static const int dma_xlate[3] = { XFER_PIO_0, XFER_PIO_3, XFER_PIO_4 };
++	cs5520_set_timings(ap, adev, dma_xlate[adev->dma_mode]);
++	cs5520_enable_dma(ap, adev);
++}
++
++/**
++ *	cs5520_set_piomode	-	program PIO timings
++ *	@ap: ATA port
++ *	@adev: ATA device
++ *
++ *	Program the PIO mode timings for the controller according to the pio
++ *	clocking table. We know pio_mode will equal dma_mode because of the
++ *	CS5520 architecture. At least once we turned DMA on and wrote a
++ *	mode setter.
++ */
++
++static void cs5520_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	cs5520_set_timings(ap, adev, adev->pio_mode);
++}
++
++static struct scsi_host_template cs5520_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations cs5520_port_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= cs5520_set_piomode,
++	.set_dmamode		= cs5520_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++ 
++static int __devinit cs5520_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	u8 pcicfg;
++	static struct ata_probe_ent probe[2];
++	int ports = 0;
++	
++	pci_read_config_byte(dev, 0x60, &pcicfg);
++	
++	/* Check if the ATA ports are enabled */
++	if ((pcicfg & 3) == 0)
++		return -ENODEV;
++		
++	if ((pcicfg & 0x40) == 0) {
++		printk(KERN_WARNING DRV_NAME ": DMA mode disabled. Enabling.\n");
++		pci_write_config_byte(dev, 0x60, pcicfg | 0x40);
++	}
++		
++	/* Perform set up for DMA */
++	if (pci_enable_device_bars(dev, 1<<2)) {
++		printk(KERN_ERR DRV_NAME ": unable to configure BAR2.\n");
++		return -ENODEV;
++	}
++	pci_set_master(dev);
++	if (pci_set_dma_mask(dev, DMA_32BIT_MASK)) {
++		printk(KERN_ERR DRV_NAME ": unable to configure DMA mask.\n");
++		return -ENODEV;
++	}
++	if (pci_set_consistent_dma_mask(dev, DMA_32BIT_MASK)) {
++		printk(KERN_ERR DRV_NAME ": unable to configure consistent DMA mask.\n");
++		return -ENODEV;
++	}
++	
++	/* We have to do our own plumbing as the PCI setup for this
++	   chipset is non-standard so we can't punt to the libata code */
++	   
++	INIT_LIST_HEAD(&probe[0].node);
++	probe[0].dev = pci_dev_to_dev(dev);
++	probe[0].port_ops = &cs5520_port_ops;
++	probe[0].sht = &cs5520_sht;
++	probe[0].pio_mask = 0x1F;
++	probe[0].mwdma_mask = id->driver_data;
++	probe[0].irq = 14;
++	probe[0].irq_flags = SA_SHIRQ;
++	probe[0].host_flags = ATA_FLAG_SLAVE_POSS;
++	probe[0].legacy_mode = 1;
++	probe[0].n_ports = 1;
++	probe[0].port[0].cmd_addr = 0x1F0;
++	probe[0].port[0].ctl_addr = 0x3F6;
++	probe[0].port[0].altstatus_addr = 0x3F6;
++	probe[0].port[0].bmdma_addr = pci_resource_start(dev, 2);
++	
++	/* The secondary lurks at different addresses but is otherwise
++	   the same beastie */
++	   
++	probe[1] = probe[0];
++	INIT_LIST_HEAD(&probe[1].node);
++	probe[1].irq = 15;
++	probe[1].hard_port_no = 1;
++	probe[1].port[0].cmd_addr = 0x170;
++	probe[1].port[0].ctl_addr = 0x376;
++	probe[1].port[0].altstatus_addr = 0x376;
++	probe[1].port[0].bmdma_addr = pci_resource_start(dev, 2) + 8;
++	
++	/* Let libata fill in the port details */
++	ata_std_ports(&probe[0].port[0]);
++	ata_std_ports(&probe[1].port[0]);
++	
++	/* Now add the ports that are active */
++	if (pcicfg & 1)
++		ports += ata_device_add(&probe[0]);
++	if (pcicfg & 2)
++		ports += ata_device_add(&probe[1]);
++	if (ports)
++		return 0;
++	return -ENODEV;
++}
++
++/**
++ *	cs5520_remove_one	-	device unload
++ *	@pdev: PCI device being removed
++ *
++ *	Handle an unplug/unload event for a PCI device. Unload the
++ *	PCI driver but do not use the default handler as we manage
++ *	resources ourself and *MUST NOT* disable the device as it has
++ *	other functions.
++ */
++ 
++static void __devexit cs5520_remove_one(struct pci_dev *pdev)
++{
++	struct device *dev = pci_dev_to_dev(pdev);
++	struct ata_host_set *host_set = dev_get_drvdata(dev);
++
++	ata_host_set_remove(host_set);
++	dev_set_drvdata(dev, NULL);
++}
++
++/* For now keep DMA off. We can set it for all but A rev CS5510 once the
++   core ATA code can handle it */
++   
++static struct pci_device_id pata_cs5520[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5510), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5520), },
++	{ 0, },
++};
++
++static struct pci_driver cs5520_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= pata_cs5520,
++	.probe 		= cs5520_init_one,
++	.remove		= cs5520_remove_one
++};
++
++
++static int __init cs5520_init(void)
++{
++	return pci_register_driver(&cs5520_pci_driver);
++}
++
++static void __exit cs5520_exit(void)
++{
++	pci_unregister_driver(&cs5520_pci_driver);
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Cyrix CS5510/5520");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, pata_cs5520);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(cs5520_init);
++module_exit(cs5520_exit);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5530.c linux-2.6.16-rc4/drivers/scsi/pata_cs5530.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5530.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_cs5530.c	2006-02-16 15:43:34.000000000 +0000
+@@ -0,0 +1,340 @@
++/*
++ * pata-cs5530.c 	- CS5530 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon cs5530.c by Mark Lord.
++ * 
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
++ * 
++ * Loosely based on the piix & svwks drivers.
++ *
++ * Documentation:
++ *	Available from AMD web site.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"cs5530"
++#define DRV_VERSION	"0.3"
++
++/**
++ *	cs5530_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Set our PIO requirements. This is fairly simple on the CS5530
++ *	chips.
++ */
++ 
++static void cs5530_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	static unsigned int cs5530_pio_timings[2][5] = {
++		{0x00009172, 0x00012171, 0x00020080, 0x00032010, 0x00040010},
++		{0xd1329172, 0x71212171, 0x30200080, 0x20102010, 0x00100010}
++	};
++	unsigned long base = ( ap->ioaddr.bmdma_addr & ~0x0F) + 0x20 + 0x10 * ap->hard_port_no;
++	u32 tuning;
++	int format;
++	
++	/* Find out which table to use */
++	tuning = inl(base + 0x04);
++	format = (tuning & 0x80000000UL) ? 1 : 0;
++	
++	/* Now load the right timing register */
++	if (adev->devno)
++		base += 0x08;
++	
++	outl(cs5530_pio_timings[format][adev->pio_mode - XFER_PIO_0], base);
++}
++
++/**
++ *	cs5530_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	We cannot mix MWDMA and UDMA without reloading timings each switch
++ *	master to slave. We track the last DMA setup in order to minimise
++ *	reloads.
++ */
++ 
++static void cs5530_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned long base = ( ap->ioaddr.bmdma_addr & ~0x0F) + 0x20 + 0x10 * ap->hard_port_no;
++	u32 tuning, timing = 0;
++	u8 reg;
++	
++	/* Find out which table to use */
++	tuning = inl(base + 0x04);
++	
++	switch(adev->dma_mode) {
++		case XFER_UDMA_0:
++			timing  = 0x00921250;break;
++		case XFER_UDMA_1:
++			timing  = 0x00911140;break;
++		case XFER_UDMA_2:
++			timing  = 0x00911030;break;
++		case XFER_MW_DMA_0:
++			timing  = 0x00077771;break;
++		case XFER_MW_DMA_1:
++			timing  = 0x00012121;break;
++		case XFER_MW_DMA_2:
++			timing  = 0x00002020;break;
++		default:
++			BUG();
++	}
++	/* Merge in the PIO format bit */
++	timing |= (tuning & 0x80000000UL);
++	if (adev->devno == 0) /* Master */
++		outl(timing, base + 0x04);
++	else {
++		if (timing & 0x00100000)
++			tuning |= 0x00100000;	/* UDMA for both */
++		else
++			tuning &= ~0x00100000;	/* MWDMA for both */
++		outl(tuning, base + 0x04);
++		outl(timing, base + 0x0C);
++	}
++	
++	/* Set the DMA capable bit in the BMDMA area */
++	reg = inb(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
++	reg |= (1 << (5 + adev->devno));
++	outb(reg, ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
++	
++	/* Remember the last DMA setup we did */
++	
++	ap->private_data = adev;
++}
++
++/**
++ *	cs5530_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary.  Specifically we have a problem that there is only
++ *	one MWDMA/UDMA bit.
++ */
++
++static int cs5530_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	struct ata_device *prev = ap->private_data;
++
++	/* See if the DMA settings could be wrong */
++	if (adev->dma_mode != 0 && adev != prev && prev != NULL) {
++		/* Maybe, but do the channels match MWDMA/UDMA ? */
++		if ((adev->dma_mode >= XFER_UDMA_0 && prev->dma_mode < XFER_UDMA_0) ||
++		    (adev->dma_mode < XFER_UDMA_0 && prev->dma_mode >= XFER_UDMA_0))
++		    	/* Switch the mode bits */
++		    	cs5530_set_dmamode(ap, adev);
++	}
++
++	return ata_qc_issue_prot(qc);
++}
++
++static struct scsi_host_template cs5530_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations cs5530_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cs5530_set_piomode,
++	.set_dmamode	= cs5530_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= cs5530_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	cs5530_init_one		-	Initialise a CS5530
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Install a driver for the newly found CS5530 companion chip. Most of
++ *	this is just housekeeping. We have to set the chip up correctly and
++ *	turn off various bits of emulation magic.
++ */
++ 
++static int cs5530_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	int compiler_warning_pointless_fix;
++	struct pci_dev *master_0 = NULL, *cs5530_0 = NULL;
++	static struct ata_port_info info = {
++		.sht = &cs5530_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x07,
++		.port_ops = &cs5530_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	
++	dev = NULL;
++	while ((dev = pci_get_device(PCI_VENDOR_ID_CYRIX, PCI_ANY_ID, dev)) != NULL) {
++		switch (dev->device) {
++			case PCI_DEVICE_ID_CYRIX_PCI_MASTER:
++				master_0 = pci_dev_get(dev);
++				break;
++			case PCI_DEVICE_ID_CYRIX_5530_LEGACY:
++				cs5530_0 = pci_dev_get(dev);
++				break;
++		}
++	}
++	if (!master_0) {
++		printk(KERN_ERR DRV_NAME ": unable to locate PCI MASTER function\n");
++		goto fail_put;
++	}
++	if (!cs5530_0) {
++		printk(KERN_ERR DRV_NAME ": unable to locate CS5530 LEGACY function\n");
++		goto fail_put;
++	}
++
++	pci_set_master(cs5530_0);
++	compiler_warning_pointless_fix = pci_set_mwi(cs5530_0);
++
++	/*
++	 * Set PCI CacheLineSize to 16-bytes:
++	 * --> Write 0x04 into 8-bit PCI CACHELINESIZE reg of function 0 of the cs5530
++	 *
++	 * Note: This value is constant because the 5530 is only a Geode companion
++	 */
++
++	pci_write_config_byte(cs5530_0, PCI_CACHE_LINE_SIZE, 0x04);
++
++	/*
++	 * Disable trapping of UDMA register accesses (Win98 hack):
++	 * --> Write 0x5006 into 16-bit reg at offset 0xd0 of function 0 of the cs5530
++	 */
++
++	pci_write_config_word(cs5530_0, 0xd0, 0x5006);
++
++	/*
++	 * Bit-1 at 0x40 enables MemoryWriteAndInvalidate on internal X-bus:
++	 * The other settings are what is necessary to get the register
++	 * into a sane state for IDE DMA operation.
++	 */
++
++	pci_write_config_byte(master_0, 0x40, 0x1e);
++
++	/* 
++	 * Set max PCI burst size (16-bytes seems to work best):
++	 *	   16bytes: set bit-1 at 0x41 (reg value of 0x16)
++	 *	all others: clear bit-1 at 0x41, and do:
++	 *	  128bytes: OR 0x00 at 0x41
++	 *	  256bytes: OR 0x04 at 0x41
++	 *	  512bytes: OR 0x08 at 0x41
++	 *	 1024bytes: OR 0x0c at 0x41
++	 */
++
++	pci_write_config_byte(master_0, 0x41, 0x14);
++
++	/*
++	 * These settings are necessary to get the chip
++	 * into a sane state for IDE DMA operation.
++	 */
++
++	pci_write_config_byte(master_0, 0x42, 0x00);
++	pci_write_config_byte(master_0, 0x43, 0xc1);
++	
++	pci_dev_put(master_0);
++	pci_dev_put(cs5530_0);
++
++	/* Now kick off ATA set up */
++	return ata_pci_init_one(dev, port_info, 2);
++	
++fail_put:
++	if (master_0)
++		pci_dev_put(master_0);
++	if (cs5530_0)
++		pci_dev_put(cs5530_0);
++	return -ENODEV;
++}
++
++static struct pci_device_id cs5530[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5530_IDE), },
++	{ 0, },
++};
++
++static struct pci_driver cs5530_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= cs5530,
++	.probe 		= cs5530_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init cs5530_init(void)
++{
++	return pci_register_driver(&cs5530_pci_driver);
++}
++
++
++static void __exit cs5530_exit(void)
++{
++	pci_unregister_driver(&cs5530_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the Cyrix/NS/AMD 5530");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, cs5530);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(cs5530_init);
++module_exit(cs5530_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5535.c linux-2.6.16-rc4/drivers/scsi/pata_cs5535.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cs5535.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_cs5535.c	2006-02-16 15:37:21.000000000 +0000
+@@ -0,0 +1,286 @@
++/*
++ * pata-cs5535.c 	- CS5535 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon cs5535.c from AMD <Jens.Altmann@amd.com> as cleaned up and
++ * made readable and Linux style by Wolfgang Zuleger <wolfgang.zuleger@gmx.de
++ * and Alexander Kiausch <alex.kiausch@t-online.de>
++ * 
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
++ * 
++ * Loosely based on the piix & svwks drivers.
++ *
++ * Documentation:
++ *	Available from AMD web site.
++ * TODO
++ *	Review errata to see if serializing is neccessary
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <asm/msr.h>
++
++#define DRV_NAME	"cs5535"
++#define DRV_VERSION	"0.2.1"
++
++/*
++ *	The Geode (Aka Athlon GX now) uses an internal MSR based
++ *	bus system for control. Demented but there you go.
++ */
++ 
++#define MSR_ATAC_BASE    	0x51300000
++#define ATAC_GLD_MSR_CAP 	(MSR_ATAC_BASE+0)
++#define ATAC_GLD_MSR_CONFIG    (MSR_ATAC_BASE+0x01)
++#define ATAC_GLD_MSR_SMI       (MSR_ATAC_BASE+0x02)
++#define ATAC_GLD_MSR_ERROR     (MSR_ATAC_BASE+0x03)
++#define ATAC_GLD_MSR_PM        (MSR_ATAC_BASE+0x04)
++#define ATAC_GLD_MSR_DIAG      (MSR_ATAC_BASE+0x05)
++#define ATAC_IO_BAR            (MSR_ATAC_BASE+0x08)
++#define ATAC_RESET             (MSR_ATAC_BASE+0x10)
++#define ATAC_CH0D0_PIO         (MSR_ATAC_BASE+0x20)
++#define ATAC_CH0D0_DMA         (MSR_ATAC_BASE+0x21)
++#define ATAC_CH0D1_PIO         (MSR_ATAC_BASE+0x22)
++#define ATAC_CH0D1_DMA         (MSR_ATAC_BASE+0x23) 
++#define ATAC_PCI_ABRTERR       (MSR_ATAC_BASE+0x24)
++
++#define ATAC_BM0_CMD_PRIM      0x00
++#define ATAC_BM0_STS_PRIM      0x02
++#define ATAC_BM0_PRD           0x04
++
++#define CS5535_CABLE_DETECT    0x48
++
++#define CS5535_BAD_PIO(timings) ( (timings&~0x80000000UL)==0x00009172 )
++
++/**
++ *	cs5535_cable_detect		-	detect cable type
++ *	@ap: Port to detect on
++ *
++ *	Perform cable detection for ATA66 capable cable. Return a libata
++ *	cable type.
++ */
++
++static int cs5535_cable_detect(struct ata_port *ap)
++{
++	u8 cable;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++
++	pci_read_config_byte(pdev, CS5535_CABLE_DETECT, &cable);
++	if (cable & 1)
++		return ATA_CBL_PATA80;
++	else
++		return ATA_CBL_PATA40;
++}
++
++/**
++ *	cs5535_phy_reset		-	reset/probe
++ *	@ap: Port to reset
++ *
++ *	Reset and configure a port
++ */
++
++static void cs5535_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = cs5535_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	cs5535_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Set our PIO requirements. The CS5535 is pretty clean about all this
++ */
++ 
++static void cs5535_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u16 pio_timings[5] = {
++		0xF7F4, 0x53F3, 0x13F1, 0x5131, 0x1131
++	};
++	static u16 pio_cmd_timings[5] = {
++		0xF7F4, 0x53F3, 0x13F1, 0x5131, 0x1131
++	};
++	u32 reg, dummy;
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++
++	int mode = adev->pio_mode - XFER_PIO_0;
++	int cmdmode = mode;
++	
++	/* Command timing has to be for the lowest of the pair of devices */
++	if (pair) {
++		int pairmode = pair->pio_mode - XFER_PIO_0;
++		cmdmode = min(mode, pairmode);
++		/* Write the other drive timing register if it changed */
++		if (cmdmode < pairmode)
++			wrmsr(ATAC_CH0D0_PIO + 2 * pair->devno, 
++				pio_cmd_timings[cmdmode] << 16 | pio_timings[pairmode], 0);
++	}
++	/* Write the drive timing register */
++	wrmsr(ATAC_CH0D0_PIO + 2 * adev->devno, 
++		pio_cmd_timings[cmdmode] << 16 | pio_timings[mode], 0);
++
++	/* Set the PIO "format 1" bit in the DMA timing register */
++	rdmsr(ATAC_CH0D0_DMA + 2 * adev->devno, reg, dummy);
++	wrmsr(ATAC_CH0D0_DMA + 2 * adev->devno, reg | 0x80000000UL, 0);
++}
++
++/**
++ *	cs5535_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ */
++ 
++static void cs5535_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u32 udma_timings[5] = { 0x7F7436A1, 0x7F733481, 0x7F723261, 0x7F713161, 0x7F703061 };
++	static u32 mwdma_timings[3] = { 0x7F0FFFF3, 0x7F035352, 0x7F024241 };
++	u32 reg, dummy;
++	int mode = adev->dma_mode;
++	
++	rdmsr(ATAC_CH0D0_DMA + 2 * adev->devno, reg, dummy);
++	reg &= 0x80000000UL;
++	if (mode >= XFER_UDMA_0)
++		reg |= udma_timings[mode - XFER_UDMA_0];
++	else
++		reg |= mwdma_timings[mode - XFER_MW_DMA_0];
++	wrmsr(ATAC_CH0D0_DMA + 2 * adev->devno, reg, 0);
++}
++
++static struct scsi_host_template cs5535_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations cs5535_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cs5535_set_piomode,
++	.set_dmamode	= cs5535_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= cs5535_phy_reset,
++	
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	cs5535_init_one		-	Initialise a CS5530
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Install a driver for the newly found CS5530 companion chip. Most of
++ *	this is just housekeeping. We have to set the chip up correctly and
++ *	turn off various bits of emulation magic.
++ */
++ 
++static int cs5535_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &cs5535_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x1f,
++		.port_ops = &cs5535_port_ops
++	};
++	struct ata_port_info *ports[1] = { &info };
++	
++	u32 timings, dummy;
++	
++	/* Check the BIOS set the initial timing clock. If not set the
++	   timings for PIO0 */
++	rdmsr(ATAC_CH0D0_PIO, timings, dummy);
++	if (CS5535_BAD_PIO(timings))
++		wrmsr(ATAC_CH0D0_PIO, 0xF7F4F7F4UL, 0);
++	rdmsr(ATAC_CH0D1_PIO, timings, dummy);
++	if (CS5535_BAD_PIO(timings))
++		wrmsr(ATAC_CH0D1_PIO, 0xF7F4F7F4UL, 0);
++	return ata_pci_init_one(dev, ports, 1);
++}
++
++static struct pci_device_id cs5535[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_NS, 0x002D), },
++	{ 0, },
++};
++
++static struct pci_driver cs5535_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= cs5535,
++	.probe 		= cs5535_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init cs5535_init(void)
++{
++	return pci_register_driver(&cs5535_pci_driver);
++}
++
++
++static void __exit cs5535_exit(void)
++{
++	pci_unregister_driver(&cs5535_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox, Jens Altmann, Wolfgan Zuleger, Alexander Kiausch");
++MODULE_DESCRIPTION("low-level driver for the NS/AMD 5530");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, cs5535);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(cs5535_init);
++module_exit(cs5535_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cypress.c linux-2.6.16-rc4/drivers/scsi/pata_cypress.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_cypress.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_cypress.c	2006-02-16 15:37:46.000000000 +0000
+@@ -0,0 +1,215 @@
++/*
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_cypress"
++#define DRV_VERSION "0.1"
++
++/* here are the offset definitions for the registers */
++
++enum {
++	CY82_IDE_CMDREG		= 0x04,
++	CY82_IDE_ADDRSETUP	= 0x48,
++	CY82_IDE_MASTER_IOR	= 0x4C,
++	CY82_IDE_MASTER_IOW	= 0x4D,
++	CY82_IDE_SLAVE_IOR	= 0x4E,
++	CY82_IDE_SLAVE_IOW	= 0x4F,
++	CY82_IDE_MASTER_8BIT	= 0x50,
++	CY82_IDE_SLAVE_8BIT	= 0x51,
++
++	CY82_INDEX_PORT		= 0x22,
++	CY82_DATA_PORT		= 0x23,
++
++	CY82_INDEX_CTRLREG1	= 0x01,
++	CY82_INDEX_CHANNEL0	= 0x30,
++	CY82_INDEX_CHANNEL1	= 0x31,
++	CY82_INDEX_TIMEOUT	= 0x32
++};
++
++/* Phee Phy Pho Phum */
++
++static void cy82c693_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	cy82c693_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup.
++ */
++ 
++static void cy82c693_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct ata_timing t;
++	const unsigned long T = 1000000 / 33;
++	short time_16, time_8;
++	u32 addr;
++	
++	if (ata_timing_compute(adev, adev->pio_mode, &t, T, 1) < 0) {
++		printk(KERN_ERR DRV_NAME ": mome computation failed.\n");
++		return;
++	}
++
++	time_16 = FIT(t.recover, 0, 15) | (FIT(t.active, 0, 15) << 4);
++	time_8 = FIT(t.act8b, 0, 15) | (FIT(t.rec8b, 0, 15) << 4);
++	
++	if (adev->devno == 0) {
++		pci_read_config_dword(pdev, CY82_IDE_ADDRSETUP, &addr);
++		
++		addr &= ~0x0F;	/* Mask bits */
++		addr |= FIT(t.setup, 0, 15);
++		
++		pci_write_config_dword(pdev, CY82_IDE_ADDRSETUP, addr);
++		pci_write_config_byte(pdev, CY82_IDE_MASTER_IOR, time_16);
++		pci_write_config_byte(pdev, CY82_IDE_MASTER_IOW, time_16);
++		pci_write_config_byte(pdev, CY82_IDE_MASTER_8BIT, time_8);
++	} else {
++		pci_read_config_dword(pdev, CY82_IDE_ADDRSETUP, &addr);
++		
++		addr &= ~0xF0;	/* Mask bits */
++		addr |= (FIT(t.setup, 0, 15) << 4);
++
++		pci_write_config_dword(pdev, CY82_IDE_ADDRSETUP, addr);
++		pci_write_config_byte(pdev, CY82_IDE_SLAVE_IOR, time_16);
++		pci_write_config_byte(pdev, CY82_IDE_SLAVE_IOW, time_16);
++		pci_write_config_byte(pdev, CY82_IDE_SLAVE_8BIT, time_8);
++	}
++}
++
++/**
++ *	cy82c693_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the DMA mode setup.
++ */
++ 
++static void cy82c693_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	int reg = CY82_INDEX_CHANNEL0 + ap->hard_port_no;
++	
++	/* Be afraid, be very afraid. Magic registers  in low I/O space */
++	outb(reg, 0x22);
++	outb(adev->dma_mode - XFER_MW_DMA_0, 0x23);
++	
++	/* 0x50 gives the best behaviour on the Alpha's using this chip */
++	outb(CY82_INDEX_TIMEOUT, 0x22);
++	outb(0x50, 0x23);
++}
++
++static struct scsi_host_template cy82c693_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations cy82c693_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= cy82c693_set_piomode,
++	.set_dmamode	= cy82c693_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= cy82c693_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static int cy82c693_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &cy82c693_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &cy82c693_port_ops
++	};
++	static struct ata_port_info *port_info[1] = { &info };
++	
++	/* Devfn 1 is the ATA primary. The secondary is magic and on devfn2. For the
++	   moment we don't handle the secondary. FIXME */
++	   
++	if (PCI_FUNC(pdev->devfn) != 1)
++		return -ENODEV;
++	
++	return ata_pci_init_one(pdev, port_info, 1);
++}
++
++static struct pci_device_id cy82c693[] = {
++	{ PCI_VENDOR_ID_CONTAQ, PCI_DEVICE_ID_CONTAQ_82C693, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0, },
++};
++
++static struct pci_driver cy82c693_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= cy82c693,
++	.probe 		= cy82c693_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init cy82c693_init(void)
++{
++	return pci_register_driver(&cy82c693_pci_driver);
++}
++
++
++static void __exit cy82c693_exit(void)
++{
++	pci_unregister_driver(&cy82c693_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the CY82C693 PATA controller");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, cy82c693);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(cy82c693_init);
++module_exit(cy82c693_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_efar.c linux-2.6.16-rc4/drivers/scsi/pata_efar.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_efar.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_efar.c	2006-02-16 15:37:53.000000000 +0000
+@@ -0,0 +1,341 @@
++/*
++ *    pata_efar.c - EFAR PIIX clone controller driver
++ *
++ *	(C) 2005 Red Hat <alan@redhat.com>
++ *
++ *    Some parts based on ata_piix.c by Jeff Garzik and others.
++ *
++ *    The EFAR is a PIIX4 clone with UDMA66 support. Unlike the later
++ *    Intel ICH controllers the EFAR widened the UDMA mode register bits
++ *    and doesn't require the funky clock selection.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_efar"
++#define DRV_VERSION	"0.1"
++
++/**
++ *	efar_cable_detect	-	check for 40/80 pin
++ *	@ap: Port
++ *
++ *	Perform cable detection for the EFAR ATA interface. This is
++ *	different to the PIIX arrangement
++ */
++ 
++static int efar_cable_detect(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 tmp;
++	
++	pci_read_config_byte(pdev, 0x47, &tmp);
++	if (tmp & (2 >> ap->hard_port_no))
++		return ATA_CBL_PATA40;
++	return ATA_CBL_PATA80;
++}
++
++/**
++ *	efar_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void efar_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	const struct pci_bits efar_enable_bits[] = {
++		{ 0x41U, 1U, 0x80UL, 0x80UL },	/* port 0 */
++		{ 0x43U, 1U, 0x80UL, 0x80UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &efar_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = efar_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	efar_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set PIO mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void efar_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio	= adev->pio_mode - XFER_PIO_0;
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	unsigned int idetm_port= ap->hard_port_no ? 0x42 : 0x40;
++	u16 idetm_data;
++	int control = 0;
++	
++	/*
++	 *	See Intel Document 298600-004 for the timing programing rules
++	 *	for PIIX/ICH. The EFAR is a clone so very similar
++	 */
++
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
++
++	if (pio > 2)
++		control |= 1;	/* TIME1 enable */
++	if (ata_pio_need_iordy(adev))	/* PIO 3/4 require IORDY */
++		control |= 2;	/* IE enable */
++	/* Intel specifies that the PPE functionality is for disk only */	   
++	if (adev->class == ATA_DEV_ATA)
++		control |= 4;	/* PPE enable */
++
++	pci_read_config_word(dev, idetm_port, &idetm_data);
++
++	/* Enable PPE, IE and TIME as appropriate */
++	
++	if (adev->devno == 0) {
++		idetm_data &= 0xCCF0;
++		idetm_data |= control;
++		idetm_data |= (timings[pio][0] << 12) |
++			(timings[pio][1] << 8);
++	} else {
++		int shift = 4 * ap->hard_port_no;
++		u8 slave_data;
++		
++		idetm_data &= 0xCC0F;
++		idetm_data |= (control << 4);
++		
++		/* Slave timing in seperate register */
++		pci_read_config_byte(dev, 0x44, &slave_data);
++		slave_data &= 0x0F << shift;
++		slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << shift;
++		pci_write_config_byte(dev, 0x44, slave_data);
++	}
++	
++	idetm_data |= 0x4000;	/* Ensure SITRE is enabled */
++	pci_write_config_word(dev, idetm_port, idetm_data);
++}
++
++/**
++ *	efar_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void efar_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	u8 master_port		= ap->hard_port_no ? 0x42 : 0x40;
++	u16 master_data;
++	u8 speed		= adev->dma_mode;
++	int devid		= adev->devno + 2 * ap->hard_port_no;
++	u8 udma_enable;
++	
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
++
++	pci_read_config_word(dev, master_port, &master_data);
++	pci_read_config_byte(dev, 0x48, &udma_enable);
++	
++	if (speed >= XFER_UDMA_0) {
++		unsigned int udma	= adev->dma_mode - XFER_UDMA_0;
++		u16 udma_timing;
++		
++		udma_enable |= (1 << devid);
++			
++		/* Load the UDMA mode number */
++		pci_read_config_word(dev, 0x4A, &udma_timing);
++		udma_timing &= ~(7 << (4 * devid));
++		udma_timing |= udma << (4 * devid);
++		pci_write_config_word(dev, 0x4A, udma_timing);
++	} else {
++		/*
++		 * MWDMA is driven by the PIO timings. We must also enable
++		 * IORDY unconditionally along with TIME1. PPE has already
++		 * been set when the PIO timing was set.
++		 */
++		unsigned int mwdma	= adev->dma_mode - XFER_MW_DMA_0;
++		unsigned int control;
++		u8 slave_data;
++		const unsigned int needed_pio[3] = {
++			XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
++		};
++		int pio = needed_pio[mwdma] - XFER_PIO_0;
++		
++		control = 3;	/* IORDY|TIME1 */
++		
++		/* If the drive MWDMA is faster than it can do PIO then
++		   we must force PIO into PIO0 */
++		   
++		if (adev->pio_mode < needed_pio[mwdma])
++			/* Enable DMA timing only */
++			control |= 8;	/* PIO cycles in PIO0 */
++
++		if (adev->devno) {	/* Slave */
++			master_data &= 0xFF4F;  /* Mask out IORDY|TIME1|DMAONLY */
++			master_data |= control << 4;
++			pci_read_config_byte(dev, 0x44, &slave_data);
++			slave_data &= (0x0F + 0xE1 * ap->hard_port_no);
++			/* Load the matching timing */
++			slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->hard_port_no ? 4 : 0);
++			pci_write_config_byte(dev, 0x44, slave_data);
++		} else { 	/* Master */
++			master_data &= 0xCCF4;	/* Mask out IORDY|TIME1|DMAONLY 
++						   and master timing bits */
++			master_data |= control;
++			master_data |=
++				(timings[pio][0] << 12) |
++				(timings[pio][1] << 8);
++		}
++		udma_enable &= ~(1 << devid);
++		pci_write_config_word(dev, master_port, master_data);
++	}
++	pci_write_config_byte(dev, 0x48, udma_enable);
++}
++
++static struct scsi_host_template efar_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations efar_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= efar_set_piomode,
++	.set_dmamode		= efar_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= efar_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++
++/**
++ *	efar_init_one - Register EFAR ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in efar_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int efar_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	static struct ata_port_info info = {
++		.sht		= &efar_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma1-2 */
++		.udma_mask 	= 0x0f, /* UDMA 66 */
++		.port_ops	= &efar_ops,
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id efar_pci_tbl[] = {
++	{ 0x1055, 0x9130, PCI_ANY_ID, PCI_ANY_ID, },
++	{ }	/* terminate list */
++};
++
++static struct pci_driver efar_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= efar_pci_tbl,
++	.probe			= efar_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init efar_init(void)
++{
++	return pci_register_driver(&efar_pci_driver);
++}
++
++static void __exit efar_exit(void)
++{
++	pci_unregister_driver(&efar_pci_driver);
++}
++
++
++module_init(efar_init);
++module_exit(efar_exit);
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("SCSI low-level driver for EFAR PIIX clones");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, efar_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt34x.c linux-2.6.16-rc4/drivers/scsi/pata_hpt34x.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt34x.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_hpt34x.c	2006-02-16 15:38:47.000000000 +0000
+@@ -0,0 +1,206 @@
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"hpt34x"
++#define DRV_VERSION	"0.1"
++
++/**
++ *	hpt34x_bus_reset	-	reset the hpt34x bus
++ *	@ap: ATA port to reset
++ *
++ *	Perform the housekeeping when doing an ATA bus reeset. We just
++ *	need to force the cable type.
++ */
++ 
++static void hpt34x_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA40;
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	hpt34x_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Set our PIO requirements. This is fairly simple on the HPT34x as
++ *	all we have to do is clear the MWDMA and UDMA bits then load the
++ *	mode number.
++ */
++ 
++static void hpt34x_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 r1, r2;
++	int dn = 2 * ap->hard_port_no + adev->devno;
++
++	pci_read_config_dword(pdev, 0x44, &r1);
++	pci_read_config_dword(pdev, 0x48, &r2);
++	/* Load the PIO timing number */
++	r1 &= ~(7 << (3 * dn));
++	r1 |= (adev->pio_mode - XFER_PIO_0) << (3 * dn);
++	r2 &= ~(0x11 << dn);	/* Clear MWDMA and UDMA bits */
++	
++	pci_write_config_dword(pdev, 0x44, r1);
++	pci_write_config_dword(pdev, 0x48, r2);
++}
++
++/**
++ *	hpt34x_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	Set up the channel for MWDMA or UDMA modes. Much the same as with
++ *	PIO, load the mode number and then set MWDMA or UDMA flag.
++ */
++ 
++static void hpt34x_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 r1, r2;
++	int dn = 2 * ap->hard_port_no + adev->devno;
++	int mode_num = adev->dma_mode & 0x0F;
++	
++	pci_read_config_dword(pdev, 0x44, &r1);
++	pci_read_config_dword(pdev, 0x48, &r2);
++	/* Load the timing number */
++	r1 &= ~(7 << (3 * dn));
++	r1 |= (mode_num << (3 * dn));
++	r2 &= ~(0x11 << dn);	/* Clear MWDMA and UDMA bits */
++	
++	if (adev->dma_mode >= XFER_UDMA_0)
++		r2 |= 0x01 << dn;	/* Ultra mode */
++	else
++		r2 |= 0x10 << dn;	/* MWDMA */
++	
++	pci_write_config_dword(pdev, 0x44, r1);
++	pci_write_config_dword(pdev, 0x48, r2);
++}
++
++static struct scsi_host_template hpt34x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations hpt34x_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt34x_set_piomode,
++	.set_dmamode	= hpt34x_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt34x_phy_reset,
++
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	hpt34x_init_one		-	Initialise an HPT343/363
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Perform basic initialisation. The chip has a quirk that it won't
++ *	function unless it is at XX00. The old ATA driver touched this up
++ *	but we leave it for pci quirks to do properly.
++ */
++ 
++static int hpt34x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &hpt34x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x07,
++		.port_ops = &hpt34x_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	u16 cmd;
++
++	/* Initialize the board */
++	pci_write_config_word(dev, 0x80, 0x00);
++	/* Check if it is a 343 or a 363. 363 has COMMAND_MEMORY set */
++	pci_read_config_word(dev, PCI_COMMAND, &cmd);
++	if (cmd & PCI_COMMAND_MEMORY)
++		pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0xF0);
++	else
++		pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x20);
++
++	/* Now kick off ATA set up */
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id hpt34x[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT343), },
++	{ 0, },
++};
++
++static struct pci_driver hpt34x_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= hpt34x,
++	.probe 		= hpt34x_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init hpt34x_init(void)
++{
++	return pci_register_driver(&hpt34x_pci_driver);
++}
++
++
++static void __exit hpt34x_exit(void)
++{
++	pci_unregister_driver(&hpt34x_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the Highpoint HPT343/363");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, hpt34x);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(hpt34x_init);
++module_exit(hpt34x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt366.c linux-2.6.16-rc4/drivers/scsi/pata_hpt366.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt366.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_hpt366.c	2006-02-16 15:45:36.000000000 +0000
+@@ -0,0 +1,479 @@
++/*
++ * Libata driver for the highpoint 366 and 368 UDMA66 ATA controllers.
++ *
++ * This driver is heavily based upon:
++ *
++ * linux/drivers/ide/pci/hpt366.c		Version 0.36	April 25, 2003
++ *
++ * Copyright (C) 1999-2003		Andre Hedrick <andre@linux-ide.org>
++ * Portions Copyright (C) 2001	        Sun Microsystems, Inc.
++ * Portions Copyright (C) 2003		Red Hat Inc
++ *
++ *
++ * TODO
++ *	Maybe PLL mode
++ *	Look into engine reset on timeout errors. Should not be
++ *		required.
++ */
++
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"hpt36x"
++#define DRV_VERSION	"0.2"
++
++struct hpt_clock {
++	u8	xfer_speed;
++	u32	timing;
++};
++
++/* key for bus clock timings
++ * bit
++ * 0:3    data_high_time. inactive time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 4:8    data_low_time. active time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 9:12   cmd_high_time. inactive time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 13:17  cmd_low_time. active time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 18:21  udma_cycle_time. clock freq and clock cycles for UDMA xfer.
++ *        during task file register access.
++ * 22:24  pre_high_time. time to initialize 1st cycle for PIO and MW DMA
++ *        xfer.
++ * 25:27  cmd_pre_high_time. time to initialize 1st PIO cycle for task
++ *        register access.
++ * 28     UDMA enable
++ * 29     DMA enable
++ * 30     PIO_MST enable. if set, the chip is in bus master mode during
++ *        PIO.
++ * 31     FIFO enable.
++ */
++
++static struct chipset_bus_clock_list_entry hpt366_40[] = {
++	{	XFER_UDMA_4,	0x900fd943	},
++	{	XFER_UDMA_3,	0x900ad943	},
++	{	XFER_UDMA_2,	0x900bd943	},
++	{	XFER_UDMA_1,	0x9008d943	},
++	{	XFER_UDMA_0,	0x9008d943	},
++
++	{	XFER_MW_DMA_2,	0xa008d943	},
++	{	XFER_MW_DMA_1,	0xa010d955	},
++	{	XFER_MW_DMA_0,	0xa010d9fc	},
++
++	{	XFER_PIO_4,	0xc008d963	},
++	{	XFER_PIO_3,	0xc010d974	},
++	{	XFER_PIO_2,	0xc010d997	},
++	{	XFER_PIO_1,	0xc010d9c7	},
++	{	XFER_PIO_0,	0xc018d9d9	},
++	{	0,		0x0120d9d9	}
++};
++
++static struct chipset_bus_clock_list_entry hpt366_33[] = {
++	{	XFER_UDMA_4,	0x90c9a731	},
++	{	XFER_UDMA_3,	0x90cfa731	},
++	{	XFER_UDMA_2,	0x90caa731	},
++	{	XFER_UDMA_1,	0x90cba731	},
++	{	XFER_UDMA_0,	0x90c8a731	},
++
++	{	XFER_MW_DMA_2,	0xa0c8a731	},
++	{	XFER_MW_DMA_1,	0xa0c8a732	},	/* 0xa0c8a733 */
++	{	XFER_MW_DMA_0,	0xa0c8a797	},
++
++	{	XFER_PIO_4,	0xc0c8a731	},
++	{	XFER_PIO_3,	0xc0c8a742	},
++	{	XFER_PIO_2,	0xc0d0a753	},
++	{	XFER_PIO_1,	0xc0d0a7a3	},	/* 0xc0d0a793 */
++	{	XFER_PIO_0,	0xc0d0a7aa	},	/* 0xc0d0a7a7 */
++	{	0,		0x0120a7a7	}
++};
++
++static struct chipset_bus_clock_list_entry hpt366_25[] = {
++	{	XFER_UDMA_4,	0x90c98521	},
++	{	XFER_UDMA_3,	0x90cf8521	},
++	{	XFER_UDMA_2,	0x90cf8521	},
++	{	XFER_UDMA_1,	0x90cb8521	},
++	{	XFER_UDMA_0,	0x90cb8521	},
++
++	{	XFER_MW_DMA_2,	0xa0ca8521	},
++	{	XFER_MW_DMA_1,	0xa0ca8532	},
++	{	XFER_MW_DMA_0,	0xa0ca8575	},
++
++	{	XFER_PIO_4,	0xc0ca8521	},
++	{	XFER_PIO_3,	0xc0ca8532	},
++	{	XFER_PIO_2,	0xc0ca8542	},
++	{	XFER_PIO_1,	0xc0d08572	},
++	{	XFER_PIO_0,	0xc0d08585	},
++	{	0,		0x01208585	}
++};
++
++static const char *bad_ata33[] = {
++	"Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3", "Maxtor 90845U3", "Maxtor 90650U2",
++	"Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5", "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
++	"Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6", "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
++	"Maxtor 90510D4",
++	"Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
++	"Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7", "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
++	"Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5", "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
++	NULL
++};
++
++static const char *bad_ata66_4[] = {
++	"IBM-DTLA-307075",
++	"IBM-DTLA-307060",
++	"IBM-DTLA-307045",
++	"IBM-DTLA-307030",
++	"IBM-DTLA-307020",
++	"IBM-DTLA-307015",
++	"IBM-DTLA-305040",
++	"IBM-DTLA-305030",
++	"IBM-DTLA-305020",
++	"IC35L010AVER07-0",
++	"IC35L020AVER07-0",
++	"IC35L030AVER07-0",
++	"IC35L040AVER07-0",
++	"IC35L060AVER07-0",
++	"WDC AC310200R",
++	NULL
++};
++
++static const char *bad_ata66_3[] = {
++	"WDC AC310200R",
++	NULL
++};
++
++static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr, const char *list[])
++{
++	unsigned char model_num[40];
++	char *s;
++	unsigned int len;
++	int i = 0;
++
++	ata_dev_id_string(dev->id, model_num, ATA_ID_PROD_OFS,
++			  sizeof(model_num));
++	s = &model_num[0];
++	len = strnlen(s, sizeof(model_num));
++
++	/* ATAPI specifies that empty space is blank-filled; remove blanks */
++	while ((len > 0) && (s[len - 1] == ' ')) {
++		len--;
++		s[len] = 0;
++	}
++
++	while(list[i] != NULL) {
++		if (!strncmp(list[i], s, len)) {
++			printk(KERN_WARNING DRV_NAME ": %s is not supported for %s.\n", 
++				modestr, list[i]);
++			return 1;
++		}
++		i++;
++	}
++	return 0;
++}
++
++/**
++ *	hpt366_filter	-	mode selection filter
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Block UDMA on devices that cause trouble with this controller.
++ */
++ 
++static unsigned int hpt366_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++	if (adev->class != ATA_DEV_ATA)
++		return mask;
++	if (hpt_dma_blacklisted(adev, "UDMA",  bad_ata33))
++		return 0;
++	if (hpt_dma_blacklisted(adev, "UDMA3", bad_ata66_3))
++		return mask & 0x07;
++	if (hpt_dma_blacklisted(adev, "UDMA4", bad_ata66_4))
++		return mask & 0x0F;
++	return mask;
++}
++
++/**
++ *	hpt36x_find_mode	-	reset the hpt36x bus
++ *	@ap: ATA port
++ *	@speed: transfer mode
++ *
++ *	Return the 32bit register programming information for this channel
++ *	that matches the speed provided.
++ */
++ 
++static u32 hpt36x_find_mode(struct ata_port *ap, int speed)
++{
++	struct hpt_clock *clocks = ap->host_set->private_data;
++	
++	while(clocks->xfer_speed) {
++		if (clocks->xfer_speed == speed)
++			return clocks->timing;
++		clocks++;
++	}
++	BUG();
++}
++	
++/**
++ *	hpt36x_phy_reset	-	reset the hpt36x bus
++ *	@ap: ATA port to reset
++ *
++ *	Perform the PHY reset handling for the 366/368
++ */
++ 
++static void hpt36x_phy_reset(struct ata_port *ap)
++{
++	u8 scr2, ata66;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	pci_read_config_byte(pdev, 0x5A, &ata66);
++	if (ata66 & (1 << ap->hard_port_no))
++		ap->cbl = ATA_CBL_PATA40;
++	else
++		ap->cbl = ATA_CBL_PATA80;
++
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	hpt366_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Perform PIO mode setup. 
++ */
++ 
++static void hpt366_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	if (fast & 0x80) {
++		fast &= ~0x80;
++		pci_write_config_byte(pdev, addr2, fast);
++	}
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt36x_find_mode(ap, adev->pio_mode);
++	mode &= ~0x8000000;	/* No FIFO in PIO */
++	mode &= ~0x30070000;	/* Leave config bits alone */
++	reg &= 0x30070000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt366_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	Set up the channel for MWDMA or UDMA modes. Much the same as with
++ *	PIO, load the mode number and then set MWDMA or UDMA flag.
++ */
++ 
++static void hpt366_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	if (fast & 0x80) {
++		fast &= ~0x80;
++		pci_write_config_byte(pdev, addr2, fast);
++	}
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt36x_find_mode(ap, adev->dma_mode);
++	mode |= 0x8000000;	/* FIFO in MWDMA or UDMA */
++	mode &= ~0xC0000000;	/* Leave config bits alone */
++	reg &= 0xC0000000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++static struct scsi_host_template hpt36x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++/*
++ *	Configuration for HPT366/68
++ */
++ 
++static struct ata_port_operations hpt366_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt366_set_piomode,
++	.set_dmamode	= hpt366_set_dmamode,
++	.mode_filter	= hpt366_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt36x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	hpt36x_init_one		-	Initialise an HPT366/368
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Initialise an HPT36x device. There are some interesting complications
++ *	here. Firstly the chip may report 366 and be one of several variants.
++ *	Secondly all the timings depend on the clock for the chip which we must
++ *	detect and look up
++ *
++ *	This is the known chip mappings. It may be missing a couple of later
++ *	releases.
++ *
++ *	Chip version		PCI		Rev	Notes
++ *	HPT366			4 (HPT366)	0	UDMA66
++ *	HPT366			4 (HPT366)	1	UDMA66
++ *	HPT368			4 (HPT366)	2	UDMA66
++ *	HPT37x/30x		4 (HPT366)	3+	Other driver
++ *
++ */
++ 
++static int hpt36x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info_hpt366 = {
++		.sht = &hpt366_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x1f,
++		.port_ops = &hpt370_port_ops
++	};
++	struct ata_port_info *port_info[2] = {&info_hpt366, &info_hpt366};
++
++	u8 irqmask;
++	u32 class_rev;
++	u32 reg1;
++
++	struct hpt_chip *chip_table;
++	int clock_slot;
++
++	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
++	class_rev &= 0xFF;
++	
++	/* May be a later chip in disguise. Check */
++	/* Newer chips are in the HPT36x driver. Ignore them */
++	if (class_rev > 2)
++			return -ENODEV;
++
++	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
++	pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
++	pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
++	pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
++
++	pci_read_config_byte(dev, 0x51, &drive_fast);
++	if (drive_fast & 0x80)
++		pci_write_config_byte(dev, 0x51, drive_fast & ~0x80);
++
++	pci_read_config_dword(dev, 0x40,  &reg1);
++	
++	/* PCI clocking determines the ATA timing values to use */
++	switch((reg1 & 0x700) {
++		case 5:
++			port->private_data = hpt366_40;
++			break;
++		case 9:
++			port->private_data = hpt366_25;
++			break;
++		default:
++			port->private_data = hpt366_33;
++			break;
++	}
++	port_info[0] = port_info[1] = port;	
++	/* Now kick off ATA set up */
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id hpt36x[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT366), },
++	{ 0, },
++};
++
++static struct pci_driver hpt36x_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= hpt36x,
++	.probe 		= hpt36x_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init hpt36x_init(void)
++{
++	return pci_register_driver(&hpt36x_pci_driver);
++}
++
++
++static void __exit hpt36x_exit(void)
++{
++	pci_unregister_driver(&hpt36x_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the Highpoint HPT366/368");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, hpt36x);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(hpt36x_init);
++module_exit(hpt36x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt37x.c linux-2.6.16-rc4/drivers/scsi/pata_hpt37x.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt37x.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_hpt37x.c	2006-02-16 15:45:27.000000000 +0000
+@@ -0,0 +1,1232 @@
++/*
++ * Libata driver for the highpoint 37x and 30x UDMA66 ATA controllers.
++ *
++ * This driver is heavily based upon:
++ *
++ * linux/drivers/ide/pci/hpt366.c		Version 0.36	April 25, 2003
++ *
++ * Copyright (C) 1999-2003		Andre Hedrick <andre@linux-ide.org>
++ * Portions Copyright (C) 2001	        Sun Microsystems, Inc.
++ * Portions Copyright (C) 2003		Red Hat Inc
++ *
++ * TODO
++ *	PLL mode
++ *	Look into engine reset on timeout errors. Should not be
++ *		required.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"hpt37x"
++#define DRV_VERSION	"0.2"
++
++struct hpt_clock {
++	u8	xfer_speed;
++	u32	timing;
++};
++
++struct hpt_chip {
++	const char *name;
++	unsigned int base;
++	struct hpt_clock *clocks[4];
++};
++
++/* key for bus clock timings
++ * bit
++ * 0:3    data_high_time. inactive time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 4:8    data_low_time. active time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 9:12   cmd_high_time. inactive time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 13:17  cmd_low_time. active time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 18:21  udma_cycle_time. clock freq and clock cycles for UDMA xfer.
++ *        during task file register access.
++ * 22:24  pre_high_time. time to initialize 1st cycle for PIO and MW DMA
++ *        xfer.
++ * 25:27  cmd_pre_high_time. time to initialize 1st PIO cycle for task
++ *        register access.
++ * 28     UDMA enable
++ * 29     DMA enable
++ * 30     PIO_MST enable. if set, the chip is in bus master mode during
++ *        PIO.
++ * 31     FIFO enable.
++ */
++
++/* from highpoint documentation. these are old values */
++static struct hpt_clock hpt370_timings_33[] = {
++/*	{	XFER_UDMA_5,	0x1A85F442,	0x16454e31	}, */
++	{	XFER_UDMA_5,	0x16454e31	},
++	{	XFER_UDMA_4,	0x16454e31	},
++	{	XFER_UDMA_3,	0x166d4e31	},
++	{	XFER_UDMA_2,	0x16494e31	},
++	{	XFER_UDMA_1,	0x164d4e31	},
++	{	XFER_UDMA_0,	0x16514e31	},
++
++	{	XFER_MW_DMA_2,	0x26514e21	},
++	{	XFER_MW_DMA_1,	0x26514e33	},
++	{	XFER_MW_DMA_0,	0x26514e97	},
++
++	{	XFER_PIO_4,	0x06514e21	},
++	{	XFER_PIO_3,	0x06514e22	},
++	{	XFER_PIO_2,	0x06514e33	},
++	{	XFER_PIO_1,	0x06914e43	},
++	{	XFER_PIO_0,	0x06914e57	},
++	{	0,		0x06514e57	}
++};
++
++static struct hpt_clock hpt370_timings_66[] = {
++	{	XFER_UDMA_5,	0x14846231	},
++	{	XFER_UDMA_4,	0x14886231	},
++	{	XFER_UDMA_3,	0x148c6231	},
++	{	XFER_UDMA_2,	0x148c6231	},
++	{	XFER_UDMA_1,	0x14906231	},
++	{	XFER_UDMA_0,	0x14986231	},
++
++	{	XFER_MW_DMA_2,	0x26514e21	},
++	{	XFER_MW_DMA_1,	0x26514e33	},
++	{	XFER_MW_DMA_0,	0x26514e97	},
++
++	{	XFER_PIO_4,	0x06514e21	},
++	{	XFER_PIO_3,	0x06514e22	},
++	{	XFER_PIO_2,	0x06514e33	},
++	{	XFER_PIO_1,	0x06914e43	},
++	{	XFER_PIO_0,	0x06914e57	},
++	{	0,		0x06514e57	}
++};
++
++/* these are the current (4 sep 2001) timings from highpoint */
++static struct hpt_clock hpt370a_timings_33[] = {
++	{	XFER_UDMA_5,	0x12446231	},
++	{	XFER_UDMA_4,	0x12446231	},
++	{	XFER_UDMA_3,	0x126c6231	},
++	{	XFER_UDMA_2,	0x12486231	},
++	{	XFER_UDMA_1,	0x124c6233	},
++	{	XFER_UDMA_0,	0x12506297	},
++
++	{	XFER_MW_DMA_2,	0x22406c31	},
++	{	XFER_MW_DMA_1,	0x22406c33	},
++	{	XFER_MW_DMA_0,	0x22406c97	},
++
++	{	XFER_PIO_4,	0x06414e31	},
++	{	XFER_PIO_3,	0x06414e42	},
++	{	XFER_PIO_2,	0x06414e53	},
++	{	XFER_PIO_1,	0x06814e93	},
++	{	XFER_PIO_0,	0x06814ea7	},
++	{	0,		0x06814ea7	}
++};
++
++/* 2x 33MHz timings */
++static struct hpt_clock hpt370a_timings_66[] = {
++	{	XFER_UDMA_5,	0x1488e673	},
++	{	XFER_UDMA_4,	0x1488e673	},
++	{	XFER_UDMA_3,	0x1498e673	},
++	{	XFER_UDMA_2,	0x1490e673	},
++	{	XFER_UDMA_1,	0x1498e677	},
++	{	XFER_UDMA_0,	0x14a0e73f	},
++
++	{	XFER_MW_DMA_2,	0x2480fa73	},
++	{	XFER_MW_DMA_1,	0x2480fa77	}, 
++	{	XFER_MW_DMA_0,	0x2480fb3f	},
++
++	{	XFER_PIO_4,	0x0c82be73	},
++	{	XFER_PIO_3,	0x0c82be95	},
++	{	XFER_PIO_2,	0x0c82beb7	},
++	{	XFER_PIO_1,	0x0d02bf37	},
++	{	XFER_PIO_0,	0x0d02bf5f	},
++	{	0,		0x0d02bf5f	}
++};
++
++static struct hpt_clock hpt370a_timings_50[] = {
++	{	XFER_UDMA_5,	0x12848242	},
++	{	XFER_UDMA_4,	0x12ac8242	},
++	{	XFER_UDMA_3,	0x128c8242	},
++	{	XFER_UDMA_2,	0x120c8242	},
++	{	XFER_UDMA_1,	0x12148254	},
++	{	XFER_UDMA_0,	0x121882ea	},
++
++	{	XFER_MW_DMA_2,	0x22808242	},
++	{	XFER_MW_DMA_1,	0x22808254	},
++	{	XFER_MW_DMA_0,	0x228082ea	},
++
++	{	XFER_PIO_4,	0x0a81f442	},
++	{	XFER_PIO_3,	0x0a81f443	},
++	{	XFER_PIO_2,	0x0a81f454	},
++	{	XFER_PIO_1,	0x0ac1f465	},
++	{	XFER_PIO_0,	0x0ac1f48a	},
++	{	0,		0x0ac1f48a	}
++};
++
++static struct hpt_clock hpt372_timings_33[] = {
++	{	XFER_UDMA_6,	0x1c81dc62	},
++	{	XFER_UDMA_5,	0x1c6ddc62	},
++	{	XFER_UDMA_4,	0x1c8ddc62	},
++	{	XFER_UDMA_3,	0x1c8edc62	},	/* checkme */
++	{	XFER_UDMA_2,	0x1c91dc62	},
++	{	XFER_UDMA_1,	0x1c9adc62	},	/* checkme */
++	{	XFER_UDMA_0,	0x1c82dc62	},	/* checkme */
++
++	{	XFER_MW_DMA_2,	0x2c829262	},
++	{	XFER_MW_DMA_1,	0x2c829266	},	/* checkme */
++	{	XFER_MW_DMA_0,	0x2c82922e	},	/* checkme */
++
++	{	XFER_PIO_4,	0x0c829c62	},
++	{	XFER_PIO_3,	0x0c829c84	},
++	{	XFER_PIO_2,	0x0c829ca6	},
++	{	XFER_PIO_1,	0x0d029d26	},
++	{	XFER_PIO_0,	0x0d029d5e	},
++	{	0,		0x0d029d5e	}
++};
++
++static struct hpt_clock hpt372_timings_50[] = {
++	{	XFER_UDMA_5,	0x12848242	},
++	{	XFER_UDMA_4,	0x12ac8242	},
++	{	XFER_UDMA_3,	0x128c8242	},
++	{	XFER_UDMA_2,	0x120c8242	},
++	{	XFER_UDMA_1,	0x12148254	},
++	{	XFER_UDMA_0,	0x121882ea	},
++
++	{	XFER_MW_DMA_2,	0x22808242	},
++	{	XFER_MW_DMA_1,	0x22808254	},
++	{	XFER_MW_DMA_0,	0x228082ea	},
++
++	{	XFER_PIO_4,	0x0a81f442	},
++	{	XFER_PIO_3,	0x0a81f443	},
++	{	XFER_PIO_2,	0x0a81f454	},
++	{	XFER_PIO_1,	0x0ac1f465	},
++	{	XFER_PIO_0,	0x0ac1f48a	},
++	{	0,		0x0a81f443	}
++};
++
++static struct hpt_clock hpt372_timings_66[] = {
++	{	XFER_UDMA_6,	0x1c869c62	},
++	{	XFER_UDMA_5,	0x1cae9c62	},
++	{	XFER_UDMA_4,	0x1c8a9c62	},
++	{	XFER_UDMA_3,	0x1c8e9c62	},
++	{	XFER_UDMA_2,	0x1c929c62	},
++	{	XFER_UDMA_1,	0x1c9a9c62	},
++	{	XFER_UDMA_0,	0x1c829c62	},
++
++	{	XFER_MW_DMA_2,	0x2c829c62	},
++	{	XFER_MW_DMA_1,	0x2c829c66	},
++	{	XFER_MW_DMA_0,	0x2c829d2e	},
++
++	{	XFER_PIO_4,	0x0c829c62	},
++	{	XFER_PIO_3,	0x0c829c84	},
++	{	XFER_PIO_2,	0x0c829ca6	},
++	{	XFER_PIO_1,	0x0d029d26	},
++	{	XFER_PIO_0,	0x0d029d5e	},
++	{	0,		0x0d029d26	}
++};
++
++static struct hpt_clock hpt374_timings_33[] = {
++	{	XFER_UDMA_6,	0x12808242	},
++	{	XFER_UDMA_5,	0x12848242	},
++	{	XFER_UDMA_4,	0x12ac8242	},
++	{	XFER_UDMA_3,	0x128c8242	},
++	{	XFER_UDMA_2,	0x120c8242	},
++	{	XFER_UDMA_1,	0x12148254	},
++	{	XFER_UDMA_0,	0x121882ea	},
++
++	{	XFER_MW_DMA_2,	0x22808242	},
++	{	XFER_MW_DMA_1,	0x22808254	},
++	{	XFER_MW_DMA_0,	0x228082ea	},
++
++	{	XFER_PIO_4,	0x0a81f442	},
++	{	XFER_PIO_3,	0x0a81f443	},
++	{	XFER_PIO_2,	0x0a81f454	},
++	{	XFER_PIO_1,	0x0ac1f465	},
++	{	XFER_PIO_0,	0x0ac1f48a	},
++	{	0,		0x06814e93	}
++};
++
++static struct hpt_chip hpt370 = {
++	"HPT370",
++	48,
++	{
++		hpt370_timings_33,
++		NULL,
++		NULL,
++		hpt370_timings_66
++	}
++};
++
++static struct hpt_chip hpt370a = {
++	"HPT370A",
++	48,
++	{
++		hpt370a_timings_33,
++		NULL,
++		hpt370a_timings_50,
++		hpt370a_timings_66
++	}
++};
++
++static struct hpt_chip hpt372 = {
++	"HPT372",
++	55,
++	{
++		hpt372_timings_33,
++		NULL,
++		hpt372_timings_50,
++		hpt372_timings_66
++	}
++};
++
++static struct hpt_chip hpt302 = {
++	"HPT302",
++	66,
++	{
++		hpt372_timings_33,
++		NULL,
++		hpt372_timings_50,
++		hpt372_timings_66
++	}
++};
++
++static struct hpt_chip hpt371 = {
++	"HPT371",
++	66,
++	{
++		hpt372_timings_33,
++		NULL,
++		hpt372_timings_50,
++		hpt372_timings_66
++	}
++};
++
++static struct hpt_chip hpt372a = {
++	"HPT372A",
++	66,
++	{
++		hpt372_timings_33,
++		NULL,
++		hpt372_timings_50,
++		hpt372_timings_66
++	}
++};
++
++static struct hpt_chip hpt374 = {
++	"HPT374",
++	48,
++	{
++		hpt374_timings_33,
++		NULL,
++		NULL,
++		NULL
++	}
++};
++
++/**
++ *	hpt37x_find_mode	-	reset the hpt37x bus
++ *	@ap: ATA port
++ *	@speed: transfer mode
++ *
++ *	Return the 32bit register programming information for this channel
++ *	that matches the speed provided.
++ */
++ 
++static u32 hpt37x_find_mode(struct ata_port *ap, int speed)
++{
++	struct hpt_clock *clocks = ap->host_set->private_data;
++	
++	while(clocks->xfer_speed) {
++		if (clocks->xfer_speed == speed)
++			return clocks->timing;
++		clocks++;
++	}
++	BUG();
++}
++
++static int hpt_dma_blacklisted(const struct ata_device *dev, char *modestr, const char *list[])
++{
++	unsigned char model_num[40];
++	char *s;
++	unsigned int len;
++	int i = 0;
++
++	ata_dev_id_string(dev->id, model_num, ATA_ID_PROD_OFS,
++			  sizeof(model_num));
++	s = &model_num[0];
++	len = strnlen(s, sizeof(model_num));
++
++	/* ATAPI specifies that empty space is blank-filled; remove blanks */
++	while ((len > 0) && (s[len - 1] == ' ')) {
++		len--;
++		s[len] = 0;
++	}
++
++	while(list[i] != NULL) {
++		if (!strncmp(list[i], s, len)) {
++			printk(KERN_WARNING DRV_NAME ": %s is not supported for %s.\n", 
++				modestr, list[i]);
++			return 1;
++		}
++		i++;
++	}
++	return 0;
++}
++
++static const char *bad_ata33[] = {
++	"Maxtor 92720U8", "Maxtor 92040U6", "Maxtor 91360U4", "Maxtor 91020U3", "Maxtor 90845U3", "Maxtor 90650U2",
++	"Maxtor 91360D8", "Maxtor 91190D7", "Maxtor 91020D6", "Maxtor 90845D5", "Maxtor 90680D4", "Maxtor 90510D3", "Maxtor 90340D2",
++	"Maxtor 91152D8", "Maxtor 91008D7", "Maxtor 90845D6", "Maxtor 90840D6", "Maxtor 90720D5", "Maxtor 90648D5", "Maxtor 90576D4",
++	"Maxtor 90510D4",
++	"Maxtor 90432D3", "Maxtor 90288D2", "Maxtor 90256D2",
++	"Maxtor 91000D8", "Maxtor 90910D8", "Maxtor 90875D7", "Maxtor 90840D7", "Maxtor 90750D6", "Maxtor 90625D5", "Maxtor 90500D4",
++	"Maxtor 91728D8", "Maxtor 91512D7", "Maxtor 91303D6", "Maxtor 91080D5", "Maxtor 90845D4", "Maxtor 90680D4", "Maxtor 90648D3", "Maxtor 90432D2",
++	NULL
++};
++
++static const char *bad_ata100_5[] = {
++	"IBM-DTLA-307075",
++	"IBM-DTLA-307060",
++	"IBM-DTLA-307045",
++	"IBM-DTLA-307030",
++	"IBM-DTLA-307020",
++	"IBM-DTLA-307015",
++	"IBM-DTLA-305040",
++	"IBM-DTLA-305030",
++	"IBM-DTLA-305020",
++	"IC35L010AVER07-0",
++	"IC35L020AVER07-0",
++	"IC35L030AVER07-0",
++	"IC35L040AVER07-0",
++	"IC35L060AVER07-0",
++	"WDC AC310200R",
++	NULL
++};
++
++/**
++ *	hpt370_filter	-	mode selection filter
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Block UDMA on devices that cause trouble with this controller.
++ */
++ 
++static unsigned int hpt370_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++	if (adev->class != ATA_DEV_ATA)
++		return mask;
++	if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33))
++		return mask & 0x1F;
++	if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
++		return mask & 0x1F;
++	return mask;
++}
++
++/**
++ *	hpt370a_filter	-	mode selection filter
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Block UDMA on devices that cause trouble with this controller.
++ */
++ 
++static unsigned int hpt370a_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++	if (adev->class != ATA_DEV_ATA)
++		return mask;
++	if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5))
++		return mask & 0x1F;
++	return mask;
++}
++	
++/**
++ *	hpt37x_phy_reset	-	reset the hpt37x bus
++ *	@ap: ATA port to reset
++ *
++ *	Perform the PHY reset handling for the 370/372 and 374 func 0
++ */
++ 
++static void hpt37x_phy_reset(struct ata_port *ap)
++{
++	u8 scr2, ata66;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	pci_read_config_byte(pdev, 0x5B, &scr2);
++	pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
++	/* Cable register now active */
++	pci_read_config_byte(pdev, 0x5A, &ata66);
++	/* Restore state */
++	pci_write_config_byte(pdev, 0x5B, scr2);
++	
++	if (ata66 & (1 << ap->hard_port_no))
++		ap->cbl = ATA_CBL_PATA40;
++	else
++		ap->cbl = ATA_CBL_PATA80;
++
++	/* Reset the state machine */
++	pci_write_config_byte(pdev, 0x50, 0x37); 
++	pci_write_config_byte(pdev, 0x54, 0x37); 
++	udelay(100);
++
++	printk("BUS RESET\n");
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	hpt374_phy_reset	-	reset the hpt374
++ *	@ap: ATA port to reset
++ *
++ *	The 374 cable detect is a little different due to the extra
++ *	channels. The function 0 channels work like usual but function 1
++ *	is special
++ */
++ 
++static void hpt374_phy_reset(struct ata_port *ap)
++{
++	u16 mcr3, mcr6;
++	u8 ata66;
++	
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	if (!(PCI_FUNC(pdev->devfn) & 1)) {
++		hpt37x_phy_reset(ap);
++		return;
++	}
++	/* Do the extra channel work */
++	pci_read_config_word(pdev, 0x52, &mcr3);
++	pci_read_config_word(pdev, 0x56, &mcr6);
++	/* Set bit 15 of 0x52 to enable TCBLID as input
++	   Set bit 15 of 0x56 to enable FCBLID as input
++	 */
++	pci_write_config_word(pdev, 0x52, mcr3 | 0x8000);
++	pci_write_config_word(pdev, 0x56, mcr6 | 0x8000);
++	pci_read_config_byte(pdev, 0x5A, &ata66);
++	/* Reset TCBLID/FCBLID to output */
++	pci_write_config_word(pdev, 0x52, mcr3);
++	pci_write_config_word(pdev, 0x56, mcr6);
++	
++	if (ata66 & (1 << ap->hard_port_no))
++		ap->cbl = ATA_CBL_PATA40;
++	else
++		ap->cbl = ATA_CBL_PATA80;
++
++	/* Reset the state machine */
++	pci_write_config_byte(pdev, 0x50, 0x37); 
++	pci_write_config_byte(pdev, 0x54, 0x37); 
++	udelay(100);
++
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++
++/**
++ *	hpt370_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Perform PIO mode setup. 
++ */
++ 
++static void hpt370_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x02;
++	fast |= 0x01;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt37x_find_mode(ap, adev->pio_mode);
++	mode &= ~0x8000000;	/* No FIFO in PIO */
++	mode &= ~0x30070000;	/* Leave config bits alone */
++	reg &= 0x30070000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt370_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	Set up the channel for MWDMA or UDMA modes. Much the same as with
++ *	PIO, load the mode number and then set MWDMA or UDMA flag.
++ */
++ 
++static void hpt370_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x02;
++	fast |= 0x01;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt37x_find_mode(ap, adev->dma_mode);
++	mode |= 0x8000000;	/* FIFO in MWDMA or UDMA */
++	mode &= ~0xC0000000;	/* Leave config bits alone */
++	reg &= 0xC0000000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt370_bmdma_start		-	DMA engine begin
++ *	@qc: ATA command
++ *
++ *	The 370 and 370A want us to reset the DMA engine each time we
++ *	use it. The 372 and later are fine.
++ */
++ 
++static void hpt370_bmdma_start(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	pci_write_config_byte(pdev, 0x50 + 4 * ap->hard_port_no, 0x37);
++	udelay(10);
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	hpt370_bmdma_end		-	DMA engine stop
++ *	@qc: ATA command
++ *
++ *	Work around the HPT370 DMA engine.
++ */
++ 
++static void hpt370_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 dma_stat = inb(ap->ioaddr.bmdma_addr + 2);
++	u8 dma_cmd;
++	unsigned long bmdma = ap->ioaddr.bmdma_addr;
++	
++	if (dma_stat & 0x01) {
++		udelay(20);
++		dma_stat = inb(bmdma + 2);
++	}
++	if (dma_stat & 0x01) {
++		/* Clear the engine */
++		pci_write_config_byte(pdev, 0x50 + 4 * ap->hard_port_no, 0x37);
++		udelay(10);
++		/* Stop DMA */
++		dma_cmd = inb(bmdma );
++		outb(dma_cmd & 0xFE, bmdma);
++		/* Clear Error */
++		dma_stat = inb(bmdma + 2);
++		outb(dma_stat | 0x06 , bmdma + 2);
++		/* Clear the engine */
++		pci_write_config_byte(pdev, 0x50 + 4 * ap->hard_port_no, 0x37);
++		udelay(10);
++	}
++	ata_bmdma_stop(qc);
++}
++
++/**
++ *	hpt372_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Perform PIO mode setup. 
++ */
++ 
++static void hpt372_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x07;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt37x_find_mode(ap, adev->pio_mode);
++	
++	printk("Find mode for %d reports %X\n", adev->pio_mode, mode);
++	mode &= ~0x8000000;	/* No FIFO in PIO */
++	mode &= ~0x30070000;	/* Leave config bits alone */
++	reg &= 0x30070000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt372_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	Set up the channel for MWDMA or UDMA modes. Much the same as with
++ *	PIO, load the mode number and then set MWDMA or UDMA flag.
++ */
++ 
++static void hpt372_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x07;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt37x_find_mode(ap, adev->dma_mode);
++	printk("Find mode for DMA %d reports %X\n", adev->dma_mode, mode);
++	mode &= ~0xC0000000;	/* Leave config bits alone */
++	mode |= 0x8000000;	/* FIFO in MWDMA or UDMA */
++	reg &= 0xC0000000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt37x_bmdma_end		-	DMA engine stop
++ *	@qc: ATA command
++ *
++ *	Clean up after the HPT372 and later DMA engine
++ */
++ 
++static void hpt37x_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int mscreg = 0x50 + 2 * ap->hard_port_no;
++	u8 bwsr_stat, msc_stat;
++	
++	pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
++	pci_read_config_byte(pdev, mscreg, &msc_stat);
++	if (bwsr_stat & (1 << ap->hard_port_no))
++		pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
++	ata_bmdma_stop(qc);
++}
++
++
++static struct scsi_host_template hpt37x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++/*
++ *	Configuration for HPT370
++ */
++ 
++static struct ata_port_operations hpt370_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt370_set_piomode,
++	.set_dmamode	= hpt370_set_dmamode,
++	.mode_filter	= hpt370_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt37x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= hpt370_bmdma_start,
++	.bmdma_stop	= hpt370_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Configuration for HPT370A. Close to 370 but less filters
++ */
++ 
++static struct ata_port_operations hpt370a_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt370_set_piomode,
++	.set_dmamode	= hpt370_set_dmamode,
++	.mode_filter	= hpt370a_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt37x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= hpt370_bmdma_start,
++	.bmdma_stop	= hpt370_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Configuration for HPT372, HPT371, HPT302. Slightly different PIO
++ *	and DMA mode setting functionality.
++ */
++ 
++static struct ata_port_operations hpt372_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt372_set_piomode,
++	.set_dmamode	= hpt372_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt37x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= hpt37x_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Configuration for HPT374. Mode setting works like 372 and friends
++ *	but we have a different cable detection procedure.
++ */
++ 
++static struct ata_port_operations hpt374_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt372_set_piomode,
++	.set_dmamode	= hpt372_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt374_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= hpt37x_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	htp37x_clock_slot	-	Turn timing to PC clock entry
++ *	@freq: Reported frequency timing
++ *	@base: Base timing
++ *
++ *	Turn the timing data intoa clock slot (0 for 33, 1 for 40, 2 for 50
++ *	and 3 for 66Mhz)
++ */
++ 
++static int hpt37x_clock_slot(unsigned int freq, unsigned int base)
++{
++	unsigned int f = (base * freq) / 192;	/* Mhz */
++	if (f < 40)
++		return 0;	/* 33Mhz slot */
++	if (f < 45)
++		return 1;	/* 40Mhz slot */
++	if (f < 55)
++		return 2;	/* 50Mhz slot */
++	return 3;		/* 60Mhz slot */
++}
++
++/**
++ *	hpt37x_calibrate_dpll		-	Calibrate the DPLL loop
++ *	@dev: PCI device 
++ *
++ *	Perform a calibration cycle on the HPT37x DPLL. Returns 1 if this
++ *	succeeds
++ */
++
++static int hpt37x_calibrate_dpll(struct pci_dev *dev)
++{
++	u8 reg5b;
++	u32 reg5c;
++	int tries;
++ 
++	for(tries = 0; tries < 0x5000; tries++) {
++		udelay(50);
++		pci_read_config_byte(dev, 0x5b, &reg5b);
++		if (reg5b & 0x80) {
++			/* See if it stays set */
++			for(tries = 0; tries < 0x1000; tries ++) {
++				pci_read_config_byte(dev, 0x5b, &reg5b);
++				/* Failed ? */
++				if ((reg5b & 0x80) == 0)
++					return 0;
++			}
++			/* Turn off tuning, we have the DPLL set */
++			pci_read_config_dword(dev, 0x5c, &reg5c);
++			pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
++			return 1;
++		}
++	}
++	/* Never went stable */
++	return 0;
++}
++/**
++ *	hpt37x_init_one		-	Initialise an HPT37X/302
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Initialise an HPT37x device. There are some interesting complications
++ *	here. Firstly the chip may report 366 and be one of several variants.
++ *	Secondly all the timings depend on the clock for the chip which we must
++ *	detect and look up
++ *
++ *	This is the known chip mappings. It may be missing a couple of later
++ *	releases.
++ *
++ *	Chip version		PCI		Rev	Notes
++ *	HPT366			4 (HPT366)	0	Other driver
++ *	HPT366			4 (HPT366)	1	Other driver
++ *	HPT368			4 (HPT366)	2	Other driver
++ *	HPT370			4 (HPT366)	3	UDMA100
++ *	HPT370A			4 (HPT366)	4	UDMA100
++ *	HPT372			4 (HPT366)	5	UDMA133 (1)
++ *	HPT372N			4 (HPT366)	6	Other driver
++ *	HPT372A			5 (HPT372)	1	UDMA133 (1)
++ *	HPT372N			5 (HPT372)	2	Other driver
++ *	HPT302			6 (HPT302)	1	UDMA133
++ *	HPT302N			6 (HPT302)	2	Other driver
++ *	HPT371			7 (HPT371)	*	UDMA133
++ *	HPT374			8 (HPT374)	*	UDMA133 4 channel
++ *	HPT372N			9 (HPT372N)	*	Other driver
++ *
++ *	(1) UDMA133 support depends on the bus clock
++ */
++ 
++static int hpt37x_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	/* HPT370 - UDMA100 */
++	static struct ata_port_info info_hpt370 = {
++		.sht = &hpt37x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &hpt370_port_ops
++	};
++	/* HPT370A - UDMA100 */
++	static struct ata_port_info info_hpt370a = {
++		.sht = &hpt37x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &hpt370a_port_ops
++	};
++	/* HPT371, 372 and friends - UDMA133 */
++	static struct ata_port_info info_hpt372 = {
++		.sht = &hpt37x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &hpt372_port_ops
++	};
++	/* HPT371, 372 and friends - UDMA100 at 50MHz clock */
++	static struct ata_port_info info_hpt372_50 = {
++		.sht = &hpt37x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &hpt372_port_ops
++	};
++	/* HPT374 - UDMA133 */
++	static struct ata_port_info info_hpt374 = {
++		.sht = &hpt37x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &hpt374_port_ops
++	};
++
++	struct ata_port_info *port_info[2];
++	struct ata_port_info *port;
++
++	u8 irqmask;
++	u32 class_rev;
++	u32 freq;
++
++	int MHz[4] = { 33, 40, 50, 66 };
++	struct hpt_chip *chip_table;
++	int clock_slot;
++
++	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
++	class_rev &= 0xFF;
++	
++	if (dev->device == PCI_DEVICE_ID_TTI_HPT366) {
++		/* May be a later chip in disguise. Check */
++		/* Older chips are in the HPT366 driver. Ignore them */
++		if (class_rev < 3)
++			return -ENODEV;
++		/* N series chips have their own driver. Ignore */
++		if (class_rev == 6)
++			return -ENODEV;
++
++		switch(class_rev) {			
++			case 3:
++				port = &info_hpt370;
++				chip_table = &hpt370;
++				break;
++			case 4:
++				port = &info_hpt370a;
++				chip_table = &hpt370a;
++				break;
++			case 5:
++				port = &info_hpt372;
++				chip_table = &hpt372;
++				break;
++			default:
++				printk(KERN_ERR "pata_hpt37x: Unknown HPT366 subtype please report (%d).\n", class_rev);
++				return -ENODEV;
++		}
++	} else {
++		switch(dev->device) {
++			case PCI_DEVICE_ID_TTI_HPT372:
++				/* 372N if rev >= 2*/
++				if (class_rev >= 2)
++					return -ENODEV;
++				port = &info_hpt372;
++				chip_table = &hpt372a;
++				break;
++			case PCI_DEVICE_ID_TTI_HPT302:
++				/* 302N if rev > 1 */
++				if (class_rev > 1)
++					return -ENODEV;
++				port = &info_hpt372;
++				/* Check this */
++				chip_table = &hpt302;
++				break;
++			case PCI_DEVICE_ID_TTI_HPT371:
++				port = &info_hpt372;
++				chip_table = &hpt371;
++				break;
++			case PCI_DEVICE_ID_TTI_HPT374:
++				chip_table = &hpt374;
++				port = &info_hpt374;
++				break;
++			default:
++				printk(KERN_ERR "pata_hpt37x: PCI table is bogus please report (%d).\n", dev->device);
++				return -ENODEV;
++		}
++	}
++	/* Ok so this is a chip we support */
++
++	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
++	pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
++	pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
++	pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
++
++	pci_read_config_byte(dev, 0x5A, &irqmask);
++	irqmask &= ~0x10;
++	pci_write_config_byte(dev, 0x5a, irqmask);
++
++	/*
++	 * default to pci clock. make sure MA15/16 are set to output
++	 * to prevent drives having problems with 40-pin cables. Needed
++	 * for some drives such as IBM-DTLA which will not enter ready
++	 * state on reset when PDIAG is a input.
++	 */
++
++	pci_write_config_byte(dev, 0x5b, 0x23);	
++	
++	pci_read_config_dword(dev, 0x70, &freq);
++	if ((freq >> 12) != 0xABCDE) {
++		int i;
++		u8 sr;
++		u32 total = 0;
++		
++		printk(KERN_WARNING "pata_hpt37x: BIOS has not set timing clocks.\n");
++		
++		/* This is the process the HPT371 BIOS is reported to use */
++		for(i = 0; i < 128; i++) {
++			pci_read_config_byte(dev, 0x78, &sr);
++			total += sr;
++			udelay(15);
++		}
++		freq = total / 128;
++	}
++	freq &= 0x1FF;
++	
++	/*
++	 *	Turn the frequency check into a band and then find a timing
++	 *	table to match it.
++	 */
++	 
++	clock_slot = hpt37x_clock_slot(freq, chip_table->base);
++	if (chip_table->clocks[clock_slot] == NULL) {
++		/*
++		 *	We need to try PLL mode instead
++		 */
++		unsigned int f_low = (MHz[clock_slot] * chip_table->base) / 192;
++		unsigned int f_high = f_low + 2;
++		int adjust;
++		
++		for(adjust = 0; adjust < 8; adjust++) {
++			if (hpt37x_calibrate_dpll(dev))
++				break;
++			/* See if it'll settle at a fractionally different clock */
++			if ((adjust & 3) == 3) {
++				f_low --;
++				f_high ++;
++			}
++			pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low);
++		}
++		if (adjust == 8) {
++			printk(KERN_WARNING "hpt37x: DPLL did not stabilize.\n");
++			return -ENODEV;
++		}
++		/* Check if this works for all cases */
++		port->private_data = hpt370_timings_66;
++		
++		printk(KERN_INFO "hpt37x: Bus clock %dMHz, using DPLL.\n", MHz[clock_slot]);
++	} else {
++		port->private_data = chip_table->clocks[clock_slot];
++		/*
++		 *	Perform a final fixup. The 371 and 372 clock determines
++		 *	if UDMA133 is available.
++		 */
++	 
++		if (clock_slot == 2 && chip_table == &hpt372) {	/* 50Mhz */
++			printk(KERN_WARNING "pata_hpt37x: No UDMA133 support available with 50MHz bus clock.\n");
++			if (port == &info_hpt372)
++				port = &info_hpt372_50;
++			else BUG();
++		}
++		printk(KERN_INFO "hpt37x: %s: Bus clock %dMHz.\n", chip_table->name, MHz[clock_slot]);
++	}
++	port_info[0] = port_info[1] = port;	
++	/* Now kick off ATA set up */
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id hpt37x[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT366), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT371), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT372), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT374), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT302), },
++	{ 0, },
++};
++
++static struct pci_driver hpt37x_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= hpt37x,
++	.probe 		= hpt37x_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init hpt37x_init(void)
++{
++	return pci_register_driver(&hpt37x_pci_driver);
++}
++
++
++static void __exit hpt37x_exit(void)
++{
++	pci_unregister_driver(&hpt37x_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the Highpoint HPT37x/30x");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, hpt37x);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(hpt37x_init);
++module_exit(hpt37x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt3x2n.c linux-2.6.16-rc4/drivers/scsi/pata_hpt3x2n.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_hpt3x2n.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_hpt3x2n.c	2006-02-16 15:36:58.000000000 +0000
+@@ -0,0 +1,580 @@
++/*
++ * Libata driver for the highpoint 372N and 302N UDMA66 ATA controllers.
++ *
++ * This driver is heavily based upon:
++ *
++ * linux/drivers/ide/pci/hpt366.c		Version 0.36	April 25, 2003
++ *
++ * Copyright (C) 1999-2003		Andre Hedrick <andre@linux-ide.org>
++ * Portions Copyright (C) 2001	        Sun Microsystems, Inc.
++ * Portions Copyright (C) 2003		Red Hat Inc
++ *
++ *
++ * TODO
++ *	371N
++ *	Work out best PLL policy
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"hpt3x2n"
++#define DRV_VERSION	"0.1"
++
++enum {
++	HPT_PCI_FAST	=	(1 << 31),
++	PCI66		=	(1 << 1),
++	USE_DPLL	=	(1 << 0)
++};
++
++struct hpt_clock {
++	u8	xfer_speed;
++	u32	timing;
++};
++
++struct hpt_chip {
++	const char *name;
++	struct hpt_clock *clocks[3];
++};
++
++/* key for bus clock timings
++ * bit
++ * 0:3    data_high_time. inactive time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 4:8    data_low_time. active time of DIOW_/DIOR_ for PIO and MW
++ *        DMA. cycles = value + 1
++ * 9:12   cmd_high_time. inactive time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 13:17  cmd_low_time. active time of DIOW_/DIOR_ during task file
++ *        register access.
++ * 18:21  udma_cycle_time. clock freq and clock cycles for UDMA xfer.
++ *        during task file register access.
++ * 22:24  pre_high_time. time to initialize 1st cycle for PIO and MW DMA
++ *        xfer.
++ * 25:27  cmd_pre_high_time. time to initialize 1st PIO cycle for task
++ *        register access.
++ * 28     UDMA enable
++ * 29     DMA enable
++ * 30     PIO_MST enable. if set, the chip is in bus master mode during
++ *        PIO.
++ * 31     FIFO enable.
++ */
++ 
++/* 66MHz DPLL clocks */
++
++static struct hpt_clock hpt3x2n_clocks[] = {
++	{	XFER_UDMA_7,	0x1c869c62	},
++	{	XFER_UDMA_6,	0x1c869c62	},
++	{	XFER_UDMA_5,	0x1c8a9c62	},
++	{	XFER_UDMA_4,	0x1c8a9c62	},
++	{	XFER_UDMA_3,	0x1c8e9c62	},
++	{	XFER_UDMA_2,	0x1c929c62	},
++	{	XFER_UDMA_1,	0x1c9a9c62	},
++	{	XFER_UDMA_0,	0x1c829c62	},
++
++	{	XFER_MW_DMA_2,	0x2c829c62	},
++	{	XFER_MW_DMA_1,	0x2c829c66	},
++	{	XFER_MW_DMA_0,	0x2c829d2c	},
++
++	{	XFER_PIO_4,	0x0c829c62	},
++	{	XFER_PIO_3,	0x0c829c84	},
++	{	XFER_PIO_2,	0x0c829ca6	},
++	{	XFER_PIO_1,	0x0d029d26	},
++	{	XFER_PIO_0,	0x0d029d5e	},
++	{	0,		0x0d029d5e	}
++};
++
++/**
++ *	hpt3x2n_find_mode	-	reset the hpt3x2n bus
++ *	@ap: ATA port
++ *	@speed: transfer mode
++ *
++ *	Return the 32bit register programming information for this channel
++ *	that matches the speed provided. For the moment the clocks table
++ *	is hard coded but easy to change. This will be needed if we use
++ *	different DPLLs
++ */
++ 
++static u32 hpt3x2n_find_mode(struct ata_port *ap, int speed)
++{
++	struct hpt_clock *clocks = hpt3x2n_clocks;
++	
++	while(clocks->xfer_speed) {
++		if (clocks->xfer_speed == speed)
++			return clocks->timing;
++		clocks++;
++	}
++	BUG();
++}
++	
++/**
++ *	hpt3x2n_phy_reset	-	reset the hpt3x2n bus
++ *	@ap: ATA port to reset
++ *
++ *	Perform the PHY reset handling for the 3x2N
++ */
++ 
++static void hpt3x2n_phy_reset(struct ata_port *ap)
++{
++	u8 scr2, ata66;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	pci_read_config_byte(pdev, 0x5B, &scr2);
++	pci_write_config_byte(pdev, 0x5B, scr2 & ~0x01);
++	/* Cable register now active */
++	pci_read_config_byte(pdev, 0x5A, &ata66);
++	/* Restore state */
++	pci_write_config_byte(pdev, 0x5B, scr2);
++	
++	if (ata66 & (1 << ap->hard_port_no))
++		ap->cbl = ATA_CBL_PATA40;
++	else
++		ap->cbl = ATA_CBL_PATA80;
++
++	/* Reset the state machine */
++	pci_write_config_byte(pdev, 0x50, 0x37); 
++	pci_write_config_byte(pdev, 0x54, 0x37); 
++	udelay(100);
++
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++/**
++ *	hpt3x2n_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Perform PIO mode setup. 
++ */
++ 
++static void hpt3x2n_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x07;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt3x2n_find_mode(ap, adev->pio_mode);
++	mode &= ~0x8000000;	/* No FIFO in PIO */
++	mode &= ~0x30070000;	/* Leave config bits alone */
++	reg &= 0x30070000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt3x2n_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	Set up the channel for MWDMA or UDMA modes. Much the same as with
++ *	PIO, load the mode number and then set MWDMA or UDMA flag.
++ */
++ 
++static void hpt3x2n_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 addr1, addr2;
++	u32 reg;
++	u32 mode;
++	u8 fast;
++
++	addr1 = 0x40 + 4 * (adev->devno + 2 * ap->hard_port_no);
++	addr2 = 0x51 + 4 * ap->hard_port_no;
++	
++	/* Fast interrupt prediction disable, hold off interrupt disable */
++	pci_read_config_byte(pdev, addr2, &fast);
++	fast &= ~0x07;
++	pci_write_config_byte(pdev, addr2, fast);
++	
++	pci_read_config_dword(pdev, addr1, &reg);
++	mode = hpt3x2n_find_mode(ap, adev->dma_mode);
++	mode |= 0x8000000;	/* FIFO in MWDMA or UDMA */
++	mode &= ~0xC0000000;	/* Leave config bits alone */
++	reg &= 0xC0000000;	/* Strip timing bits */
++	pci_write_config_dword(pdev, addr1, reg | mode);
++}
++
++/**
++ *	hpt3x2n_bmdma_end		-	DMA engine stop
++ *	@qc: ATA command
++ *
++ *	Clean up after the HPT3x2n and later DMA engine
++ */
++ 
++static void hpt3x2n_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int mscreg = 0x50 + 2 * ap->hard_port_no;
++	u8 bwsr_stat, msc_stat;
++	
++	pci_read_config_byte(pdev, 0x6A, &bwsr_stat);
++	pci_read_config_byte(pdev, mscreg, &msc_stat);
++	if (bwsr_stat & (1 << ap->hard_port_no))
++		pci_write_config_byte(pdev, mscreg, msc_stat | 0x30);
++	ata_bmdma_stop(qc);
++}
++
++/**
++ *	hpt3x2n_set_clock	-	clock control
++ *	@ap: ATA port
++ *	@source: 0x21 or 0x23 for PLL or PCI sourced clock
++ *
++ *	Switch the ATA bus clock between the PLL and PCI clock sources
++ *	while correctly isolating the bus and resetting internal logic
++ *
++ *	We must use the DPLL for
++ *	-	writing
++ *	-	second channel UDMA7 (SATA ports) or higher
++ *	-	66MHz PCI
++ *	
++ *	or we will underclock the device and get reduced performance.
++ */
++ 
++static void hpt3x2n_set_clock(struct ata_port *ap, int source)
++{
++	unsigned long bmdma = ap->ioaddr.bmdma_addr;
++	
++	/* Tristate the bus */
++	outb(0x80, bmdma+0x73);
++	outb(0x80, bmdma+0x77);
++	
++	/* Switch clock and reset channels */
++	outb(source, bmdma+0x7B);
++	outb(0xC0, bmdma+0x79);
++	
++	/* Reset state machines */
++	outb(0x37, bmdma+0x70);
++	outb(0x37, bmdma+0x74);
++	
++	/* Complete reset */
++	outb(0x00, bmdma+0x79);
++	
++	/* Reconnect channels to bus */
++	outb(0x00, bmdma+0x73);
++	outb(0x00, bmdma+0x77);
++}
++
++/* Check if our partner interface is busy */
++
++static int hpt3x2n_pair_idle(struct ata_port *ap)
++{
++	struct ata_host_set *host = ap->host_set;
++	struct ata_port *pair = host->ports[ap->hard_port_no ^ 1];
++	
++	if (pair->hsm_task_state == HSM_ST_IDLE)
++		return 1;
++	return 0;
++}
++
++static int hpt3x2n_use_dpll(struct ata_port *ap, int reading)
++{
++	long flags = (long)ap->host_set->private_data;
++	/* See if we should use the DPLL */
++	if (reading == 0)
++		return USE_DPLL;	/* Needed for write */
++	if (flags & PCI66)
++		return USE_DPLL;	/* Needed at 66Mhz */
++	return 0;	
++}
++
++static int hpt3x2n_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_taskfile *tf = &qc->tf;
++	struct ata_port *ap = qc->ap;
++	int flags = (long)ap->host_set->private_data;
++	
++	if (hpt3x2n_pair_idle(ap)) {
++		int dpll = hpt3x2n_use_dpll(ap, (tf->flags & ATA_TFLAG_WRITE));
++		if ((flags & USE_DPLL) != dpll) {
++			if (dpll == 1)
++				hpt3x2n_set_clock(ap, 0x21);
++			else
++				hpt3x2n_set_clock(ap, 0x23);
++		}
++	}
++	return ata_qc_issue_prot(qc);
++}
++
++static struct scsi_host_template hpt3x2n_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++/*
++ *	Configuration for HPT3x2n.
++ */
++ 
++static struct ata_port_operations hpt3x2n_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= hpt3x2n_set_piomode,
++	.set_dmamode	= hpt3x2n_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= hpt3x2n_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= hpt3x2n_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= hpt3x2n_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	hpt3xn_calibrate_dpll		-	Calibrate the DPLL loop
++ *	@dev: PCI device 
++ *
++ *	Perform a calibration cycle on the HPT3xN DPLL. Returns 1 if this
++ *	succeeds
++ */
++
++static int hpt3xn_calibrate_dpll(struct pci_dev *dev)
++{
++	u8 reg5b;
++	u32 reg5c;
++	int tries;
++ 
++	for(tries = 0; tries < 0x5000; tries++) {
++		udelay(50);
++		pci_read_config_byte(dev, 0x5b, &reg5b);
++		if (reg5b & 0x80) {
++			/* See if it stays set */
++			for(tries = 0; tries < 0x1000; tries ++) {
++				pci_read_config_byte(dev, 0x5b, &reg5b);
++				/* Failed ? */
++				if ((reg5b & 0x80) == 0)
++					return 0;
++			}
++			/* Turn off tuning, we have the DPLL set */
++			pci_read_config_dword(dev, 0x5c, &reg5c);
++			pci_write_config_dword(dev, 0x5c, reg5c & ~ 0x100);
++			return 1;
++		}
++	}
++	/* Never went stable */
++	return 0;
++}
++
++static int hpt3x2n_pci_clock(struct pci_dev *pdev)
++{
++	unsigned long freq;
++	u32 fcnt;
++	
++	pci_read_config_dword(pdev, 0x70/*CHECKME*/, &fcnt);
++	if ((fcnt >> 12) != 0xABCDE) {
++		printk(KERN_WARNING "hpt3xn: BIOS clock data not set.\n");
++		return 33;	/* Not BIOS set */
++	}
++	fcnt &= 0x1FF;
++	
++	freq = (fcnt * 77) / 192;
++	
++	/* Clamp to bands */
++	if (freq < 40)
++		return 33;
++	if (freq < 45)
++		return 40;
++	if (freq < 55)
++		return 50;
++	return 66;
++}
++
++/**
++ *	hpt3x2n_init_one		-	Initialise an HPT37X/302
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Initialise an HPT3x2n device. There are some interesting complications
++ *	here. Firstly the chip may report 366 and be one of several variants.
++ *	Secondly all the timings depend on the clock for the chip which we must
++ *	detect and look up
++ *
++ *	This is the known chip mappings. It may be missing a couple of later
++ *	releases.
++ *
++ *	Chip version		PCI		Rev	Notes
++ *	HPT372			4 (HPT366)	5	Other driver
++ *	HPT372N			4 (HPT366)	6	UDMA133
++ *	HPT372			5 (HPT372)	1	Other driver
++ *	HPT372N			5 (HPT372)	2	UDMA133
++ *	HPT302			6 (HPT302)	*	Other driver
++ *	HPT302N			6 (HPT302)	> 1	UDMA133
++ *	HPT371			7 (HPT371)	*	Other driver
++ *	HPT371N			7 (HPT371)	> 1	UDMA133
++ *	HPT374			8 (HPT374)	*	Other driver
++ *	HPT372N			9 (HPT372N)	*	UDMA133
++ *
++ *	(1) UDMA133 support depends on the bus clock
++ *
++ *	To pin down		HPT371N
++ */
++ 
++static int hpt3x2n_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	/* HPT372N and friends - UDMA133 */
++	static struct ata_port_info info = {
++		.sht = &hpt3x2n_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &hpt3x2n_port_ops
++	};
++	struct ata_port_info *port_info[2];
++	struct ata_port_info *port = &info;
++
++	u8 irqmask;
++	u32 class_rev;
++	
++	unsigned int pci_mhz;
++	unsigned int f_low, f_high;
++	int adjust;
++	
++	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
++	class_rev &= 0xFF;
++	
++	switch(dev->device) {
++		case PCI_DEVICE_ID_TTI_HPT366:
++			if (class_rev < 6)
++				return -ENODEV;
++			break;
++		case PCI_DEVICE_ID_TTI_HPT372:
++			/* 372N if rev >= 1*/
++			if (class_rev == 0)
++				return -ENODEV;
++			break;
++		case PCI_DEVICE_ID_TTI_HPT302:
++			if (class_rev < 2)
++				return -ENODEV;
++			break;
++		case PCI_DEVICE_ID_TTI_HPT372N:
++			break;
++		default:
++			printk(KERN_ERR "pata_hpt3x2n: PCI table is bogus please report (%d).\n", dev->device);
++			return -ENODEV;
++	}
++
++	/* Ok so this is a chip we support */
++
++	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (L1_CACHE_BYTES / 4));
++	pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x78);
++	pci_write_config_byte(dev, PCI_MIN_GNT, 0x08);
++	pci_write_config_byte(dev, PCI_MAX_LAT, 0x08);
++
++	pci_read_config_byte(dev, 0x5A, &irqmask);
++	irqmask &= ~0x10;
++	pci_write_config_byte(dev, 0x5a, irqmask);
++
++	/* Tune the PLL. HPT recommend using 75 for SATA, 66 for UDMA133 or
++	   50 for UDMA100. Right now we always use 66 */
++	   
++	pci_mhz = hpt3x2n_pci_clock(dev);
++	
++	f_low = (pci_mhz * 48) / 66;	/* PCI Mhz for 66Mhz DPLL */
++	f_high = f_low + 2;		/* Tolerance */
++	
++	pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low | 0x100);
++	/* PLL clock */
++	pci_write_config_byte(dev, 0x5B, 0x21);
++	
++	/* Unlike the 37x we don't try jiggling the frequency */
++	for(adjust = 0; adjust < 8; adjust++) {
++		if (hpt3xn_calibrate_dpll(dev))
++			break;
++		pci_write_config_dword(dev, 0x5C, (f_high << 16) | f_low);
++	}
++	if (adjust == 8)
++		printk(KERN_WARNING "hpt3xn: DPLL did not stabilize.\n");
++
++	/* Set our private data up. We only need a few flags so we use
++	   it directly */
++	port->private_data = NULL;
++	if (pci_mhz > 60)
++		port->private_data = (void *)PCI66;
++		
++	/* Now kick off ATA set up */
++	port_info[0] = port_info[1] = port;
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id hpt3x2n[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT366), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT372), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT302), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_TTI, PCI_DEVICE_ID_TTI_HPT372N), },
++	{ 0, },
++};
++
++static struct pci_driver hpt3x2n_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= hpt3x2n,
++	.probe 		= hpt3x2n_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init hpt3x2n_init(void)
++{
++	return pci_register_driver(&hpt3x2n_pci_driver);
++}
++
++
++static void __exit hpt3x2n_exit(void)
++{
++	pci_unregister_driver(&hpt3x2n_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the Highpoint HPT3x2n/30x");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, hpt3x2n);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(hpt3x2n_init);
++module_exit(hpt3x2n_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_isapnp.c linux-2.6.16-rc4/drivers/scsi/pata_isapnp.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_isapnp.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_isapnp.c	2006-01-21 16:52:31.000000000 +0000
+@@ -0,0 +1,151 @@
++
++/*
++ *   pata-isapnp.c - ISA PnP PATA controller driver.
++ *   Copyright 2005/2006 Red Hat Inc <alan@redhat.com>, all rights reserved.
++ *
++ *   Based in part on ide-pnp.c by Andrey Panin <pazke@donpac.ru>
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/isapnp.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/ata.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_isapnp"
++#define DRV_VERSION "0.1"
++
++static struct scsi_host_template isapnp_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations isapnp_port_ops = {
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	isapnp_init_one		-	attach an isapnp interface
++ *	@idev: PnP device
++ *	@dev_id: matching detect line
++ *
++ *	Register an ISA bus IDE interface. Such interfaces are PIO 0 and
++ *	non shared IRQ. 
++ */
++ 
++static int isapnp_init_one(struct pnp_dev *idev, const struct pnp_device_id *dev_id)
++{
++	struct ata_probe_ent ae;
++
++	if (pnp_port_valid(idev, 0) == 0)
++		return -ENODEV;
++	if (pnp_port_valid(idev, 1) == 0)
++		return -ENODEV;
++		
++	/* FIXME: Should selected polled PIO here not fail */
++	if (pnp_irq_valid(idev, 0) == 0)
++		return -ENODEV;
++	
++	memset(&ae, 0, sizeof(struct ata_probe_ent));
++	INIT_LIST_HEAD(&ae.node);
++	ae.dev = &idev->dev;
++	ae.port_ops = &isapnp_port_ops;
++	ae.sht = &isapnp_sht;
++	ae.n_ports = 1;
++	ae.pio_mask = 1;		/* ISA so PIO 0 cycles */
++	ae.irq = pnp_irq(idev, 0);
++	ae.irq_flags = 0;
++	ae.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_IRQ_MASK;
++	ae.port[0].cmd_addr = pnp_port_start(idev, 0);
++	ae.port[0].altstatus_addr = pnp_port_start(idev, 1);
++	ae.port[0].ctl_addr = pnp_port_start(idev, 1);
++	ata_std_ports(&ae.port[0]);
++
++	if (ata_device_add(&ae) == 0)
++		return -ENODEV;
++	return 0;
++}
++
++/**
++ *	isapnp_remove_one	-	unplug an isapnp interface
++ *	@idev: PnP device
++ *
++ *	Remove a previously configured PnP ATA port. Called only on module
++ *	unload events as the core does not currently deal with ISAPnP docking.
++ */
++ 
++static void isapnp_remove_one(struct pnp_dev *idev)
++{
++	struct device *dev = &idev->dev;
++	struct ata_host_set *host_set = dev_get_drvdata(dev);
++	
++	ata_host_set_remove(host_set);
++	dev_set_drvdata(dev, NULL);
++}
++
++static struct pnp_device_id isapnp_devices[] = {
++  	/* Generic ESDI/IDE/ATA compatible hard disk controller */
++	{.id = "PNP0600", .driver_data = 0},
++	{.id = ""}
++};
++
++static struct pnp_driver isapnp_driver = {
++	.name		= DRV_NAME,
++	.id_table	= isapnp_devices,
++	.probe		= isapnp_init_one,
++	.remove		= isapnp_remove_one,
++};
++
++static int __init isapnp_init(void)
++{
++	return pnp_register_driver(&isapnp_driver);
++}
++
++static void __exit isapnp_exit(void)
++{
++	pnp_unregister_driver(&isapnp_driver);
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for ISA PnP ATA");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++module_init(isapnp_init);
++module_exit(isapnp_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_it8172.c linux-2.6.16-rc4/drivers/scsi/pata_it8172.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_it8172.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_it8172.c	2006-02-16 15:39:11.000000000 +0000
+@@ -0,0 +1,280 @@
++/*
++ * pata_it8172.c 	- IT8172 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based heavily on
++ *
++ * BRIEF MODULE DESCRIPTION
++ *      IT8172 IDE controller support
++ *
++ * Copyright 2000 MontaVista Software Inc.
++ * Author: MontaVista Software, Inc.
++ *              stevel@mvista.com or source@mvista.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  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
++ *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
++ *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
++ *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
++ *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
++ *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
++ *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
++ *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
++ *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
++ *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
++ *
++ *  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.
++ *
++ *	TODO
++ *	Check for errata
++ *	See if we really need to force native mode
++ *	PIO timings (also lacking in original)
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "it8172"
++#define DRV_VERSION "0.1.1"
++
++static void it8172_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits it8172_enable_bits[] = {
++		{ 0x00, 0, 0x00, 0x00 },
++		{ 0x40, 1, 0x00, 0x01 }
++	};
++
++	if (ap->hard_port_no && !pci_test_config_bits(pdev, &it8172_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	it8172_set_pio_timing	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called by both the pio and dma setup functions to set the controller
++ *	timings for PIO transfers. We must load both the mode number and 
++ *	timing values into the controller.
++ */
++ 
++static void it8172_set_pio_timing(struct ata_port *ap, struct ata_device *adev, int pio)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u16 reg40;
++	
++	pci_read_config_word(pdev, 0x40, &reg40);
++	
++	/*
++	 * FIX! The DIOR/DIOW pulse width and recovery times in port 0x44
++	 * are being left at the default values of 8 PCI clocks (242 nsec
++	 * for a 33 MHz clock). These can be safely shortened at higher
++	 * PIO modes. The DIOR/DIOW pulse width and recovery times only
++	 * apply to PIO modes, not to the DMA modes.
++	 */
++
++	/*
++	 * Enable port 0x44. The IT8172G spec is confused; it calls
++	 * this register the "Slave IDE Timing Register", but in fact,
++	 * it controls timing for both master and slave drives.
++	 */
++
++	reg40 |= 0x4000;
++	if (adev->devno) {
++		reg40 |= 0xC006;
++		if (pio > 1) 
++			/* Enable prefetch and IORDY sample-point */
++			reg40 |= 0x0060;
++	} else {
++		reg40 |= 0xC060;
++		if (pio > 1)
++			/* Enable prefetch and IORDY sample-point */
++			reg40 |= 0x0006;
++	}
++	/* Write back the enables */
++	pci_write_config_word(pdev, 0x40, reg40);
++}
++
++/**
++ *	it8172_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. We use a shared helper for this
++ *	as the DMA setup must also adjust the PIO timing information.
++ */
++ 
++static void it8172_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	it8172_set_pio_timing(ap, adev, adev->pio_mode - XFER_PIO_0);
++}
++
++/**
++ *	it8172_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the DMA mode setup. We must tune an appropriate PIO
++ *	mode to match.
++ */
++ 
++static void it8172_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int dn = (2 * ap->hard_port_no) + adev->devno;
++	u8 reg48, reg4a;
++	int pio;
++	
++	static int pio_map[] = { 1, 3, 4};
++	/*
++	 * Setting the DMA cycle time to 2 or 3 PCI clocks (60 and 91 nsec
++	 * at 33 MHz PCI clock) seems to cause BadCRC errors during DMA
++	 * transfers on some drives, even though both numbers meet the minimum
++	 * ATAPI-4 spec of 73 and 54 nsec for UDMA 1 and 2 respectively.
++	 * So the faster times are just commented out here. The good news is
++	 * that the slower cycle time has very little affect on transfer
++	 * performance.
++	 */
++
++	pci_read_config_byte(pdev, 0x48, &reg48);
++	pci_read_config_byte(pdev, 0x4A, &reg4a);
++
++ 	reg4a &= ~(3 << (4 * dn));
++ 	
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		reg48 |= 1 << dn;
++#ifdef UDMA_TIMING_SET
++		reg4a |= ((adev->dma_mode - XFER_UDMA_0) << (4 * dn));
++#endif		
++	 	pio = 4;
++	} else  {
++		pio = pio_map[adev->dma_mode - XFER_MW_DMA_0];
++		reg48 &= ~ (1 << dn);
++	}
++	pci_write_config_byte(pdev, 0x48, reg48);
++	pci_write_config_byte(pdev, 0x4A, reg4a);
++ 	it8172_set_pio_timing(ap, adev, pio);
++		
++}
++
++static struct scsi_host_template it8172_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations it8172_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= it8172_set_piomode,
++	.set_dmamode	= it8172_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= it8172_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++	
++static int it8172_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &it8172_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x06,	/* No MWDMA0 support */
++		.udma_mask = 0x7,
++		.port_ops = &it8172_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	
++        if ((!(PCI_FUNC(dev->devfn) & 1) ||
++            (!((dev->class >> 8) == PCI_CLASS_STORAGE_IDE))))
++		return -ENODEV; /* IT8172 is more than an IDE controller */
++
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id it8172[] = {
++	{ PCI_VENDOR_ID_ITE, PCI_DEVICE_ID_ITE_IT8172G, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0, },
++};
++
++static struct pci_driver it8172_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= it8172,
++	.probe 		= it8172_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init it8172_init(void)
++{
++	return pci_register_driver(&it8172_pci_driver);
++}
++
++
++static void __exit it8172_exit(void)
++{
++	pci_unregister_driver(&it8172_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for ITE IT8172");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, it8172);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(it8172_init);
++module_exit(it8172_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_it821x.c linux-2.6.16-rc4/drivers/scsi/pata_it821x.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_it821x.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_it821x.c	2006-02-20 12:27:55.000000000 +0000
+@@ -0,0 +1,743 @@
++/*
++ * ata-it821x.c 	- IT821x PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon
++ *
++ * it821x.c
++ * 
++ * linux/drivers/ide/pci/it821x.c		Version 0.09	December 2004
++ *
++ * Copyright (C) 2004		Red Hat <alan@redhat.com>
++ *
++ *  May be copied or modified under the terms of the GNU General Public License
++ *  Based in part on the ITE vendor provided SCSI driver.
++ *
++ *  Documentation available from
++ * 	http://www.ite.com.tw/pc/IT8212F_V04.pdf
++ *  Some other documents are NDA.
++ *
++ *  The ITE8212 isn't exactly a standard IDE controller. It has two
++ *  modes. In pass through mode then it is an IDE controller. In its smart
++ *  mode its actually quite a capable hardware raid controller disguised
++ *  as an IDE controller. Smart mode only understands DMA read/write and
++ *  identify, none of the fancier commands apply. The IT8211 is identical
++ *  in other respects but lacks the raid mode.
++ *
++ *  Errata:
++ *  o	Rev 0x10 also requires master/slave hold the same DMA timings and
++ *	cannot do ATAPI MWDMA.
++ *  o	The identify data for raid volumes lacks CHS info (technically ok)
++ *	but also fails to set the LBA28 and other bits. We fix these in
++ *	the IDE probe quirk code.
++ *  o	If you write LBA48 sized I/O's (ie > 256 sector) in smart mode
++ *	raid then the controller firmware dies
++ *  o	Smart mode without RAID doesn't clear all the necessary identify
++ *	bits to reduce the command set to the one used
++ *
++ *  This has a few impacts on the driver
++ *  - In pass through mode we do all the work you would expect
++ *  - In smart mode the clocking set up is done by the controller generally
++ *    but we must watch the other limits and filter.
++ *  - There are a few extra vendor commands that actually talk to the
++ *    controller but only work PIO with no IRQ.
++ *
++ *  Vendor areas of the identify block in smart mode are used for the
++ *  timing and policy set up. Each HDD in raid mode also has a serial
++ *  block on the disk. The hardware extra commands are get/set chip status,
++ *  rebuild, get rebuild status.
++ *
++ *  In Linux the driver supports pass through mode as if the device was
++ *  just another IDE controller. If the smart mode is running then
++ *  volumes are managed by the controller firmware and each IDE "disk"
++ *  is a raid volume. Even more cute - the controller can do automated
++ *  hotplug and rebuild.
++ *
++ *  The pass through controller itself is a little demented. It has a
++ *  flaw that it has a single set of PIO/MWDMA timings per channel so
++ *  non UDMA devices restrict each others performance. It also has a
++ *  single clock source per channel so mixed UDMA100/133 performance
++ *  isn't perfect and we have to pick a clock. Thankfully none of this
++ *  matters in smart mode. ATAPI DMA is not currently supported.
++ *
++ *  It seems the smart mode is a win for RAID1/RAID10 but otherwise not.
++ *
++ *  TODO
++ *	-	ATAPI and other speed filtering
++ *	-	Command filter in smart mode
++ *	-	RAID configuration ioctls
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++
++#define DRV_NAME "it821x"
++#define DRV_VERSION "0.2.1"
++
++struct it821x_dev
++{
++	unsigned int smart:1,		/* Are we in smart raid mode */
++		timing10:1;		/* Rev 0x10 */
++	u8	clock_mode;		/* 0, ATA_50 or ATA_66 */
++	u8	want[2][2];		/* Mode/Pri log for master slave */
++	/* We need these for switching the clock when DMA goes on/off
++	   The high byte is the 66Mhz timing */
++	u16	pio[2];			/* Cached PIO values */
++	u16	mwdma[2];		/* Cached MWDMA values */
++	u16	udma[2];		/* Cached UDMA values (per drive) */
++	u16	last_device;		/* Master or slave loaded ? */
++};
++
++#define ATA_66		0
++#define ATA_50		1
++#define ATA_ANY		2
++
++#define UDMA_OFF	0
++#define MWDMA_OFF	0
++
++/*
++ *	We allow users to force the card into non raid mode without
++ *	flashing the alternative BIOS. This is also neccessary right now
++ *	for embedded platforms that cannot run a PC BIOS but are using this
++ *	device.
++ */
++
++static int it8212_noraid;
++
++
++/**
++ *	it821x_phy_reset	-	probe/reset
++ *	@ap: ATA port
++ *
++ *	Set the cable type and trigger a probe
++ */
++ 
++static void it821x_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA80;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	it821x_program	-	program the PIO/MWDMA registers
++ *	@ap: ATA port
++ *	@adev: Device to program
++ *	@timing: Timing value (66Mhz in top 8bits, 50 in the low 8)
++ *
++ *	Program the PIO/MWDMA timing for this channel according to the
++ *	current clock. These share the same register so are managed by
++ *	the DMA start/stop sequence as with the old driver.
++ */
++
++static void it821x_program(struct ata_port *ap, struct ata_device *adev, u16 timing)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct it821x_dev *itdev = ap->private_data;
++	int channel = ap->hard_port_no;
++	u8 conf;
++
++	/* Program PIO/MWDMA timing bits */
++	if (itdev->clock_mode == ATA_66)
++		conf = timing >> 8;
++	else
++		conf = timing & 0xFF;
++	pci_write_config_byte(pdev, 0x54 + 4 * channel, conf);
++}
++
++
++/**
++ *	it821x_program_udma	-	program the UDMA registers
++ *	@ap: ATA port
++ *	@adev: ATA device to update
++ *	@timing: Timing bits. Top 8 are for 66Mhz bottom for 50Mhz
++ *
++ *	Program the UDMA timing for this drive according to the
++ *	current clock. Handles the dual clocks and also knows about
++ *	the errata on the 0x10 revision. The UDMA errata is partly handled
++ *	here and partly in start_dma.
++ */
++
++static void it821x_program_udma(struct ata_port *ap, struct ata_device *adev, u16 timing)
++{
++	struct it821x_dev *itdev = ap->private_data;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int channel = ap->hard_port_no;
++	int unit = adev->devno;
++	u8 conf;
++
++	/* Program UDMA timing bits */
++	if (itdev->clock_mode == ATA_66)
++		conf = timing >> 8;
++	else
++		conf = timing & 0xFF;
++	if (itdev->timing10 == 0)
++		pci_write_config_byte(pdev, 0x56 + 4 * channel + unit, conf);
++	else {
++		/* Early revision must be programmed for both together */
++		pci_write_config_byte(pdev, 0x56 + 4 * channel, conf);
++		pci_write_config_byte(pdev, 0x56 + 4 * channel + 1, conf);
++	}
++}
++
++/**
++ *	it821x_clock_strategy
++ *	@ap: ATA interface
++ *	@adev: ATA device being updated
++ *
++ *	Select between the 50 and 66Mhz base clocks to get the best
++ *	results for this interface.
++ */
++
++static void it821x_clock_strategy(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct it821x_dev *itdev = ap->private_data;
++	u8 unit = adev->devno;
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++
++	int clock, altclock;
++	u8 v;
++	int sel = 0;
++
++	/* Look for the most wanted clocking */
++	if (itdev->want[0][0] > itdev->want[1][0]) {
++		clock = itdev->want[0][1];
++		altclock = itdev->want[1][1];
++	} else {
++		clock = itdev->want[1][1];
++		altclock = itdev->want[0][1];
++	}
++
++	/* Master doesn't care does the slave ? */
++	if (clock == ATA_ANY)
++		clock = altclock;
++
++	/* Nobody cares - keep the same clock */
++	if (clock == ATA_ANY)
++		return;
++	/* No change */
++	if (clock == itdev->clock_mode)
++		return;
++
++	/* Load this into the controller ? */
++	if (clock == ATA_66)
++		itdev->clock_mode = ATA_66;
++	else {
++		itdev->clock_mode = ATA_50;
++		sel = 1;
++	}
++	pci_read_config_byte(pdev, 0x50, &v);
++	v &= ~(1 << (1 + ap->hard_port_no));
++	v |= sel << (1 + ap->hard_port_no);
++	pci_write_config_byte(pdev, 0x50, v);
++
++	/*
++	 *	Reprogram the UDMA/PIO of the pair drive for the switch
++	 *	MWDMA will be dealt with by the dma switcher
++	 */
++	if (pair && itdev->udma[1-unit] != UDMA_OFF) {
++		it821x_program_udma(ap, pair, itdev->udma[1-unit]);
++		it821x_program(ap, pair, itdev->pio[1-unit]);
++	}
++	/*
++	 *	Reprogram the UDMA/PIO of our drive for the switch.
++	 *	MWDMA will be dealt with by the dma switcher
++	 */
++	if (itdev->udma[unit] != UDMA_OFF) {
++		it821x_program_udma(ap, adev, itdev->udma[unit]);
++		it821x_program(ap, adev, itdev->pio[unit]);
++	}
++}
++
++/**
++ *	it821x_passthru_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Configure for PIO mode. This is complicated as the register is
++ *	shared by PIO and MWDMA and for both channels.
++ */
++
++static void it821x_passthru_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	/* Spec says 89 ref driver uses 88 */
++	static u16 pio[]	= { 0xAA88, 0xA382, 0xA181, 0x3332, 0x3121 };
++	static u8 pio_want[]    = { ATA_66, ATA_66, ATA_66, ATA_66, ATA_ANY };
++
++	struct it821x_dev *itdev = ap->private_data;
++	int unit = adev->devno;
++	int mode_wanted = adev->pio_mode - XFER_PIO_0;
++	
++	/* We prefer 66Mhz clock for PIO 0-3, don't care for PIO4 */
++	itdev->want[unit][1] = pio_want[mode_wanted];
++	itdev->want[unit][0] = 1;	/* PIO is lowest priority */
++	itdev->pio[unit] = pio[mode_wanted];
++	it821x_clock_strategy(ap, adev);
++	it821x_program(ap, adev, itdev->pio[unit]);
++}
++
++/**
++ *	it821x_passthru_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Set up the DMA modes. The actions taken depend heavily on the mode
++ *	to use. If UDMA is used as is hopefully the usual case then the 
++ *	timing register is private and we need only consider the clock. If
++ *	we are using MWDMA then we have to manage the setting ourself as
++ *	we switch devices and mode.
++ */
++
++static void it821x_passthru_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u16 dma[]	= { 0x8866, 0x3222, 0x3121 };
++	static u8 mwdma_want[]	= { ATA_ANY, ATA_66, ATA_ANY };
++	static u16 udma[]	= { 0x4433, 0x4231, 0x3121, 0x2121, 0x1111, 0x2211, 0x1111 };
++	static u8 udma_want[]	= { ATA_ANY, ATA_50, ATA_ANY, ATA_66, ATA_66, ATA_50, ATA_66 };
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct it821x_dev *itdev = ap->private_data;
++	int channel = ap->hard_port_no;
++	int unit = adev->devno;
++	u8 conf;
++
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		int mode_wanted = adev->dma_mode - XFER_UDMA_0;
++		
++		itdev->want[unit][1] = udma_want[mode_wanted];
++		itdev->want[unit][0] = 3;	/* UDMA is high priority */
++		itdev->mwdma[unit] = MWDMA_OFF;
++		itdev->udma[unit] = udma[mode_wanted];
++		if (mode_wanted >= 5)
++			itdev->udma[unit] |= 0x8080;	/* UDMA 5/6 select on */
++
++		/* UDMA on. Again revision 0x10 must do the pair */
++		pci_read_config_byte(pdev, 0x50, &conf);
++		if (itdev->timing10)
++			conf &= channel ? 0x9F: 0xE7;
++		else
++			conf &= ~ (1 << (3 + 2 * channel + unit));
++		pci_write_config_byte(pdev, 0x50, conf);
++		it821x_clock_strategy(ap, adev);
++		it821x_program_udma(ap, adev, itdev->udma[unit]);
++	} else {
++		int mode_wanted = adev->dma_mode - XFER_UDMA_0;
++		
++		itdev->want[unit][1] = mwdma_want[mode_wanted];
++		itdev->want[unit][0] = 2;	/* MWDMA is low priority */
++		itdev->mwdma[unit] = dma[mode_wanted];
++		itdev->udma[unit] = UDMA_OFF;
++
++		/* UDMA bits off - Revision 0x10 do them in pairs */
++		pci_read_config_byte(pdev, 0x50, &conf);
++		if (itdev->timing10)
++			conf |= channel ? 0x60: 0x18;
++		else
++			conf |= 1 << (3 + 2 * channel + unit);
++		pci_write_config_byte(pdev, 0x50, conf);
++		it821x_clock_strategy(ap, adev);
++	}
++}
++
++/**
++ *	it821x_passthru_dma_start	-	DMA start callback
++ *	@qc: Command in progress
++ *
++ *	Usually drivers set the DMA timing at the point the set_dmamode call
++ *	is made. IT821x however requires we load new timings on the 
++ *	transitions in some cases.
++ */
++
++static void it821x_passthru_bmdma_start(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	struct it821x_dev *itdev = ap->private_data;
++	int unit = adev->devno;
++
++	if (itdev->mwdma[unit] != MWDMA_OFF)
++		it821x_program(ap, adev, itdev->mwdma[unit]);
++	else if (itdev->udma[unit] != UDMA_OFF && itdev->timing10)
++		it821x_program_udma(ap, adev, itdev->udma[unit]);
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	it821x_passthru_dma_stop	-	DMA stop callback
++ *	@qc: ATA command
++ *
++ *	We loaded new timings in dma_start, as a result we need to restore
++ *	the PIO timings in dma_stop so that the next command issue gets the
++ *	right clock values.
++ */
++
++static void it821x_passthru_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	struct it821x_dev *itdev = ap->private_data;
++	int unit = adev->devno;
++
++	ata_bmdma_stop(qc);
++	if (itdev->mwdma[unit] != MWDMA_OFF)
++		it821x_program(ap, adev, itdev->pio[unit]);
++}
++
++
++/**
++ *	it821x_passthru_dev_select	-	Select master/slave
++ *	@ap: ATA port
++ *	@device: Device number (not pointer)
++ *
++ *	Device selection hook. If neccessary perform clock switching
++ */
++ 
++void it821x_passthru_dev_select(struct ata_port *ap, unsigned int device)
++{
++	struct it821x_dev *itdev = ap->private_data;
++	if (itdev && device != itdev->last_device) {
++		struct ata_device *adev = &ap->device[device];
++		it821x_program(ap, adev, itdev->pio[adev->devno]);
++		itdev->last_device = device;
++	}
++}
++
++/**
++ *	it821x_passthru_qc_issue_prot	-	wrap qc issue prot
++ *	@qc: command
++ *
++ *	Wrap the command issue sequence for the IT821x. We need to
++ *	perform out own device selection timing loads before the
++ *	usual happenings kick off
++ */
++ 
++static int it821x_passthru_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	it821x_passthru_dev_select(qc->ap, qc->dev->devno);
++	return ata_qc_issue_prot(qc);
++}
++
++/**
++ *	it821x_smart_set_mode	-	mode setting
++ *	@ap: interface to set up
++ *
++ *	Use a non standard set_mode function. We don't want to be tuned.
++ *	The BIOS configured everything. Our job is not to fiddle. We
++ *	read the dma enabled bits from the PCI configuration of the device
++ *	and respect them. 
++ */
++ 
++static void it821x_smart_set_mode(struct ata_port *ap)
++{
++	int dma_enabled;
++	int i;
++
++	/* Bits 5 and 6 indicate if DMA is active on master/slave */
++	dma_enabled = inb(ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
++	
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *dev = &ap->device[i];
++		if (ata_dev_present(dev)) {
++			/* We don't really care */
++			dev->pio_mode = XFER_PIO_0;
++			dev->dma_mode = XFER_MW_DMA_0;
++			/* We do need the right mode information for DMA or PIO 
++			   and this comes from the current configuration flags */
++			if (dma_enabled & (1 << (5 + i))) {
++				dev->xfer_mode = XFER_MW_DMA_0;
++				dev->xfer_shift = ATA_SHIFT_MWDMA;
++				dev->flags &= ~ATA_DFLAG_PIO;
++			} else {
++				dev->xfer_mode = XFER_PIO_0;
++				dev->xfer_shift = ATA_SHIFT_PIO;
++				dev->flags |= ATA_DFLAG_PIO;
++			}
++			/* Keep sector count safe (LBA48 counts blow the
++			   brains of the firmware) */
++			   
++			/* Do we need a dev_config method ? */
++			dev->flags |= ATA_DFLAG_LOCK_SECTORS;
++		}
++	}
++}
++
++/**
++ *	it821x_check_atapi_dma	-	ATAPI DMA handler
++ *	@qc: Command we are about to issue
++ *
++ *	Decide if this ATAPI command can be issued by DMA on this
++ *	controller. Return 0 if it can be.
++ */
++ 
++static int it821x_check_atapi_dma(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct it821x_dev *itdev = ap->private_data;
++	
++	/* No ATAPI DMA in smart mode */
++	if (itdev->smart)
++		return -EOPNOTSUPP;
++	/* No ATAPI DMA on rev 10 */
++	if (itdev->timing10)
++		return -EOPNOTSUPP;
++	/* Cool */
++	return 0;
++}
++		
++
++/**
++ *	it821x_port_start	-	port setup
++ *	@ap: ATA port being set up
++ *
++ *	The it821x needs to maintain private data structures and also to
++ *	use the standard PCI interface which lacks support for this
++ *	functionality. We instead set up the private data on the port 
++ *	start hook, and tear it down on port stop
++ */
++ 
++static int it821x_port_start(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct it821x_dev *itdev;
++	u8 conf;
++
++	int ret = ata_port_start(ap);
++	if (ret < 0)
++		return ret;
++		
++	ap->private_data = kmalloc(sizeof(struct it821x_dev), GFP_KERNEL);
++	if (ap->private_data == NULL) {
++		ata_port_stop(ap);
++		return -ENOMEM;
++	}
++	
++	itdev = ap->private_data;
++	memset(itdev, 0, sizeof(struct it821x_dev));
++
++	pci_read_config_byte(pdev, 0x50, &conf);
++
++	if (conf & 1) {
++		itdev->smart = 1;
++		/* Long I/O's although allowed in LBA48 space cause the
++		   onboard firmware to enter the twighlight zone */
++		/* No ATAPI DMA in this mode either */
++	}
++	/* Pull the current clocks from 0x50 */
++	if (conf & (1 << (1 + ap->hard_port_no)))
++		itdev->clock_mode = ATA_50;
++	else
++		itdev->clock_mode = ATA_66;
++
++	itdev->want[0][1] = ATA_ANY;
++	itdev->want[1][1] = ATA_ANY;
++	itdev->last_device = -1;
++
++	pci_read_config_byte(pdev, PCI_REVISION_ID, &conf);
++	if (conf == 0x10) {
++		itdev->timing10 = 1;
++		/* Need to disable ATAPI DMA for this case */
++		if (!itdev->smart)
++			printk(KERN_WARNING DRV_NAME": Revision 0x10, workarounds activated.\n");
++	}
++
++	return 0;
++}
++
++/**
++ *	it821x_port_stop	-	port shutdown
++ *	@ap: ATA port being removed
++ *
++ *	Release the private objects we added in it821x_port_start
++ */
++ 
++static void it821x_port_stop(struct ata_port *ap) {
++	kfree(ap->private_data);
++	ap->private_data = NULL;	/* We want an OOPS if we reuse this
++					   too late! */
++	ata_port_stop(ap);
++}
++
++static struct scsi_host_template it821x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	/* 255 sectors to begin with. This is locked in smart mode but not
++	   in pass through */
++	.max_sectors		= 255,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations it821x_smart_port_ops = {
++	.set_mode	= it821x_smart_set_mode,
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.check_atapi_dma= it821x_check_atapi_dma,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= it821x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= it821x_port_start,
++	.port_stop	= it821x_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations it821x_passthru_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= it821x_passthru_set_piomode,
++	.set_dmamode	= it821x_passthru_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.check_atapi_dma= it821x_check_atapi_dma,
++	.dev_select 	= it821x_passthru_dev_select,
++
++	.phy_reset	= it821x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= it821x_passthru_bmdma_start,
++	.bmdma_stop	= it821x_passthru_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= it821x_passthru_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++	.irq_handler	= ata_interrupt,
++	.port_start	= it821x_port_start,
++	.port_stop	= it821x_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static void __devinit it821x_disable_raid(struct pci_dev *pdev)
++{
++	/* Reset local CPU, and set BIOS not ready */
++	pci_write_config_byte(pdev, 0x5E, 0x01);
++
++	/* Set to bypass mode, and reset PCI bus */
++	pci_write_config_byte(pdev, 0x50, 0x00);
++	pci_write_config_word(pdev, PCI_COMMAND,
++			      PCI_COMMAND_PARITY | PCI_COMMAND_IO |
++			      PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
++	pci_write_config_word(pdev, 0x40, 0xA0F3);
++
++	pci_write_config_dword(pdev,0x4C, 0x02040204);
++	pci_write_config_byte(pdev, 0x42, 0x36);
++	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0);
++}
++
++	
++static int it821x_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	u8 conf;
++	
++	static struct ata_port_info info_smart = {
++		.sht = &it821x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &it821x_smart_port_ops
++	};
++	static struct ata_port_info info_passthru = {
++		.sht = &it821x_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &it821x_passthru_port_ops
++	};
++	static struct ata_port_info *port_info[2];
++	
++	static char *mode[2] = { "pass through", "smart" };
++
++	/* Force the card into bypass mode if so requested */
++	if (it8212_noraid) {
++		printk(KERN_INFO DRV_NAME ": forcing bypass mode.\n");
++		it821x_disable_raid(pdev);
++	}
++	pci_read_config_byte(pdev, 0x50, &conf);
++	conf &= 1;
++	
++	printk(KERN_INFO DRV_NAME ": controller in %s mode.\n", mode[conf]);
++	if (conf == 0)
++		port_info[0] = port_info[1] = &info_passthru;
++	else
++		port_info[0] = port_info[1] = &info_smart;
++	
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static struct pci_device_id it821x[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_ITE, PCI_DEVICE_ID_ITE_8211), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_ITE, PCI_DEVICE_ID_ITE_8212), },
++	{ 0, },
++};
++
++static struct pci_driver it821x_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= it821x,
++	.probe 		= it821x_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init it821x_init(void)
++{
++	return pci_register_driver(&it821x_pci_driver);
++}
++
++
++static void __exit it821x_exit(void)
++{
++	pci_unregister_driver(&it821x_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for the IT8211/IT8212 IDE RAID controller");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, it821x);
++MODULE_VERSION(DRV_VERSION);
++
++
++module_param_named(noraid, it8212_noraid, int, S_IRUGO);
++MODULE_PARM_DESC(it8212_noraid, "Force card into bypass mode");
++
++module_init(it821x_init);
++module_exit(it821x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_legacy.c linux-2.6.16-rc4/drivers/scsi/pata_legacy.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_legacy.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_legacy.c	2006-02-16 15:33:52.000000000 +0000
+@@ -0,0 +1,672 @@
++
++/*
++ *   pata-legacy.c - Legacy port PATA/SATA controller driver.
++ *   Copyright 2005/2006 Red Hat Inc <alan@redhat.com>, all rights reserved.
++ *
++ *   An ATA driver for the legacy ATA ports.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/ata.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "legacy"
++#define DRV_VERSION "0.3.1"
++
++#define NR_HOST 6
++
++static int legacy_port[NR_HOST] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
++static int legacy_irq[NR_HOST] = { 15, 14, 11, 10, 8, 12 };
++
++static struct ata_host_set *legacy_host[NR_HOST];
++static int nr_legacy_host;
++static int legacy_all;
++static int ht6560a;
++static int ht6560b;
++static int opti82c611a;
++
++/**
++ *	legacy_set_mode		-	mode setting
++ *	@ap: IDE interface
++ *
++ *	Use a non standard set_mode function. We don't want to be tuned.
++ *
++ *	The BIOS configured everything. Our job is not to fiddle. Just use
++ *	whatever PIO the hardware is using and leave it at that. When we
++ *	get some kind of nice user driven API for control then we can
++ *	expand on this as per hdparm in the base kernel.
++ */
++ 
++static void legacy_set_mode(struct ata_port *ap)
++{
++	int i;
++
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *dev = &ap->device[i];
++		if (ata_dev_present(dev)) {
++			dev->pio_mode = XFER_PIO_0;
++			dev->xfer_mode = XFER_PIO_0;
++			dev->xfer_shift = ATA_SHIFT_PIO;
++			dev->flags |= ATA_DFLAG_PIO;
++		}
++	}
++}
++
++static struct scsi_host_template legacy_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations legacy_port_ops = {
++	.set_mode	= legacy_set_mode,
++	
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer_noirq,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Promise 20230C and 20620 support
++ *
++ *	This controller supports PIO0 to PIO2. We set PIO timings conservatively to
++ *	allow for 50MHz Vesa Local Bus. The 20620 DMA support is weird being DMA to
++ *	controller and PIO'd to the host and not supported. 
++ */
++
++static void pdc20230_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	int tries = 5;
++	int pio = adev->pio_mode - XFER_PIO_0;
++	u8 rt;
++	
++	do
++	{
++		inb(0x1F5);
++		outb(inb(0x1F2) | 0x80, 0x1F2);
++		inb(0x1F2);
++		inb(0x3F6);
++		inb(0x3F6);
++		inb(0x1F2);
++		inb(0x1F2);
++	}
++	while((inb(0x1F2) & 0x80) && --tries);
++	
++	outb(inb(0x1F4) & 0x07, 0x1F4);
++	
++	rt = inb(0x1F3);
++	rt &= 0x07 << (3 * adev->devno);
++	rt |= (3 * pio) << (3 * adev->devno);
++	
++	udelay(100);
++	outb(inb(0x1F2) | 0x01, 0x1F2);
++	udelay(100);
++	inb(0x1F5);
++	
++}
++
++static void pdc_data_xfer_vlb(struct ata_port *ap, struct ata_device *adev, unsigned char *buf, unsigned int buflen, int write_data)
++{
++	int slop = buflen & 3;
++	unsigned long flags;
++
++	if (ata_id_has_dword_io(adev->id)) {
++		local_irq_save(flags);
++
++		/* Perform the 32bit I/O synchronization sequence */	
++		inb(ap->ioaddr.nsect_addr);
++		inb(ap->ioaddr.nsect_addr);
++		inb(ap->ioaddr.nsect_addr);
++	
++		/* Now the data */
++	
++		if (write_data)
++			outsl(ap->ioaddr.data_addr, buf, buflen >> 2);
++		else
++			insl(ap->ioaddr.data_addr, buf, buflen >> 2);
++	
++		if (unlikely(slop)) {
++			u32 pad;
++			if (write_data) {
++				memcpy(&pad, buf + buflen - slop, slop);
++				outl(le32_to_cpu(pad), ap->ioaddr.data_addr);
++			} else {
++				pad = cpu_to_le16(inl(ap->ioaddr.data_addr));
++				memcpy(buf + buflen - slop, &pad, slop);
++			}
++		}
++		local_irq_restore(flags);
++	}
++	else
++		ata_pio_data_xfer_noirq(ap, adev, buf, buflen, write_data);
++}
++
++static struct ata_port_operations pdc20230_port_ops = {
++	.set_piomode	= pdc20230_set_piomode,	
++
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= pdc_data_xfer_vlb,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Holtek 6560A support
++ *
++ *	This controller supports PIO0 to PIO2 (no IORDY even though higher timings
++ *	can be loaded).
++ */
++
++static void ht6560a_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	u8 active, recover;
++	struct ata_timing t;
++
++	/* Get the timing data in cycles. For now play safe at 50Mhz */
++	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
++	
++	active = FIT(t.active, 2, 15);
++	recover = FIT(t.recover, 4, 15);
++
++	inb(0x3E6);
++	inb(0x3E6);
++	inb(0x3E6);
++	inb(0x3E6);
++	
++	outb(recover << 4 | active, ap->ioaddr.device_addr);
++	inb(ap->ioaddr.status_addr);
++}
++
++static struct ata_port_operations ht6560a_port_ops = {
++	.set_piomode	= ht6560a_set_piomode,	
++
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,	/* Check vlb/noirq */
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Holtek 6560B support
++ *
++ *	This controller supports PIO0 to PIO4. We honour the BIOS/jumper FIFO setting
++ *	unless we see an ATAPI device in which case we force it off.
++ *
++ *	FIXME: need to implement 2nd channel support.
++ */
++
++static void ht6560b_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	u8 active, recover;
++	struct ata_timing t;
++	
++	/* Get the timing data in cycles. For now play safe at 50Mhz */
++	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
++	
++	active = FIT(t.active, 2, 15);
++	recover = FIT(t.recover, 2, 16);
++	recover &= 0x15;
++
++	inb(0x3E6);
++	inb(0x3E6);
++	inb(0x3E6);
++	inb(0x3E6);
++	
++	outb(recover << 4 | active, ap->ioaddr.device_addr);
++	
++	if (adev->class != ATA_DEV_ATA) {
++		u8 rconf = inb(0x3E6);
++		if (rconf & 0x24) {
++			rconf &= ~ 0x24;
++			outb(rconf, 0x3E6);
++		}
++	}
++	inb(ap->ioaddr.status_addr);
++}
++
++static struct ata_port_operations ht6560b_port_ops = {
++	.set_piomode	= ht6560b_set_piomode,	
++
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,	/* FIXME: Check 32bit and noirq */
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/*
++ *	Opti 82C611A
++ *
++ *	This controller supports PIO0 to PIO3.
++ */
++
++static void opti82c611a_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	u8 active, recover, setup;
++	struct ata_timing t;
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++	int clock;
++	int khz[4] = { 50000, 40000, 33000, 25000 };
++	u8 rc;
++	
++	/* Enter configuration mode */
++	inb(ap->ioaddr.error_addr);
++	inb(ap->ioaddr.error_addr);
++	
++	/* Read VLB clock strapping */
++	clock = 1000000000 / khz[inb(ap->ioaddr.lbah_addr) & 0x03];
++	
++	/* Get the timing data in cycles */
++	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
++	
++	/* Setup timing is shared */
++	if (pair) {
++		struct ata_timing tp;
++		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
++		
++		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
++	}
++	
++	active = FIT(t.active, 2, 17) - 2;
++	recover = FIT(t.recover, 1, 16) - 1;
++	setup = FIT(t.setup, 1, 4) - 1;
++	
++	/* Select the right timing bank for write timing */
++	rc = inb(ap->ioaddr.lbal_addr);
++	rc &= 0x7F;
++	rc |= (adev->devno << 7);
++	outb(rc, ap->ioaddr.lbal_addr);
++
++	/* Write the timings */	
++	outb(active << 4 | recover, ap->ioaddr.error_addr);
++	
++	/* Select the right bank for read timings, also
++	   load the shared timings for address */
++	rc = inb(ap->ioaddr.device_addr);
++	rc &= 0xC0;
++	rc |= adev->devno;	/* Index select */
++	rc |= (setup << 4) | 0x04;
++	outb(rc, ap->ioaddr.device_addr);
++	
++	/* Load the read timings */
++	outb(active << 4 | recover, ap->ioaddr.data_addr);
++	
++	/* Ensure the timing register mode is right */
++	rc = inb (ap->ioaddr.lbal_addr);
++	rc &= 0x73;
++	rc |= 0x84;
++	outb(rc, ap->ioaddr.lbal_addr);
++
++	/* Exit command mode */
++	outb(0x82,  ap->ioaddr.nsect_addr);	
++}
++
++static struct ata_port_operations opti82c611a_port_ops = {
++	.set_piomode	= opti82c611a_set_piomode,	
++
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	legacy_init_one		-	attach a legacy interface
++ *	@io: I/O port start
++ *	@ctrl: control port
++ *	@irq: interrupt line
++ *
++ *	Register an ISA bus IDE interface. Such interfaces are PIO and we
++ *	assume do not support IRQ sharing.
++ */
++ 
++static __init int legacy_init_one(unsigned long io, unsigned long ctrl, int irq)
++{
++	struct ata_probe_ent ae;
++	int ret;
++	struct ata_port_operations *ops = &legacy_port_ops;
++	int pio_mask = 0x1F;
++	
++	if (request_region(io, 8, "pata_legacy") == NULL)
++		return -EBUSY;
++	if (request_region(ctrl, 1, "pata_legacy") == NULL) {
++		release_region(io, 8);
++		return -EBUSY;
++	}
++
++	if (ht6560a == 1 && (io == 0x1F0 || io == 0x170)) {
++		ops = &ht6560a_port_ops;
++		pio_mask = 0x07;
++	}
++	if (ht6560b == 1 && (io == 0x1F0 || io == 0x170)) {
++		ops = &ht6560b_port_ops;
++		pio_mask = 0x1F;
++	}
++	if (opti82c611a == 1 && (io == 0x1F0 || io == 0x170)) {
++		ops = &opti82c611a_port_ops;
++		pio_mask = 0x0F;
++	}
++	else if (io == 0x1F0) {
++		/* Probes */
++		inb(0x1F5);
++		outb(inb(0x1F2) | 0x80, 0x1F2);
++		inb(0x1F2);
++		inb(0x3F6);
++		inb(0x3F6);
++		inb(0x1F2);
++		inb(0x1F2);
++		
++		if ((inb(0x1F2) & 0x80) == 0) {
++			/* PDC20230 or 20630 ? */
++			printk(KERN_INFO "PDC20230-C/20630 VLB ATA controller detected.\n");
++				pio_mask = 0x07;
++			ops = &pdc20230_port_ops;
++			udelay(100);
++			inb(0x1F5);
++		} else {
++			outb(0x55, 0x1F2);
++			inb(0x1F2);
++			inb(0x1F2);
++			if (inb(0x1F2) == 0x00) {
++				printk(KERN_INFO "PDC20230-B VLB ATA controller detected.\n");
++			}
++		}
++	}
++	memset(&ae, 0, sizeof(struct ata_probe_ent));
++	INIT_LIST_HEAD(&ae.node);
++	ae.dev = NULL;
++	ae.port_ops = ops;
++	ae.sht = &legacy_sht;
++	ae.n_ports = 1;
++	ae.pio_mask = pio_mask;
++	ae.irq = irq;
++	ae.irq_flags = 0;
++	ae.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_IRQ_MASK;
++	ae.port[0].cmd_addr = io;
++	ae.port[0].altstatus_addr = ctrl;
++	ae.port[0].ctl_addr =	ctrl;
++	ata_std_ports(&ae.port[0]);
++
++	ret = ata_device_add(&ae);
++	if (ret == 0)
++		return -ENODEV;
++		
++	legacy_host[nr_legacy_host++] = ae.host_set;
++	return 0;	
++}
++
++/**
++ *	legacy_check_special_cases	-	ATA special cases
++ *	@p: PCI device to check
++ *	@master: set this if we find an ATA master
++ *	@master: set this if we find an ATA secondary
++ *
++ *	A small number of vendors implemented early PCI ATA interfaces on bridge logic
++ *	without the ATA interface being PCI visible. Where we have a matching PCI driver
++ *	we must skip the relevant device here. If we don't know about it then the legacy
++ *	driver is the right driver anyway.
++ */
++
++static void legacy_check_special_cases(struct pci_dev *p, int *primary, int *secondary)
++{
++	/* Cyrix CS5510 pre SFF MWDMA ATA on the bridge */
++	if (p->vendor == 0x1078 && p->device == 0x0000) {
++		*primary = *secondary = 1;
++		return;
++	}
++	/* Cyrix CS5520 pre SFF MWDMA ATA on the bridge */
++	if (p->vendor == 0x1078 && p->device == 0x0002) {
++		*primary = *secondary = 1;
++		return;
++	}
++	/* Intel MPIIX - PIO ATA on non PCI side of bridge */
++	if (p->vendor == 0x8086 && p->device == 0x1234) {
++		u16 r;
++		pci_read_config_word(p, 0x6C, &r);
++		if (r & 0x8000) {	/* ATA port enabled */
++			if (r & 0x4000)
++				*secondary = 1;
++			else
++				*primary = 1;
++		}
++		return;
++	}
++}
++
++/**
++ *	legacy_init		-	attach legacy interfaces
++ *
++ *	Attach legacy IDE interfaces by scanning the usual IRQ/port suspects.
++ *	Right now we do not scan the ide0 and ide1 address but should do so
++ *	for non PCI systems or systems with no PCI IDE legacy mode devices.
++ *	If you fix that note there are special cases to consider like VLB
++ *	drivers and CS5510/20.
++ */
++ 
++static __init int legacy_init(void)
++{
++	int i;
++	int ct = 0;
++	int primary = 0;
++	int secondary = 0;
++	int last_port = NR_HOST;
++	
++	struct pci_dev *p = NULL;
++
++	for_each_pci_dev(p) {	
++		int r;
++		/* Check for any overlap of the system ATA mappings. Native mode controllers
++		   stuck on these addresses or some devices in 'raid' mode won't be found by
++		   the storage class test */
++		for (r = 0; r < 6; r++) {
++			if (pci_resource_start(p, r) == 0x1f0)
++				primary = 1;
++			if (pci_resource_start(p, r) == 0x170)
++				secondary = 1;
++		}
++		/* Check for special cases */
++		legacy_check_special_cases(p, &primary, &secondary);
++		
++		/* If PCI bus is present then don't probe for tertiary legacy ports */
++		if (legacy_all == 0)
++			last_port = 2;
++	}
++	
++	
++	for (i = 0; i < last_port; i++) {
++		/* Skip primary if we have seen a PCI one */
++		if (i == 0 && primary == 1)
++			continue;
++		/* Skip secondary if we have seen a PCI one */
++		if (i == 1 && secondary == 1)
++			continue;
++		if (legacy_init_one(legacy_port[i], 
++				   legacy_port[i] + 0x0206, 
++				   legacy_irq[i]) == 0)
++			ct++;
++	}
++	if (ct != 0)
++		return 0;
++	return -ENODEV;
++}
++
++static __exit void legacy_exit(void)
++{
++	int i;
++
++	for (i = 0; i < nr_legacy_host; i++) {
++		struct ata_port *ap =legacy_host[i]->ports[0];
++		unsigned long io = ap->ioaddr.cmd_addr;
++		unsigned long ctrl = ap->ioaddr.ctl_addr;
++		ata_host_set_remove(legacy_host[i]);
++		release_region(io, 8);
++		release_region(ctrl, 1);
++	}	
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for legacy ATA");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++/**
++ *	legacy_probe_all	-	setup argument handler
++ *	@unused: unused
++ *
++ *	Called when the probe_all argument is passed to this driver. This indicates
++ *	that we should check all the legacy ATA addresses even if PCI is present. Should
++ *	only ever be needed on very strange PCI/legacy combinations
++ */
++ 
++static int __init legacy_probe_all(char *unused)
++{
++	legacy_all = 1;
++	return 1;
++}
++
++__setup("probe-all", legacy_probe_all);
++
++/**
++ *	legacy_ht6560a	-	setup argument handler
++ *	@unused: unused
++ *
++ *	Called when the ht6560a argument is passed to this driver. This indicates
++ *	that we should check all the legacy ATA addresses even if PCI is present. Should
++ *	only ever be needed on very strange PCI/legacy combinations
++ */
++ 
++static int __init legacy_ht6560a(char *unused)
++{
++	ht6560a = 1;
++	return 1;
++}
++
++__setup("ht6560a", legacy_ht6560a);
++
++/**
++ *	legacy_ht6560b	-	setup argument handler
++ *	@unused: unused
++ *
++ *	Called when the ht6560b argument is passed to this driver. This indicates
++ *	that we should check all the legacy ATA addresses even if PCI is present. Should
++ *	only ever be needed on very strange PCI/legacy combinations
++ */
++ 
++static int __init legacy_ht6560b(char *unused)
++{
++	ht6560b = 1;
++	return 1;
++}
++
++__setup("ht6560b", legacy_ht6560b);
++
++/**
++ *	legacy_ht6560a	-	setup argument handler
++ *	@unused: unused
++ *
++ *	Called when the ht6560a argument is passed to this driver. This indicates
++ *	that we should check all the legacy ATA addresses even if PCI is present. Should
++ *	only ever be needed on very strange PCI/legacy combinations
++ */
++ 
++static int __init legacy_opti82c611a(char *unused)
++{
++	opti82c611a = 1;
++	return 1;
++}
++
++__setup("opti82c611a", legacy_opti82c611a);
++
++module_init(legacy_init);
++module_exit(legacy_exit);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_mpiix.c linux-2.6.16-rc4/drivers/scsi/pata_mpiix.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_mpiix.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_mpiix.c	2006-02-16 15:38:41.000000000 +0000
+@@ -0,0 +1,303 @@
++/*
++ * pata_mpiix.c 	- Intel MPIIX PATA for new ATA layer
++ *			  (C) 2005-2006 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * The MPIIX is different enough to the PIIX4 and friends that we give it
++ * a separate driver. The old ide/pci code handles this by just not tuning
++ * MPIIX at all. 
++ *
++ * The MPIIX also differs in another important way from the majority of PIIX
++ * devices. The chip is a bridge (pardon the pun) between the old world of
++ * ISA IDE and PCI IDE. Although the ATA timings are PCI configured the actual
++ * IDE controller is not decoded in PCI space and the chip does not claim to
++ * be IDE class PCI. This requires slightly non-standard probe logic compared
++ * with PCI IDE and also that we do not disable the device when our driver is
++ * unloaded (as it has many other functions).
++ *
++ * The driver conciously keeps this logic internally to avoid pushing quirky
++ * PATA history into the clean libata layer.
++ *
++ * Thinkpad specific note: If you boot an MPIIX using thinkpad with a PCMCIA 
++ * hard disk present this driver will not detect it. This is not a bug. In this
++ * configuration the secondary port of the MPIIX is disabled and the addresses
++ * are decoded by the PCMCIA bridge and therefore are for a generic IDE driver
++ * to operate.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_mpiix"
++#define DRV_VERSION "0.4"
++
++/**
++ *	mpiix_phy_reset		-	probe reset
++ *	@ap: ATA port
++ *
++ *	Perform the ATA probe and bus reset sequence plus specific handling
++ *	for this hardware. The MPIIX has the enable bits in a different place
++ *	to PIIX4 and friends. As a pure PIO device it has no cable detect
++ */
++
++static void mpiix_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static const struct pci_bits mpiix_enable_bits[] = {
++		{ 0x6D, 1, 0x80, 0x80 },
++		{ 0x6F, 1, 0x80, 0x80 }
++	};
++
++	if (!pci_test_config_bits(pdev, &mpiix_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	mpiix_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. The MPIIX allows us to program the
++ *	IORDY sample point (2-5 clocks), recovery 1-4 clocks and whether
++ *	prefetching or iordy are used.
++ *
++ *	This would get very ugly because we can only program timing for one
++ *	device at a time, the other gets PIO0. Fortunately libata calls 
++ *	our qc_issue_prot command before a command is issued so we can
++ *	flip the timings back and forth to reduce the pain.
++ */
++
++static void mpiix_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	int control = 0;
++	int pio = adev->pio_mode - XFER_PIO_0;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u16 idetim;
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
++
++	pci_read_config_word(pdev, 0x6C, &idetim);
++	/* Mask the IORDY/TIME/PPE0 bank for this device */
++	if (adev->class == ATA_DEV_ATA)
++		control |= 4;	/* PPE enable for disk */
++	if (ata_pio_need_iordy(adev))
++		control |= 2;	/* IORDY */
++	if (pio > 0)
++		control |= 1;	/* This drive is on the fast timing bank */
++
++	/* Mask out timing and clear both TIME bank selects */
++	idetim &= 0xCCEE;
++	idetim &= ~(0x07  << (2 * adev->devno));
++	idetim |= (control << (2 * adev->devno));
++
++	idetim |= (timings[pio][0] << 12) | (timings[pio][1] << 8);
++	pci_write_config_word(pdev, 0x6C, idetim);
++
++	/* We use ap->private_data as a pointer to the device currently
++	   loaded for timing */
++	ap->private_data = adev;
++}
++
++/**
++ *	mpiix_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary. Our logic also clears TIME0/TIME1 for the other device so
++ *	that, even if we get this wrong, cycles to the other device will
++ *	be made PIO0.
++ */
++
++static int mpiix_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++
++	/* If modes have been configured and the channel data is not loaded
++	   then load it. We have to check if pio_mode is set as the core code
++	   does not set adev->pio_mode to XFER_PIO_0 while probing as would be
++	   logical */
++	   
++	if (adev->pio_mode && adev != ap->private_data)
++		mpiix_set_piomode(ap, adev);
++		
++	return ata_qc_issue_prot(qc);
++}
++
++static struct scsi_host_template mpiix_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations mpiix_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= mpiix_set_piomode,
++
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= mpiix_phy_reset,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= mpiix_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int mpiix_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	/* Single threaded by the PCI probe logic */
++	static struct ata_probe_ent probe[2];
++	static int printed_version;
++	u16 idetim;
++	int enabled;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &dev->dev, "version " DRV_VERSION "\n");
++
++	/* MPIIX has many functions which can be turned on or off according
++	   to other devices present. Make sure IDE is enabled before we try
++	   and use it */
++	   
++	pci_read_config_word(dev, 0x6C, &idetim);
++	if (!(idetim & 0x8000))
++		return -ENODEV;
++
++	/* We do our own plumbing to avoid leaking special cases for whacko
++	   ancient hardware into the core code. There are two issues to 
++	   worry about.  #1 The chip is a bridge so if in legacy mode and
++	   without BARs set fools the setup.  #2 If you pci_disable_device
++	   the MPIIX your box goes castors up */
++
++	INIT_LIST_HEAD(&probe[0].node);
++	probe[0].dev = pci_dev_to_dev(dev);
++	probe[0].port_ops = &mpiix_port_ops;
++	probe[0].sht = &mpiix_sht;
++	probe[0].pio_mask = 0x1F;
++	probe[0].irq = 14;
++	probe[0].irq_flags = SA_SHIRQ;
++	probe[0].host_flags = ATA_FLAG_SLAVE_POSS;
++	probe[0].legacy_mode = 1;
++	probe[0].hard_port_no = 0;
++	probe[0].n_ports = 1;
++	probe[0].port[0].cmd_addr = 0x1F0;
++	probe[0].port[0].ctl_addr = 0x3F6;
++	probe[0].port[0].altstatus_addr = 0x3F6;
++	
++	/* The secondary lurks at different addresses but is otherwise
++	   the same beastie */
++	   
++	INIT_LIST_HEAD(&probe[1].node);
++	probe[1] = probe[0];
++	probe[1].irq = 15;
++	probe[1].hard_port_no = 1;
++	probe[1].port[0].cmd_addr = 0x170;
++	probe[1].port[0].ctl_addr = 0x376;
++	probe[1].port[0].altstatus_addr = 0x376;
++	
++	/* Let libata fill in the port details */
++	ata_std_ports(&probe[0].port[0]);
++	ata_std_ports(&probe[1].port[0]);
++	
++	/* Now add the port that is active */
++	enabled = (idetim & 0x4000) ? 1 : 0;
++
++	if (ata_device_add(&probe[enabled]))
++		return 0;
++	return -ENODEV;
++}
++
++/**
++ *	mpiix_remove_one	-	device unload
++ *	@pdev: PCI device being removed
++ *
++ *	Handle an unplug/unload event for a PCI device. Unload the
++ *	PCI driver but do not use the default handler as we *MUST NOT*
++ *	disable the device as it has other functions.
++ */
++ 
++static void __devexit mpiix_remove_one(struct pci_dev *pdev)
++{
++	struct device *dev = pci_dev_to_dev(pdev);
++	struct ata_host_set *host_set = dev_get_drvdata(dev);
++
++	ata_host_set_remove(host_set);
++	dev_set_drvdata(dev, NULL);
++}
++
++
++
++static const struct pci_device_id mpiix[] = {
++	{ PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371MX, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
++	{ 0, },
++};
++
++static struct pci_driver mpiix_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= mpiix,
++	.probe 		= mpiix_init_one,
++	.remove		= mpiix_remove_one
++};
++
++static int __init mpiix_init(void)
++{
++	return pci_register_driver(&mpiix_pci_driver);
++}
++
++
++static void __exit mpiix_exit(void)
++{
++	pci_unregister_driver(&mpiix_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Intel MPIIX");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, mpiix);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(mpiix_init);
++module_exit(mpiix_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_netcell.c linux-2.6.16-rc4/drivers/scsi/pata_netcell.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_netcell.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_netcell.c	2006-02-08 14:05:57.000000000 +0000
+@@ -0,0 +1,176 @@
++/*
++ *    pata_netcell.c - Netcell PATA driver
++ *
++ *	(c) 2006 Red Hat  <alan@redhat.com>
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_netcell"
++#define DRV_VERSION	"0.1"
++
++/**
++ *	netcell_cable_detect	-	check for 40/80 pin
++ *	@ap: Port
++ *
++ *	Cables are handled by the RAID controller. Report 80 pin.
++ */
++ 
++static int netcell_cable_detect(struct ata_port *ap)
++{
++	return ATA_CBL_PATA80;
++}
++
++/**
++ *	netcell_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void netcell_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = netcell_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/* No PIO or DMA methods needed for this device */
++
++static struct scsi_host_template netcell_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	/* Special handling needed if you have sector or LBA48 limits */
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	/* Use standard CHS mapping rules */
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations netcell_ops = {
++	.port_disable		= ata_port_disable,
++
++	/* Task file is PCI ATA format, use helpers */
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= netcell_phy_reset,
++
++	/* BMDMA handling is PCI ATA format, use helpers */
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,	/* In -ac only right now */
++
++	/* Timeout handling. Special recovery hooks here */
++	.eng_timeout		= ata_eng_timeout,
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	/* Generic PATA PCI ATA helpers */
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++
++/**
++ *	netcell_init_one - Register Netcell ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in netcell_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int netcell_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	static struct ata_port_info info = {
++		.sht		= &netcell_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		/* Actually we don't really care about these as the
++		   firmware deals with it */
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask 	= 0x3f, /* UDMA 133 */
++		.port_ops	= &netcell_ops,
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++
++	/* Any chip specific setup/optimisation/messages here */
++	ata_pci_clear_simplex(pdev);
++	
++	/* And let the library code do the work */
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id netcell_pci_tbl[] = {
++	{ 0x169C, 0x0044, PCI_ANY_ID, PCI_ANY_ID, },
++	{ }	/* terminate list */
++};
++
++static struct pci_driver netcell_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= netcell_pci_tbl,
++	.probe			= netcell_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init netcell_init(void)
++{
++	return pci_register_driver(&netcell_pci_driver);
++}
++
++static void __exit netcell_exit(void)
++{
++	pci_unregister_driver(&netcell_pci_driver);
++}
++
++
++module_init(netcell_init);
++module_exit(netcell_exit);
++
++MODULE_AUTHOR("");
++MODULE_DESCRIPTION("SCSI low-level driver for Netcell PATA RAID");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, netcell_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_ns87410.c linux-2.6.16-rc4/drivers/scsi/pata_ns87410.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_ns87410.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_ns87410.c	2006-02-15 15:05:43.000000000 +0000
+@@ -0,0 +1,213 @@
++/*
++ * pata_ns87410.c 	- National Semiconductor 87410 PATA for new ATA layer
++ *			  (C) 2006 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_ns87410"
++#define DRV_VERSION "0.1"
++
++/**
++ *	ns87410_phy_reset		-	probe reset
++ *	@ap: ATA port
++ *
++ *	Perform the ATA probe and bus reset sequence plus specific handling
++ *	for this hardware. The MPIIX has the enable bits in a different place
++ *	to PIIX4 and friends. As a pure PIO device it has no cable detect
++ */
++
++static void ns87410_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static const struct pci_bits ns87410_enable_bits[] = {
++		{ 0x43, 1, 0x08, 0x08 },
++		{ 0x47, 1, 0x08, 0x08 }
++	};
++
++	if (!pci_test_config_bits(pdev, &ns87410_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	ns87410_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program timing data. This is kept per channel not per device,
++ *	and only affects the data port.
++ */
++
++static void ns87410_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int port = 0x40 + 4 * ap->hard_port_no;
++	u8 idetcr, idefr;
++	struct ata_timing at;
++	
++	static const u8 activebits[15] = {
++		0, 1, 2, 3, 4,
++		5, 5, 6, 6, 6, 
++		6, 7, 7, 7, 7
++	};
++	
++	static const u8 recoverbits[12] = {
++		0, 1, 2, 3, 4, 5, 6, 6, 7, 7, 7, 7
++	};
++
++	pci_read_config_byte(pdev, port + 3, &idefr);
++
++	if (ata_pio_need_iordy(adev))
++		idefr |= 0x04;	/* IORDY enable */
++	else
++		idefr &= ~0x04;
++		
++	if (ata_timing_compute(adev, adev->pio_mode, &at, 30303, 1) < 0) {
++		dev_printk(KERN_ERR, &pdev->dev, "unknown mode %d.\n", adev->pio_mode);
++		return;
++	}
++	
++	at.active = FIT(at.active, 2, 16) - 2;
++	at.setup = FIT(at.setup, 1, 4) - 1;
++	at.recover = FIT(at.recover, 1, 12) - 1;
++	
++	idetcr = (at.setup << 6) | (recoverbits[at.recover] << 3) | activebits[at.active];
++
++	pci_write_config_byte(pdev, port, idetcr);
++	pci_write_config_byte(pdev, port + 3, idefr);
++	/* We use ap->private_data as a pointer to the device currently
++	   loaded for timing */
++	ap->private_data = adev;
++}
++
++/**
++ *	ns87410_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary. Our logic also clears TIME0/TIME1 for the other device so
++ *	that, even if we get this wrong, cycles to the other device will
++ *	be made PIO0.
++ */
++
++static int ns87410_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++
++	/* If modes have been configured and the channel data is not loaded
++	   then load it. We have to check if pio_mode is set as the core code
++	   does not set adev->pio_mode to XFER_PIO_0 while probing as would be
++	   logical */
++	   
++	if (adev->pio_mode && adev != ap->private_data)
++		ns87410_set_piomode(ap, adev);
++		
++	return ata_qc_issue_prot(qc);
++}
++
++static struct scsi_host_template ns87410_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations ns87410_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= ns87410_set_piomode,
++
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= ns87410_phy_reset,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ns87410_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int ns87410_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &ns87410_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x0F,
++		.port_ops = &ns87410_port_ops
++	};
++	static struct ata_port_info *port_info[2] = {&info, &info};
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static const struct pci_device_id ns87410[] = {
++	{ PCI_DEVICE(0x100B, 0xD001), },
++	{ 0, },
++};
++
++static struct pci_driver ns87410_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= ns87410,
++	.probe 		= ns87410_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init ns87410_init(void)
++{
++	return pci_register_driver(&ns87410_pci_driver);
++}
++
++
++static void __exit ns87410_exit(void)
++{
++	pci_unregister_driver(&ns87410_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Nat Semi 87410");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, ns87410);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(ns87410_init);
++module_exit(ns87410_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_oldpiix.c linux-2.6.16-rc4/drivers/scsi/pata_oldpiix.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_oldpiix.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_oldpiix.c	2006-01-21 16:55:29.000000000 +0000
+@@ -0,0 +1,327 @@
++/*
++ *    pata_oldpiix.c - Intel PATA/SATA controllers
++ *
++ *	(C) 2005 Red Hat <alan@redhat.com>
++ *
++ *    Some parts based on ata_piix.c by Jeff Garzik and others.
++ *
++ *    Early PIIX differs significantly from the later PIIX as it lacks
++ *    SITRE and the slave timing registers. This means that you have to
++ *    set timing per channel, or be clever. Libata tells us whenever it
++ *    does drive selection and we use this to reload the timings.
++ *
++ *    Because of these behaviour differences PIIX gets its own driver module.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_oldpiix"
++#define DRV_VERSION	"0.3"
++
++/**
++ *	oldpiix_pata_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void oldpiix_pata_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static const struct pci_bits oldpiix_enable_bits[] = {
++		{ 0x41U, 1U, 0x80UL, 0x80UL },	/* port 0 */
++		{ 0x43U, 1U, 0x80UL, 0x80UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &oldpiix_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	oldpiix_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set PIO mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void oldpiix_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio	= adev->pio_mode - XFER_PIO_0;
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	unsigned int idetm_port= ap->hard_port_no ? 0x42 : 0x40;
++	u16 idetm_data;
++	int control = 0;
++
++	/*
++	 *	See Intel Document 298600-004 for the timing programing rules
++	 *	for PIIX/ICH. Note that the early PIIX does not have the slave
++	 *	timing port at 0x44.
++	 */
++
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
++
++	if (pio > 2)
++		control |= 1;	/* TIME1 enable */
++	if (ata_pio_need_iordy(adev))
++		control |= 2;	/* IE IORDY */
++
++	/* Intel specifies that the PPE functionality is for disk only */
++	if (adev->class == ATA_DEV_ATA)
++		control |= 4;	/* PPE enable */
++
++	pci_read_config_word(dev, idetm_port, &idetm_data);
++
++	/* Enable PPE, IE and TIME as appropriate. Clear the other
++	   drive timing bits */
++	if (adev->devno == 0) {
++		idetm_data &= 0xCCE0;
++		idetm_data |= control;
++	} else {
++		idetm_data &= 0xCC0E;
++		idetm_data |= (control << 4);
++	}
++	idetm_data |= (timings[pio][0] << 12) |
++			(timings[pio][1] << 8);
++	pci_write_config_word(dev, idetm_port, idetm_data);
++
++	/* Track which port is configured */
++	ap->private_data = adev;
++}
++
++/**
++ *	oldpiix_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *	@isich: True if the device is an ICH and has IOCFG registers
++ *
++ *	Set MWDMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void oldpiix_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	u8 idetm_port		= ap->hard_port_no ? 0x42 : 0x40;
++	u16 idetm_data;
++
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 0 },
++			    { 2, 1 },
++			    { 2, 3 }, };
++
++	/*
++	 * MWDMA is driven by the PIO timings. We must also enable
++	 * IORDY unconditionally along with TIME1. PPE has already
++	 * been set when the PIO timing was set.
++	 */
++
++	unsigned int mwdma	= adev->dma_mode - XFER_MW_DMA_0;
++	unsigned int control;
++	const unsigned int needed_pio[3] = {
++		XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
++	};
++	int pio = needed_pio[mwdma] - XFER_PIO_0;
++
++	pci_read_config_word(dev, idetm_port, &idetm_data);
++
++	control = 3;	/* IORDY|TIME0 */
++	/* Intel specifies that the PPE functionality is for disk only */
++	if (adev->class == ATA_DEV_ATA)
++		control |= 4;	/* PPE enable */
++
++	/* If the drive MWDMA is faster than it can do PIO then
++	   we must force PIO into PIO0 */
++
++	if (adev->pio_mode < needed_pio[mwdma])
++		/* Enable DMA timing only */
++		control |= 8;	/* PIO cycles in PIO0 */
++
++	/* Mask out the relevant control and timing bits we will load. Also
++	   clear the other drive TIME register as a precaution */
++	if (adev->devno == 0) {
++		idetm_data &= 0xCCE0;
++		idetm_data |= control;
++	} else {
++		idetm_data &= 0xCC0E;
++		idetm_data |= (control << 4);
++	}
++	idetm_data |= (timings[pio][0] << 12) | (timings[pio][1] << 8);
++	pci_write_config_word(dev, idetm_port, idetm_data);
++
++	/* Track which port is configured */
++	ap->private_data = adev;
++}
++
++/**
++ *	oldpiix_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary. Our logic also clears TIME0/TIME1 for the other device so
++ *	that, even if we get this wrong, cycles to the other device will
++ *	be made PIO0.
++ */
++
++static int oldpiix_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++
++	if (adev != ap->private_data) {
++		if (adev->dma_mode)
++			oldpiix_set_dmamode(ap, adev);
++		else if (adev->pio_mode)
++			oldpiix_set_piomode(ap, adev);
++	}
++	return ata_qc_issue_prot(qc);
++}
++
++
++static struct scsi_host_template oldpiix_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations oldpiix_pata_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= oldpiix_set_piomode,
++	.set_dmamode		= oldpiix_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= oldpiix_pata_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= oldpiix_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++
++/**
++ *	oldpiix_init_one - Register PIIX ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in oldpiix_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.  We probe for combined mode (sigh),
++ *	and then hand over control to libata, for it to do the rest.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int oldpiix_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	static struct ata_port_info info = {
++		.sht		= &oldpiix_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma1-2 */
++		.port_ops	= &oldpiix_pata_ops,
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id oldpiix_pci_tbl[] = {
++	{ 0x8086, 0x1230, PCI_ANY_ID, PCI_ANY_ID, },
++	{ }	/* terminate list */
++};
++
++static struct pci_driver oldpiix_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= oldpiix_pci_tbl,
++	.probe			= oldpiix_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init oldpiix_init(void)
++{
++	return pci_register_driver(&oldpiix_pci_driver);
++}
++
++static void __exit oldpiix_exit(void)
++{
++	pci_unregister_driver(&oldpiix_pci_driver);
++}
++
++
++module_init(oldpiix_init);
++module_exit(oldpiix_exit);
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("SCSI low-level driver for early PIIX series controllers");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, oldpiix_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_opti.c linux-2.6.16-rc4/drivers/scsi/pata_opti.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_opti.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_opti.c	2006-02-16 15:38:28.000000000 +0000
+@@ -0,0 +1,268 @@
++/*
++ * pata_opti.c 	- ATI PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based on
++ *  linux/drivers/ide/pci/opti621.c		Version 0.7	Sept 10, 2002
++ *
++ *  Copyright (C) 1996-1998  Linus Torvalds & authors (see below)
++ *
++ * Authors:
++ * Jaromir Koutek <miri@punknet.cz>,
++ * Jan Harkes <jaharkes@cwi.nl>,
++ * Mark Lord <mlord@pobox.com>
++ * Some parts of code are from ali14xx.c and from rz1000.c.
++ *
++ * Also consulted the FreeBSD prototype driver by Kevin Day to try
++ * and resolve some confusions.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_opti"
++#define DRV_VERSION "0.1.2"
++
++enum {
++	READ_REG	= 0,	/* index of Read cycle timing register */
++	WRITE_REG 	= 1,	/* index of Write cycle timing register */
++	CNTRL_REG 	= 3,	/* index of Control register */
++	STRAP_REG 	= 5,	/* index of Strap register */
++	MISC_REG 	= 6	/* index of Miscellaneous register */
++};
++
++/**
++ *	opti_phy_reset		-	probe reset
++ *	@ap: ATA port
++ *
++ *	Perform the ATA probe and bus reset sequence plus specific handling
++ *	for this hardware. The Opti needs little handling - we have no UDMA66
++ *	capability that needs cable detection. All we must do is check the port
++ *	is enabled.
++ */
++
++static void opti_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static const struct pci_bits opti_enable_bits[] = {
++		{ 0x45, 1, 0x80, 0x00 },
++		{ 0x45, 1, 0x08, 0x00 }
++	};
++
++	if (!pci_test_config_bits(pdev, &opti_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	opti_write_reg		-	control register setup
++ *	@ap: ATA port
++ *	@value: value
++ *	@reg: control register number
++ *
++ *	The Opti uses magic 'trapdoor' register accesses to do configuration
++ *	rather than using PCI space as other controllers do. The double inw
++ *	on the error register activates configuration mode. We can then write
++ *	the control register
++ */
++
++static void opti_write_reg(struct ata_port *ap, u8 val, int reg)
++{
++	unsigned long regio = ap->ioaddr.cmd_addr;
++	inw(regio + 1);
++	inw(regio + 1);
++	outb(3, regio + 2);
++	outb(val, regio + reg);
++	outb(0x83, regio + 2);
++}
++
++#if 0
++/**
++ *	opti_read_reg		-	control register read
++ *	@ap: ATA port
++ *	@reg: control register number
++ *
++ *	The Opti uses magic 'trapdoor' register accesses to do configuration
++ *	rather than using PCI space as other controllers do. The double inw
++ *	on the error register activates configuration mode. We can then read
++ *	the control register
++ */
++
++static u8 opti_read_reg(struct ata_port *ap, int reg)
++{
++	unsigned long regio = ap->ioaddr.cmd_addr;
++	u8 ret;
++	inw(regio + 1);
++	inw(regio + 1);
++	outb(3, regio + 2);
++	ret = inb(regio + reg);
++	outb(0x83, regio + 2);
++}
++#endif
++
++/**
++ *	opti_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. Timing numbers are taken from
++ *	the FreeBSD driver then pre computed to keep the code clean. There
++ *	are two tables depending on the hardware clock speed.
++ */
++
++static void opti_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++	int clock;
++	int pio = adev->pio_mode - XFER_PIO_0;
++	unsigned long regio = ap->ioaddr.cmd_addr;
++	u8 addr;
++
++	/* Address table precomputed with prefetch off and a DCLK of 2 */
++	static const u8 addr_timing[2][5] = {
++		{ 0x30, 0x20, 0x20, 0x10, 0x10 },
++		{ 0x20, 0x20, 0x10, 0x10, 0x10 }
++	};
++	static const u8 data_rec_timing[2][5] = {
++		{ 0x6B, 0x56, 0x42, 0x32, 0x31 },
++		{ 0x58, 0x44, 0x32, 0x22, 0x21 }
++	};
++
++	outb(0xff, regio + 5);
++	clock = inw(regio + 5) & 1;
++
++	/*
++ 	 *	As with many controllers the address setup time is shared
++ 	 *	and must suit both devices if present.
++	 */
++
++	addr = addr_timing[clock][pio];
++	if (pair) {
++		/* Hardware constraint */
++		u8 pair_addr = addr_timing[clock][pair->pio_mode - XFER_PIO_0];
++		if (pair_addr > addr)
++			addr = pair_addr;
++	}
++
++	/* Commence primary programming sequence */
++	opti_write_reg(ap, adev->devno, MISC_REG);
++	opti_write_reg(ap, data_rec_timing[clock][pio], READ_REG);
++	opti_write_reg(ap, data_rec_timing[clock][pio], WRITE_REG);
++	opti_write_reg(ap, addr, MISC_REG);
++
++	/* Programming sequence complete, override strapping */
++	opti_write_reg(ap, 0x85, CNTRL_REG);
++}
++
++static struct scsi_host_template opti_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations opti_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= opti_set_piomode,
++/*	.set_dmamode	= opti_set_dmamode, */
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= opti_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int opti_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &opti_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.port_ops = &opti_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	static int printed_version;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &dev->dev, "version " DRV_VERSION "\n");
++
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static const struct pci_device_id opti[] = {
++	{ PCI_VENDOR_ID_OPTI, PCI_DEVICE_ID_OPTI_82C621, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_OPTI, PCI_DEVICE_ID_OPTI_82C825, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ 0, },
++};
++
++static struct pci_driver opti_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= opti,
++	.probe 		= opti_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init opti_init(void)
++{
++	return pci_register_driver(&opti_pci_driver);
++}
++
++
++static void __exit opti_exit(void)
++{
++	pci_unregister_driver(&opti_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Opti 621/621X");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, opti);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(opti_init);
++module_exit(opti_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pcmcia.c linux-2.6.16-rc4/drivers/scsi/pata_pcmcia.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pcmcia.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_pcmcia.c	2006-01-21 16:55:56.000000000 +0000
+@@ -0,0 +1,406 @@
++/*
++ *   pata-pcmcia.c - PCMCIA PATA controller driver.
++ *   Copyright 2005/2006 Red Hat Inc <alan@redhat.com>, all rights reserved.
++ *
++ *   Heavily based upon ide-cs.c
++ *   The initial developer of the original code is David A. Hinds
++ *   <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
++ *   are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/ata.h>
++#include <linux/libata.h>
++
++#include <pcmcia/cs_types.h>
++#include <pcmcia/cs.h>
++#include <pcmcia/cistpl.h>
++#include <pcmcia/ds.h>
++#include <pcmcia/cisreg.h>
++#include <pcmcia/ciscode.h>
++
++
++#define DRV_NAME "pata_pcmcia"
++#define DRV_VERSION "0.1"
++
++/*
++ *	Private data structure to glue stuff together
++ */
++ 
++struct ata_pcmcia_info {
++	dev_link_t	link;
++	int		ndev;
++	dev_node_t	node;
++};
++
++static struct scsi_host_template pcmcia_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations pcmcia_port_ops = {
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++#define CS_CHECK(fn, ret) \
++do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
++
++/**
++ *	pcmcia_init_one		-	attach an pcmcia interface
++ *	@pdev: pcmcia device
++ *
++ *	Register a PCMCIA IDE interface. Such interfaces are PIO 0 and
++ *	non shared IRQ. 
++ */
++ 
++static int pcmcia_init_one(struct pcmcia_device *pdev)
++{
++	struct ata_probe_ent ae;
++	dev_link_t *link;
++	struct ata_pcmcia_info *info;
++	client_handle_t handle;
++	tuple_t tuple;
++	struct {
++		unsigned short buf[128];
++		cisparse_t parse;
++		config_info_t conf;
++		cistpl_cftable_entry_t dflt;
++	} *stk = NULL;
++	cistpl_cftable_entry_t *cfg;
++	int pass, last_ret = 0, last_fn = 0, is_kme = 0, ret = -ENOMEM;
++	unsigned long io_base, ctl_base;
++	
++	info = kzalloc(sizeof(*info), GFP_KERNEL);
++	if (info == NULL)
++		return -ENOMEM;
++		
++	link = &info->link;
++	link->priv = info;
++	
++	link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
++	link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
++	link->io.IOAddrLines = 3;
++	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
++	link->irq.IRQInfo1 = IRQ_LEVEL_ID;
++	link->conf.Attributes = CONF_ENABLE_IRQ;
++	link->conf.Vcc = 50;
++	link->conf.IntType = INT_MEMORY_AND_IO;
++
++	link->handle = pdev;
++	pdev->instance = link;
++
++	handle = link->handle;
++	
++	link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
++	
++	stk = kzalloc(sizeof(*stk), GFP_KERNEL);
++	if (!stk)
++		goto out1;
++
++	cfg = &stk->parse.cftable_entry;
++
++	tuple.TupleData = (cisdata_t *)&stk->buf;
++	tuple.TupleOffset = 0;
++	tuple.TupleDataMax = 255;
++	tuple.Attributes = 0;
++	tuple.DesiredTuple = CISTPL_CONFIG;
++
++	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
++	CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
++	CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &stk->parse));
++	link->conf.ConfigBase = stk->parse.config.base;
++	link->conf.Present = stk->parse.config.rmask[0];
++	
++	tuple.DesiredTuple = CISTPL_MANFID;
++	if (!pcmcia_get_first_tuple(handle, &tuple) && !pcmcia_get_tuple_data(handle, &tuple) && !pcmcia_parse_tuple(handle, &tuple, &stk->parse))
++			is_kme = ((stk->parse.manfid.manf == MANFID_KME) && ((stk->parse.manfid.card == PRODID_KME_KXLC005_A) || (stk->parse.manfid.card == PRODID_KME_KXLC005_B)));
++
++	/* Configure card */
++	link->state |= DEV_CONFIG;
++
++	/* Not sure if this is right... look up the current Vcc */
++	CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(handle, &stk->conf));
++	link->conf.Vcc = stk->conf.Vcc;
++
++	pass = io_base = ctl_base = 0;
++	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
++	tuple.Attributes = 0;
++	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
++
++	while (1) {
++		if (pcmcia_get_tuple_data(handle, &tuple) != 0)
++			goto next_entry;
++		if (pcmcia_parse_tuple(handle, &tuple, &stk->parse) != 0)
++			goto next_entry;
++		/* Check for matching Vcc, unless we're desperate */
++		if (!pass) {
++			if (cfg->vcc.present & (1 << CISTPL_POWER_VNOM)) {
++				if (stk->conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM] / 10000)
++					goto next_entry;
++			} else if (stk->dflt.vcc.present & (1 << CISTPL_POWER_VNOM)) {
++				if (stk->conf.Vcc != stk->dflt.vcc.param[CISTPL_POWER_VNOM] / 10000)
++					goto next_entry;
++			}
++		}
++
++		if (cfg->vpp1.present & (1 << CISTPL_POWER_VNOM))
++			link->conf.Vpp1 = link->conf.Vpp2 = cfg->vpp1.param[CISTPL_POWER_VNOM] / 10000;
++		else if (stk->dflt.vpp1.present & (1 << CISTPL_POWER_VNOM))
++			link->conf.Vpp1 = link->conf.Vpp2 = stk->dflt.vpp1.param[CISTPL_POWER_VNOM] / 10000;
++
++		if ((cfg->io.nwin > 0) || (stk->dflt.io.nwin > 0)) {
++			cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &stk->dflt.io;
++			link->conf.ConfigIndex = cfg->index;
++			link->io.BasePort1 = io->win[0].base;
++			link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
++			if (!(io->flags & CISTPL_IO_16BIT))
++				link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
++			if (io->nwin == 2) {
++				link->io.NumPorts1 = 8;
++				link->io.BasePort2 = io->win[1].base;
++				link->io.NumPorts2 = (is_kme) ? 2 : 1;
++				if (pcmcia_request_io(link->handle, &link->io) != 0)
++					goto next_entry;
++				io_base = link->io.BasePort1;
++				ctl_base = link->io.BasePort2;
++			} else if ((io->nwin == 1) && (io->win[0].len >= 16)) {
++				link->io.NumPorts1 = io->win[0].len;
++				link->io.NumPorts2 = 0;
++				if (pcmcia_request_io(link->handle, &link->io) != 0)
++					goto next_entry;
++				io_base = link->io.BasePort1;
++				ctl_base = link->io.BasePort1 + 0x0e;
++			} else goto next_entry;
++			/* If we've got this far, we're done */
++			break;
++		}
++next_entry:
++		if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
++			memcpy(&stk->dflt, cfg, sizeof(stk->dflt));
++		if (pass) {
++			CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(handle, &tuple));
++		} else if (pcmcia_get_next_tuple(handle, &tuple) != 0) {
++			CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
++			memset(&stk->dflt, 0, sizeof(stk->dflt));
++			pass++;
++		}
++	}
++	
++	if (is_kme)
++		outb(0x81, ctl_base + 0x01);
++	
++	/* FIXME: Could be more ports at base + 0x10 but we only deal with
++	   one right now */
++
++	if (link->io.NumPorts1 >= 0x20)
++		printk(KERN_WARNING DRV_NAME ": second channel not yet supported.\n");
++
++	/*
++ 	 *	Having done the PCMCIA plumbing the ATA side is relatively
++ 	 *	sane.
++	 */
++	
++	memset(&ae, 0, sizeof(struct ata_probe_ent));
++	INIT_LIST_HEAD(&ae.node);
++	ae.dev = &pdev->dev;
++	ae.port_ops = &pcmcia_port_ops;
++	ae.sht = &pcmcia_sht;
++	ae.n_ports = 1;
++	ae.pio_mask = 1;		/* ISA so PIO 0 cycles */
++	ae.irq = link->irq.AssignedIRQ;
++	ae.irq_flags = 0;
++	ae.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_IRQ_MASK;
++	ae.port[0].cmd_addr = io_base;
++	ae.port[0].altstatus_addr = ctl_base;
++	ae.port[0].ctl_addr = ctl_base;
++	ata_std_ports(&ae.port[0]);
++
++	if (ata_device_add(&ae) == 0)
++		goto failed;
++		
++	info->ndev = 1;
++	link->dev = &info->node;
++	link->state &= ~DEV_CONFIG_PENDING;
++	kfree(stk);
++	return 0;
++
++cs_failed:
++	cs_error(link->handle, last_fn, last_ret);
++failed:
++	kfree(stk);
++	info->ndev = 0;
++	link->dev = NULL;
++
++	pcmcia_release_configuration(link->handle);
++	pcmcia_release_io(link->handle, &link->io);
++	pcmcia_release_irq(link->handle, &link->irq);
++
++	link->state &= ~DEV_CONFIG;
++out1:
++	kfree(info);
++	return ret;
++}
++
++/**
++ *	pcmcia_remove_one	-	unplug an pcmcia interface
++ *	@pdev: pcmcia device
++ *
++ *	A PCMCIA ATA device has been unplugged. Perform the needed 
++ *	cleanup. Also called on module unload for any active devices.
++ */
++ 
++void pcmcia_remove_one(struct pcmcia_device *pdev)
++{
++	dev_link_t *link = dev_to_instance(pdev);
++	struct ata_pcmcia_info *info = link->priv;
++	struct device *dev = &pdev->dev;
++
++	if (link->state & DEV_CONFIG) {
++		if (info->ndev) {
++			struct ata_host_set *host_set = dev_get_drvdata(dev);
++			ata_host_set_remove(host_set);
++			dev_set_drvdata(dev, NULL);
++		}
++		info->ndev = 0;
++		link->dev = NULL;
++
++		pcmcia_release_configuration(link->handle);
++		pcmcia_release_io(link->handle, &link->io);
++		pcmcia_release_irq(link->handle, &link->irq);
++		link->state &= ~DEV_CONFIG;
++	}
++	kfree(link->priv);
++}
++
++static int pcmcia_suspend(struct pcmcia_device *dev)
++{
++	dev_link_t *link = dev_to_instance(dev);
++
++	link->state |= DEV_SUSPEND;
++	if (link->state & DEV_CONFIG)
++		pcmcia_release_configuration(link->handle);
++
++	return 0;
++}
++
++static int pcmcia_resume(struct pcmcia_device *dev)
++{
++	dev_link_t *link = dev_to_instance(dev);
++
++	link->state &= ~DEV_SUSPEND;
++	if (DEV_OK(link))
++		pcmcia_request_configuration(link->handle, &link->conf);
++
++	return 0;
++}
++
++static struct pcmcia_device_id pcmcia_devices[] = {
++	PCMCIA_DEVICE_FUNC_ID(4),
++	PCMCIA_DEVICE_MANF_CARD(0x0007, 0x0000),	/* Hitachi */
++	PCMCIA_DEVICE_MANF_CARD(0x0032, 0x0704),
++	PCMCIA_DEVICE_MANF_CARD(0x0045, 0x0401),
++	PCMCIA_DEVICE_MANF_CARD(0x0098, 0x0000),	/* Toshiba */
++	PCMCIA_DEVICE_MANF_CARD(0x00a4, 0x002d),
++	PCMCIA_DEVICE_MANF_CARD(0x00ce, 0x0000),	/* Samsung */
++ 	PCMCIA_DEVICE_MANF_CARD(0x0319, 0x0000),	/* Hitachi */
++	PCMCIA_DEVICE_MANF_CARD(0x2080, 0x0001),
++	PCMCIA_DEVICE_MANF_CARD(0x4e01, 0x0200),	/* Lexar */
++	PCMCIA_DEVICE_PROD_ID123("Caravelle", "PSC-IDE ", "PSC000", 0x8c36137c, 0xd0693ab8, 0x2768a9f0),
++	PCMCIA_DEVICE_PROD_ID123("CDROM", "IDE", "MCD-601p", 0x1b9179ca, 0xede88951, 0x0d902f74),
++	PCMCIA_DEVICE_PROD_ID123("PCMCIA", "IDE CARD", "F1", 0x281f1c5d, 0x1907960c, 0xf7fde8b9),
++	PCMCIA_DEVICE_PROD_ID12("ARGOSY", "CD-ROM", 0x78f308dc, 0x66536591),
++	PCMCIA_DEVICE_PROD_ID12("ARGOSY", "PnPIDE", 0x78f308dc, 0x0c694728),
++	PCMCIA_DEVICE_PROD_ID12("CNF CD-M", "CD-ROM", 0x7d93b852, 0x66536591),
++	PCMCIA_DEVICE_PROD_ID12("Creative Technology Ltd.", "PCMCIA CD-ROM Interface Card", 0xff8c8a45, 0xfe8020c4),
++	PCMCIA_DEVICE_PROD_ID12("Digital Equipment Corporation.", "Digital Mobile Media CD-ROM", 0x17692a66, 0xef1dcbde),
++	PCMCIA_DEVICE_PROD_ID12("EXP", "CD+GAME", 0x6f58c983, 0x63c13aaf),
++	PCMCIA_DEVICE_PROD_ID12("EXP   ", "CD-ROM", 0x0a5c52fd, 0x66536591),
++	PCMCIA_DEVICE_PROD_ID12("EXP   ", "PnPIDE", 0x0a5c52fd, 0x0c694728),
++	PCMCIA_DEVICE_PROD_ID12("FREECOM", "PCCARD-IDE", 0x5714cbf7, 0x48e0ab8e),
++	PCMCIA_DEVICE_PROD_ID12("HITACHI", "FLASH", 0xf4f43949, 0x9eb86aae),
++	PCMCIA_DEVICE_PROD_ID12("HITACHI", "microdrive", 0xf4f43949, 0xa6d76178),
++	PCMCIA_DEVICE_PROD_ID12("IBM", "IBM17JSSFP20", 0xb569a6e5, 0xf2508753),
++	PCMCIA_DEVICE_PROD_ID12("IO DATA", "CBIDE2      ", 0x547e66dc, 0x8671043b),
++	PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDE", 0x547e66dc, 0x5c5ab149),
++	PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDEII", 0x547e66dc, 0xb3662674),
++	PCMCIA_DEVICE_PROD_ID12("LOOKMEET", "CBIDE2      ", 0xe37be2b5, 0x8671043b),
++	PCMCIA_DEVICE_PROD_ID2("NinjaATA-", 0xebe0bd79),
++	PCMCIA_DEVICE_PROD_ID12("PCMCIA", "CD-ROM", 0x281f1c5d, 0x66536591),
++	PCMCIA_DEVICE_PROD_ID12("PCMCIA", "PnPIDE", 0x281f1c5d, 0x0c694728),
++	PCMCIA_DEVICE_PROD_ID12("SHUTTLE TECHNOLOGY LTD.", "PCCARD-IDE/ATAPI Adapter", 0x4a3f0ba0, 0x322560e1),
++	PCMCIA_DEVICE_PROD_ID12("TOSHIBA", "MK2001MPL", 0xb4585a1a, 0x3489e003),
++	PCMCIA_DEVICE_PROD_ID12("WIT", "IDE16", 0x244e5994, 0x3e232852),
++	PCMCIA_DEVICE_PROD_ID1("STI Flash", 0xe4a13209),
++	PCMCIA_DEVICE_PROD_ID12("STI", "Flash 5.0", 0xbf2df18d, 0x8cb57a0e),
++	PCMCIA_MFC_DEVICE_PROD_ID12(1, "SanDisk", "ConnectPlus", 0x7a954bd9, 0x74be00c6),
++	PCMCIA_DEVICE_NULL,
++};
++
++MODULE_DEVICE_TABLE(pcmcia, pcmcia_devices);
++
++static struct pcmcia_driver pcmcia_driver = {
++	.owner		= THIS_MODULE,
++	.drv	{
++		.name		= DRV_NAME,
++	},
++	.id_table	= pcmcia_devices,
++	.probe		= pcmcia_init_one,
++	.remove		= pcmcia_remove_one,
++	.suspend	= pcmcia_suspend,
++	.resume		= pcmcia_resume,
++};
++
++static int __init pcmcia_init(void)
++{
++	return pcmcia_register_driver(&pcmcia_driver);
++}
++
++static void __exit pcmcia_exit(void)
++{
++	pcmcia_unregister_driver(&pcmcia_driver);
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for PCMCIA ATA");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++module_init(pcmcia_init);
++module_exit(pcmcia_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pdc2027x.c linux-2.6.16-rc4/drivers/scsi/pata_pdc2027x.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pdc2027x.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_pdc2027x.c	2006-01-21 16:56:47.000000000 +0000
+@@ -0,0 +1,857 @@
++/*
++ *  Promise PATA TX2/TX4/TX2000/133 IDE driver for pdc20268 to pdc20277.
++ *
++ *  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.
++ *
++ *  Ported to libata by:
++ *  Albert Lee <albertcc@tw.ibm.com> IBM Corporation
++ *
++ *  Copyright (C) 1998-2002		Andre Hedrick <andre@linux-ide.org>
++ *  Portions Copyright (C) 1999 Promise Technology, Inc.
++ *
++ *  Author: Frank Tiernan (frankt@promise.com)
++ *  Released under terms of General Public License
++ *
++ *
++ *  libata documentation is available via 'make {ps|pdf}docs',
++ *  as Documentation/DocBook/libata.*
++ *
++ *  Hardware information only available under NDA.
++ *
++ */
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi.h>
++#include <scsi/scsi_host.h>
++#include <scsi/scsi_cmnd.h>
++#include <linux/libata.h>
++#include <asm/io.h>
++
++#define DRV_NAME	"pata_pdc2027x"
++#define DRV_VERSION	"0.73"
++#undef PDC_DEBUG
++
++#ifdef PDC_DEBUG
++#define PDPRINTK(fmt, args...) printk(KERN_ERR "%s: " fmt, __FUNCTION__, ## args)
++#else
++#define PDPRINTK(fmt, args...)
++#endif
++
++enum {
++	PDC_UDMA_100		= 0,
++	PDC_UDMA_133		= 1,
++
++	PDC_100_MHZ		= 100000000,
++	PDC_133_MHZ		= 133333333,
++
++	PDC_SYS_CTL		= 0x1100,
++	PDC_ATA_CTL		= 0x1104,
++	PDC_GLOBAL_CTL		= 0x1108,
++	PDC_CTCR0		= 0x110C,
++	PDC_CTCR1		= 0x1110,
++	PDC_BYTE_COUNT		= 0x1120,
++	PDC_PLL_CTL		= 0x1202,
++};
++
++static int pdc2027x_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
++static void pdc2027x_remove_one(struct pci_dev *pdev);
++static void pdc2027x_phy_reset(struct ata_port *ap);
++static void pdc2027x_set_piomode(struct ata_port *ap, struct ata_device *adev);
++static void pdc2027x_set_dmamode(struct ata_port *ap, struct ata_device *adev);
++static void pdc2027x_post_set_mode(struct ata_port *ap);
++static int pdc2027x_check_atapi_dma(struct ata_queued_cmd *qc);
++
++/*
++ * ATA Timing Tables based on 133MHz controller clock.
++ * These tables are only used when the controller is in 133MHz clock.
++ * If the controller is in 100MHz clock, the ASIC hardware will
++ * set the timing registers automatically when "set feature" command
++ * is issued to the device. However, if the controller clock is 133MHz,
++ * the following tables must be used.
++ */
++static struct pdc2027x_pio_timing {
++	u8 value0, value1, value2;
++} pdc2027x_pio_timing_tbl [] = {
++	{ 0xfb, 0x2b, 0xac }, /* PIO mode 0 */
++	{ 0x46, 0x29, 0xa4 }, /* PIO mode 1 */
++	{ 0x23, 0x26, 0x64 }, /* PIO mode 2 */
++	{ 0x27, 0x0d, 0x35 }, /* PIO mode 3, IORDY on, Prefetch off */
++	{ 0x23, 0x09, 0x25 }, /* PIO mode 4, IORDY on, Prefetch off */
++};
++
++static struct pdc2027x_mdma_timing {
++	u8 value0, value1;
++} pdc2027x_mdma_timing_tbl [] = {
++	{ 0xdf, 0x5f }, /* MDMA mode 0 */
++	{ 0x6b, 0x27 }, /* MDMA mode 1 */
++	{ 0x69, 0x25 }, /* MDMA mode 2 */
++};
++
++static struct pdc2027x_udma_timing {
++	u8 value0, value1, value2;
++} pdc2027x_udma_timing_tbl [] = {
++	{ 0x4a, 0x0f, 0xd5 }, /* UDMA mode 0 */
++	{ 0x3a, 0x0a, 0xd0 }, /* UDMA mode 1 */
++	{ 0x2a, 0x07, 0xcd }, /* UDMA mode 2 */
++	{ 0x1a, 0x05, 0xcd }, /* UDMA mode 3 */
++	{ 0x1a, 0x03, 0xcd }, /* UDMA mode 4 */
++	{ 0x1a, 0x02, 0xcb }, /* UDMA mode 5 */
++	{ 0x1a, 0x01, 0xcb }, /* UDMA mode 6 */
++};
++
++static const struct pci_device_id pdc2027x_pci_tbl[] = {
++#ifdef ATA_ENABLE_PATA
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20268, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_100 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20269, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_133 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20270, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_100 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20271, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_133 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20275, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_133 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20276, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_133 },
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20277, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PDC_UDMA_133 },
++#endif
++	{ }	/* terminate list */
++};
++
++static struct pci_driver pdc2027x_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= pdc2027x_pci_tbl,
++	.probe			= pdc2027x_init_one,
++	.remove			= __devexit_p(pdc2027x_remove_one),
++};
++
++static struct scsi_host_template pdc2027x_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++};
++
++static struct ata_port_operations pdc2027x_pata100_ops = {
++	.port_disable		= ata_port_disable,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= pdc2027x_phy_reset,
++
++	.check_atapi_dma	= pdc2027x_check_atapi_dma,
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.eng_timeout		= ata_eng_timeout,
++	.data_xfer		= ata_mmio_data_xfer,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static struct ata_port_operations pdc2027x_pata133_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= pdc2027x_set_piomode,
++	.set_dmamode		= pdc2027x_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= pdc2027x_phy_reset,
++	.post_set_mode		= pdc2027x_post_set_mode,
++
++	.check_atapi_dma	= pdc2027x_check_atapi_dma,
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.eng_timeout		= ata_eng_timeout,
++	.data_xfer		= ata_mmio_data_xfer,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static struct ata_port_info pdc2027x_port_info[] = {
++	/* PDC_UDMA_100 */
++	{
++		.sht		= &pdc2027x_sht,
++		.host_flags	= ATA_FLAG_NO_LEGACY | ATA_FLAG_SLAVE_POSS |
++		                  ATA_FLAG_SRST | ATA_FLAG_MMIO,
++		.pio_mask	= 0x1f, /* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask	= ATA_UDMA5, /* udma0-5 */
++		.port_ops	= &pdc2027x_pata100_ops,
++	},
++	/* PDC_UDMA_133 */
++	{
++		.sht		= &pdc2027x_sht,
++		.host_flags	= ATA_FLAG_NO_LEGACY | ATA_FLAG_SLAVE_POSS |
++                        	  ATA_FLAG_SRST | ATA_FLAG_MMIO,
++		.pio_mask	= 0x1f, /* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma0-2 */
++		.udma_mask	= ATA_UDMA6, /* udma0-6 */
++		.port_ops	= &pdc2027x_pata133_ops,
++	},
++};
++
++MODULE_AUTHOR("Andre Hedrick, Frank Tiernan, Albert Lee");
++MODULE_DESCRIPTION("libata driver module for Promise PDC20268 to PDC20277");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++MODULE_DEVICE_TABLE(pci, pdc2027x_pci_tbl);
++
++/**
++ *	port_mmio - Get the MMIO address of PDC2027x extended registers
++ *	@ap: Port
++ *	@offset: offset from mmio base
++ */
++static inline void* port_mmio(struct ata_port *ap, unsigned int offset)
++{
++	return ap->host_set->mmio_base + ap->port_no * 0x100 + offset;
++}
++
++/**
++ *	dev_mmio - Get the MMIO address of PDC2027x extended registers
++ *	@ap: Port
++ *	@adev: device
++ *	@offset: offset from mmio base
++ */
++static inline void* dev_mmio(struct ata_port *ap, struct ata_device *adev, unsigned int offset)
++{
++	u8 adj = (adev->devno) ? 0x08 : 0x00;
++	return port_mmio(ap, offset) + adj;
++}
++
++/**
++ *	pdc2027x_pata_cbl_detect - Probe host controller cable detect info
++ *	@ap: Port for which cable detect info is desired
++ *
++ *	Read 80c cable indicator from Promise extended register.
++ *      This register is latched when the system is reset.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++static void pdc2027x_cbl_detect(struct ata_port *ap)
++{
++	u32 cgcr;
++
++	/* check cable detect results */
++	cgcr = readl(port_mmio(ap, PDC_GLOBAL_CTL));
++	if (cgcr & (1 << 26))
++		goto cbl40;
++
++	PDPRINTK("No cable or 80-conductor cable on port %d\n", ap->port_no);
++
++	ap->cbl = ATA_CBL_PATA80;
++	return;
++
++cbl40:
++	printk(KERN_INFO DRV_NAME ": 40-conductor cable detected on port %d\n", ap->port_no);
++	ap->cbl = ATA_CBL_PATA40;
++	ap->udma_mask &= ATA_UDMA_MASK_40C;
++}
++
++/**
++ * pdc2027x_port_enabled - Check PDC ATA control register to see whether the port is enabled.
++ * @ap: Port to check
++ */
++static inline int pdc2027x_port_enabled(struct ata_port *ap)
++{
++	return readb(port_mmio(ap, PDC_ATA_CTL)) & 0x02;
++}
++
++/**
++ *	pdc2027x_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	Probe PATA phy.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++static void pdc2027x_phy_reset(struct ata_port *ap)
++{
++	/* Check whether port enabled */
++	if (!pdc2027x_port_enabled(ap)) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++
++	pdc2027x_cbl_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	pdc2027x_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port to configure
++ *	@adev: um
++ *	@pio: PIO mode, 0 - 4
++ *
++ *	Set PIO mode for device.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++static void pdc2027x_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio = adev->pio_mode - XFER_PIO_0;
++	u32 ctcr0, ctcr1;
++
++	PDPRINTK("adev->pio_mode[%X]\n", adev->pio_mode);
++
++	/* Sanity check */
++	if (pio > 4) {
++		printk(KERN_ERR DRV_NAME ": Unknown pio mode [%d] ignored\n", pio);
++		return;
++
++	}
++
++	/* Set the PIO timing registers using value table for 133MHz */
++	PDPRINTK("Set pio regs... \n");
++
++	ctcr0 = readl(dev_mmio(ap, adev, PDC_CTCR0));
++	ctcr0 &= 0xffff0000;
++	ctcr0 |= pdc2027x_pio_timing_tbl[pio].value0 |
++		(pdc2027x_pio_timing_tbl[pio].value1 << 8);
++	writel(ctcr0, dev_mmio(ap, adev, PDC_CTCR0));
++
++	ctcr1 = readl(dev_mmio(ap, adev, PDC_CTCR1));
++	ctcr1 &= 0x00ffffff;
++	ctcr1 |= (pdc2027x_pio_timing_tbl[pio].value2 << 24);
++	writel(ctcr1, dev_mmio(ap, adev, PDC_CTCR1));
++
++	PDPRINTK("Set pio regs done\n");
++
++	PDPRINTK("Set to pio mode[%u] \n", pio);
++}
++
++/**
++ *	pdc2027x_set_dmamode - Initialize host controller PATA UDMA timings
++ *	@ap: Port to configure
++ *	@adev: um
++ *	@udma: udma mode, XFER_UDMA_0 to XFER_UDMA_6
++ *
++ *	Set UDMA mode for device.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++static void pdc2027x_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int dma_mode = adev->dma_mode;
++	u32 ctcr0, ctcr1;
++
++	if ((dma_mode >= XFER_UDMA_0) &&
++	   (dma_mode <= XFER_UDMA_6)) {
++		/* Set the UDMA timing registers with value table for 133MHz */
++		unsigned int udma_mode = dma_mode & 0x07;
++
++		if (dma_mode == XFER_UDMA_2) {
++			/*
++			 * Turn off tHOLD.
++			 * If tHOLD is '1', the hardware will add half clock for data hold time.
++			 * This code segment seems to be no effect. tHOLD will be overwritten below.
++			 */
++			ctcr1 = readl(dev_mmio(ap, adev, PDC_CTCR1));
++			writel(ctcr1 & ~(1 << 7), dev_mmio(ap, adev, PDC_CTCR1));
++		}
++
++		PDPRINTK("Set udma regs... \n");
++
++		ctcr1 = readl(dev_mmio(ap, adev, PDC_CTCR1));
++		ctcr1 &= 0xff000000;
++		ctcr1 |= pdc2027x_udma_timing_tbl[udma_mode].value0 |
++			(pdc2027x_udma_timing_tbl[udma_mode].value1 << 8) |
++			(pdc2027x_udma_timing_tbl[udma_mode].value2 << 16);
++		writel(ctcr1, dev_mmio(ap, adev, PDC_CTCR1));
++
++		PDPRINTK("Set udma regs done\n");
++
++		PDPRINTK("Set to udma mode[%u] \n", udma_mode);
++
++	} else  if ((dma_mode >= XFER_MW_DMA_0) &&
++		   (dma_mode <= XFER_MW_DMA_2)) {
++		/* Set the MDMA timing registers with value table for 133MHz */
++		unsigned int mdma_mode = dma_mode & 0x07;
++
++		PDPRINTK("Set mdma regs... \n");
++		ctcr0 = readl(dev_mmio(ap, adev, PDC_CTCR0));
++
++		ctcr0 &= 0x0000ffff;
++		ctcr0 |= (pdc2027x_mdma_timing_tbl[mdma_mode].value0 << 16) |
++			(pdc2027x_mdma_timing_tbl[mdma_mode].value1 << 24);
++
++		writel(ctcr0, dev_mmio(ap, adev, PDC_CTCR0));
++		PDPRINTK("Set mdma regs done\n");
++
++		PDPRINTK("Set to mdma mode[%u] \n", mdma_mode);
++	} else {
++		printk(KERN_ERR DRV_NAME ": Unknown dma mode [%u] ignored\n", dma_mode);
++	}
++}
++
++/**
++ *	pdc2027x_post_set_mode - Set the timing registers back to correct values.
++ *	@ap: Port to configure
++ *
++ *	The pdc2027x hardware will look at "SET FEATURES" and change the timing registers
++ *	automatically. The values set by the hardware might be incorrect, under 133Mhz PLL.
++ *	This function overwrites the possibly incorrect values set by the hardware to be correct.
++ */
++static void pdc2027x_post_set_mode(struct ata_port *ap)
++{
++	int i;
++
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *dev = &ap->device[i];
++
++		if (ata_dev_present(dev)) {
++
++			pdc2027x_set_piomode(ap, dev);
++
++			/*
++			 * Enable prefetch if the device support PIO only.
++			 */
++			if (dev->xfer_shift == ATA_SHIFT_PIO) {
++				u32 ctcr1 = readl(dev_mmio(ap, dev, PDC_CTCR1));
++				ctcr1 |= (1 << 25);
++				writel(ctcr1, dev_mmio(ap, dev, PDC_CTCR1));
++
++				PDPRINTK("Turn on prefetch\n");
++			} else {
++				pdc2027x_set_dmamode(ap, dev);
++			}
++		}
++	}
++}
++
++/**
++ *	pdc2027x_check_atapi_dma - Check whether ATAPI DMA can be supported for this command
++ *	@qc: Metadata associated with taskfile to check
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ *
++ *	RETURNS: 0 when ATAPI DMA can be used
++ *		 1 otherwise
++ */
++static int pdc2027x_check_atapi_dma(struct ata_queued_cmd *qc)
++{
++	struct scsi_cmnd *cmd = qc->scsicmd;
++	u8 *scsicmd = cmd->cmnd;
++	int rc = 1; /* atapi dma off by default */
++
++	/*
++	 * This workaround is from Promise's GPL driver.
++	 * If ATAPI DMA is used for commands not in the
++	 * following white list, say MODE_SENSE and REQUEST_SENSE,
++	 * pdc2027x might hit the irq lost problem.
++	 */
++	switch (scsicmd[0]) {
++	case READ_10:
++	case WRITE_10:
++	case READ_12:
++	case WRITE_12:
++	case READ_6:
++	case WRITE_6:
++	case 0xad: /* READ_DVD_STRUCTURE */
++	case 0xbe: /* READ_CD */
++		/* ATAPI DMA is ok */
++		rc = 0;
++		break;
++	default:
++		;
++	}
++
++	return rc;
++}
++
++/**
++ * pdc_read_counter - Read the ctr counter
++ * @probe_ent: for the port address
++ */
++
++static long pdc_read_counter(struct ata_probe_ent *probe_ent)
++{
++	long counter;
++	int retry = 1;
++	u32 bccrl, bccrh, bccrlv, bccrhv;
++
++retry:
++	bccrl = readl(probe_ent->mmio_base + PDC_BYTE_COUNT) & 0xffff;
++	bccrh = readl(probe_ent->mmio_base + PDC_BYTE_COUNT + 0x100) & 0xffff;
++	rmb();
++
++	/* Read the counter values again for verification */
++	bccrlv = readl(probe_ent->mmio_base + PDC_BYTE_COUNT) & 0xffff;
++	bccrhv = readl(probe_ent->mmio_base + PDC_BYTE_COUNT + 0x100) & 0xffff;
++	rmb();
++
++	counter = (bccrh << 15) | bccrl;
++
++	PDPRINTK("bccrh [%X] bccrl [%X]\n", bccrh,  bccrl);
++	PDPRINTK("bccrhv[%X] bccrlv[%X]\n", bccrhv, bccrlv);
++
++	/*
++	 * The 30-bit decreasing counter are read by 2 pieces.
++	 * Incorrect value may be read when both bccrh and bccrl are changing.
++	 * Ex. When 7900 decrease to 78FF, wrong value 7800 might be read.
++	 */
++	if (retry && !(bccrh == bccrhv && bccrl >= bccrlv)) {
++		retry--;
++		PDPRINTK("rereading counter\n");
++		goto retry;
++	}
++
++	return counter;
++}
++
++/**
++ * adjust_pll - Adjust the PLL input clock in Hz.
++ *
++ * @pdc_controller: controller specific information
++ * @probe_ent: For the port address
++ * @pll_clock: The input of PLL in HZ
++ */
++static void pdc_adjust_pll(struct ata_probe_ent *probe_ent, long pll_clock, unsigned int board_idx)
++{
++
++	u16 pll_ctl;
++	long pll_clock_khz = pll_clock / 1000;
++	long pout_required = board_idx? PDC_133_MHZ:PDC_100_MHZ;
++	long ratio = pout_required / pll_clock_khz;
++	int F, R;
++
++	/* Sanity check */
++	if (unlikely(pll_clock_khz < 5000L || pll_clock_khz > 70000L)) {
++		printk(KERN_ERR DRV_NAME ": Invalid PLL input clock %ldkHz, give up!\n", pll_clock_khz);
++		return;
++	}
++
++#ifdef PDC_DEBUG
++	PDPRINTK("pout_required is %ld\n", pout_required);
++
++	/* Show the current clock value of PLL control register
++	 * (maybe already configured by the firmware)
++	 */
++	pll_ctl = readw(probe_ent->mmio_base + PDC_PLL_CTL);
++
++	PDPRINTK("pll_ctl[%X]\n", pll_ctl);
++#endif
++
++	/*
++	 * Calculate the ratio of F, R and OD
++	 * POUT = (F + 2) / (( R + 2) * NO)
++	 */
++	if (ratio < 8600L) { /* 8.6x */
++		/* Using NO = 0x01, R = 0x0D */
++		R = 0x0d;
++	} else if (ratio < 12900L) { /* 12.9x */
++		/* Using NO = 0x01, R = 0x08 */
++		R = 0x08;
++	} else if (ratio < 16100L) { /* 16.1x */
++		/* Using NO = 0x01, R = 0x06 */
++		R = 0x06;
++	} else if (ratio < 64000L) { /* 64x */
++		R = 0x00;
++	} else {
++		/* Invalid ratio */
++		printk(KERN_ERR DRV_NAME ": Invalid ratio %ld, give up!\n", ratio);
++		return;
++	}
++
++	F = (ratio * (R+2)) / 1000 - 2;
++
++	if (unlikely(F < 0 || F > 127)) {
++		/* Invalid F */
++		printk(KERN_ERR DRV_NAME ": F[%d] invalid!\n", F);
++		return;
++	}
++
++	PDPRINTK("F[%d] R[%d] ratio*1000[%ld]\n", F, R, ratio);
++
++	pll_ctl = (R << 8) | F;
++
++	PDPRINTK("Writing pll_ctl[%X]\n", pll_ctl);
++
++	writew(pll_ctl, probe_ent->mmio_base + PDC_PLL_CTL);
++	readw(probe_ent->mmio_base + PDC_PLL_CTL); /* flush */
++
++	/* Wait the PLL circuit to be stable */
++	mdelay(30);
++
++#ifdef PDC_DEBUG
++	/*
++	 *  Show the current clock value of PLL control register
++	 * (maybe configured by the firmware)
++	 */
++	pll_ctl = readw(probe_ent->mmio_base + PDC_PLL_CTL);
++
++	PDPRINTK("pll_ctl[%X]\n", pll_ctl);
++#endif
++
++	return;
++}
++
++/**
++ * detect_pll_input_clock - Detect the PLL input clock in Hz.
++ * @probe_ent: for the port address
++ * Ex. 16949000 on 33MHz PCI bus for pdc20275.
++ *     Half of the PCI clock.
++ */
++static long pdc_detect_pll_input_clock(struct ata_probe_ent *probe_ent)
++{
++	u32 scr;
++	long start_count, end_count;
++	long pll_clock;
++
++	/* Read current counter value */
++	start_count = pdc_read_counter(probe_ent);
++
++	/* Start the test mode */
++	scr = readl(probe_ent->mmio_base + PDC_SYS_CTL);
++	PDPRINTK("scr[%X]\n", scr);
++	writel(scr | (0x01 << 14), probe_ent->mmio_base + PDC_SYS_CTL);
++	readl(probe_ent->mmio_base + PDC_SYS_CTL); /* flush */
++
++	/* Let the counter run for 100 ms. */
++	mdelay(100);
++
++	/* Read the counter values again */
++	end_count = pdc_read_counter(probe_ent);
++
++	/* Stop the test mode */
++	scr = readl(probe_ent->mmio_base + PDC_SYS_CTL);
++	PDPRINTK("scr[%X]\n", scr);
++	writel(scr & ~(0x01 << 14), probe_ent->mmio_base + PDC_SYS_CTL);
++	readl(probe_ent->mmio_base + PDC_SYS_CTL); /* flush */
++
++	/* calculate the input clock in Hz */
++	pll_clock = (start_count - end_count) * 10;
++
++	PDPRINTK("start[%ld] end[%ld] \n", start_count, end_count);
++	PDPRINTK("PLL input clock[%ld]Hz\n", pll_clock);
++
++	return pll_clock;
++}
++
++/**
++ * pdc_hardware_init - Initialize the hardware.
++ * @pdev: instance of pci_dev found
++ * @pdc_controller: controller specific information
++ * @pe:  for the port address
++ */
++static int pdc_hardware_init(struct pci_dev *pdev, struct ata_probe_ent *pe, unsigned int board_idx)
++{
++	long pll_clock;
++
++	/*
++	 * Detect PLL input clock rate.
++	 * On some system, where PCI bus is running at non-standard clock rate.
++	 * Ex. 25MHz or 40MHz, we have to adjust the cycle_time.
++	 * The pdc20275 controller employs PLL circuit to help correct timing registers setting.
++	 */
++	pll_clock = pdc_detect_pll_input_clock(pe);
++
++	if (pll_clock < 0) /* counter overflow? Try again. */
++		pll_clock = pdc_detect_pll_input_clock(pe);
++
++	dev_printk(KERN_INFO, &pdev->dev, "PLL input clock %ld kHz\n", pll_clock/1000);
++
++	/* Adjust PLL control register */
++	pdc_adjust_pll(pe, pll_clock, board_idx);
++
++	return 0;
++}
++
++/**
++ * pdc_ata_setup_port - setup the mmio address
++ * @port: ata ioports to setup
++ * @base: base address
++ */
++static void pdc_ata_setup_port(struct ata_ioports *port, unsigned long base)
++{
++	port->cmd_addr		=
++	port->data_addr		= base;
++	port->feature_addr	=
++	port->error_addr	= base + 0x05;
++	port->nsect_addr	= base + 0x0a;
++	port->lbal_addr		= base + 0x0f;
++	port->lbam_addr		= base + 0x10;
++	port->lbah_addr		= base + 0x15;
++	port->device_addr	= base + 0x1a;
++	port->command_addr	=
++	port->status_addr	= base + 0x1f;
++	port->altstatus_addr	=
++	port->ctl_addr		= base + 0x81a;
++}
++
++/**
++ * pdc2027x_init_one - PCI probe function
++ * Called when an instance of PCI adapter is inserted.
++ * This function checks whether the hardware is supported,
++ * initialize hardware and register an instance of ata_host_set to
++ * libata by providing struct ata_probe_ent and ata_device_add().
++ * (implements struct pci_driver.probe() )
++ *
++ * @pdev: instance of pci_dev found
++ * @ent:  matching entry in the id_tbl[]
++ */
++static int __devinit pdc2027x_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	unsigned int board_idx = (unsigned int) ent->driver_data;
++
++	struct ata_probe_ent *probe_ent = NULL;
++	unsigned long base;
++	void *mmio_base;
++	int rc;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
++
++	rc = pci_enable_device(pdev);
++	if (rc)
++		return rc;
++
++	rc = pci_request_regions(pdev, DRV_NAME);
++	if (rc)
++		goto err_out;
++
++	rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
++	if (rc)
++		goto err_out_regions;
++
++	rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
++	if (rc)
++		goto err_out_regions;
++
++	/* Prepare the probe entry */
++	probe_ent = kmalloc(sizeof(*probe_ent), GFP_KERNEL);
++	if (probe_ent == NULL) {
++		rc = -ENOMEM;
++		goto err_out_regions;
++	}
++
++	memset(probe_ent, 0, sizeof(*probe_ent));
++	probe_ent->dev = pci_dev_to_dev(pdev);
++	INIT_LIST_HEAD(&probe_ent->node);
++
++	mmio_base = ioremap(pci_resource_start(pdev, 5),
++		            pci_resource_len(pdev, 5));
++
++	if (mmio_base == NULL) {
++		rc = -ENOMEM;
++		goto err_out_free_ent;
++	}
++
++	base = (unsigned long) mmio_base;
++
++	probe_ent->sht		= pdc2027x_port_info[board_idx].sht;
++	probe_ent->host_flags	= pdc2027x_port_info[board_idx].host_flags;
++	probe_ent->pio_mask	= pdc2027x_port_info[board_idx].pio_mask;
++	probe_ent->mwdma_mask	= pdc2027x_port_info[board_idx].mwdma_mask;
++	probe_ent->udma_mask	= pdc2027x_port_info[board_idx].udma_mask;
++	probe_ent->port_ops	= pdc2027x_port_info[board_idx].port_ops;
++
++       	probe_ent->irq = pdev->irq;
++       	probe_ent->irq_flags = SA_SHIRQ;
++	probe_ent->mmio_base = mmio_base;
++
++	pdc_ata_setup_port(&probe_ent->port[0], base + 0x17c0);
++	probe_ent->port[0].bmdma_addr = base + 0x1000;
++	pdc_ata_setup_port(&probe_ent->port[1], base + 0x15c0);
++	probe_ent->port[1].bmdma_addr = base + 0x1008;
++
++	probe_ent->n_ports = 2;
++
++	pci_set_master(pdev);
++	//pci_enable_intx(pdev);
++
++	/* initialize adapter */
++	if (pdc_hardware_init(pdev, probe_ent, board_idx) != 0)
++		goto err_out_free_ent;
++
++	ata_device_add(probe_ent);
++	kfree(probe_ent);
++
++	return 0;
++
++err_out_free_ent:
++	kfree(probe_ent);
++err_out_regions:
++	pci_release_regions(pdev);
++err_out:
++	pci_disable_device(pdev);
++	return rc;
++}
++
++/**
++ * pdc2027x_remove_one - Called to remove a single instance of the
++ * adapter.
++ *
++ * @dev: The PCI device to remove.
++ * FIXME: module load/unload not working yet
++ */
++static void __devexit pdc2027x_remove_one(struct pci_dev *pdev)
++{
++	ata_pci_remove_one(pdev);
++}
++
++/**
++ * pdc2027x_init - Called after this module is loaded into the kernel.
++ */
++static int __init pdc2027x_init(void)
++{
++	return pci_register_driver(&pdc2027x_pci_driver);
++}
++
++/**
++ * pdc2027x_exit - Called before this module unloaded from the kernel
++ */
++static void __exit pdc2027x_exit(void)
++{
++	pci_unregister_driver(&pdc2027x_pci_driver);
++}
++
++module_init(pdc2027x_init);
++module_exit(pdc2027x_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pdc202xx_old.c linux-2.6.16-rc4/drivers/scsi/pata_pdc202xx_old.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_pdc202xx_old.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_pdc202xx_old.c	2006-02-20 13:19:57.000000000 +0000
+@@ -0,0 +1,428 @@
++/*
++ * pata_pdc202xx_old.c 	- SL82C105 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based in part on linux/drivers/ide/pci/pdc202xx_old.c
++ *
++ * Initial revision
++ *
++ * TODO:
++ *	Channel interlock/reset on both required ?
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_pdc202xx_old"
++#define DRV_VERSION "0.1.2"
++
++static void pdc2024x_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++
++static void pdc2026x_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u16 cis;
++	
++	pci_read_config_word(pdev, 0x50, &cis);
++	if (cis & (1 << (10 + ap->hard_port_no)))
++		ap->cbl = ATA_CBL_PATA80;
++	else
++		ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++
++/**
++ *	pdc_configure_piomode	-	set chip PIO timing
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *	@pio: PIO mode
++ *
++ *	Called to do the PIO mode setup. Our timing registers are shared
++ *	so a configure_dmamode call will undo any work we do here and vice
++ *	versa
++ */
++ 
++static void pdc_configure_piomode(struct ata_port *ap, struct ata_device *adev, int pio)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int port = 0x60 + 4 * ap->hard_port_no + 2 * adev->devno;
++	static u16 pio_timing[5] = {
++		0x0913, 0x050C , 0x0308, 0x0206, 0x0104
++	};
++	u8 r_ap, r_bp;
++
++	/* FIFO, IORDY ? */	
++	pci_read_config_byte(pdev, port, &r_ap);
++	pci_read_config_byte(pdev, port + 1, &r_bp);
++	r_ap &= ~0x0F;
++	r_bp &= ~0x07;
++	r_ap |= (pio_timing[pio] >> 8);
++	r_bp |= (pio_timing[pio] & 0xFF);
++	pci_write_config_byte(pdev, port, r_ap);
++	pci_write_config_byte(pdev, port + 1, r_bp);
++}
++
++/**
++ *	pdc_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. Our timing registers are shared
++ *	but we want to set the PIO timing by default.
++ */
++ 
++static void pdc_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	pdc_configure_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
++}
++
++/**
++ *	pdc_configure_dmamode	-	set DMA mode in chip
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Load DMA cycle times into the chip ready for a DMA transfer
++ *	to occur.
++ */
++ 
++static void pdc_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int port = 0x60 + 4 * ap->hard_port_no + 2 * adev->devno;
++	static u8 udma_timing[6][2] = {
++		{ 0x60, 0x03 },	/* 33 Mhz Clock */
++		{ 0x40, 0x02 },
++		{ 0x20, 0x01 },
++		{ 0x40, 0x02 },	/* 66 Mhz Clock */
++		{ 0x20, 0x01 },
++		{ 0x20, 0x01 }		
++	};
++	u8 r_bp, r_cp;
++	
++	pci_read_config_byte(pdev, port + 1, &r_bp);
++	pci_read_config_byte(pdev, port + 2, &r_cp);
++	
++	r_bp &= ~0xF0;
++	r_cp &= ~0x0F;
++	
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		int speed = adev->dma_mode - XFER_UDMA_0;
++		r_bp |= udma_timing[speed][0];
++		r_cp |= udma_timing[speed][1];
++		
++	} else {
++		int speed = adev->dma_mode - XFER_MW_DMA_0;
++		r_bp |= 0x60;
++		r_cp |= (5 - speed);
++	}
++	pci_write_config_byte(pdev, port + 1, r_bp);
++	pci_write_config_byte(pdev, port + 2, r_cp);
++	
++}
++
++/**
++ *	pdc2026x_reset_engine	-	Reset the DMA engine
++ *	@ap: ATA interface
++ *
++ *	Reset the 2026x DMA engine. This is not something we want to do,
++ *	and we need to figure out how to serialize this across dual channel
++ *	devices if it is neccessary.
++ *
++ *	FIXME: Do we need to reset the other interface too ?
++ */
++ 
++static void pdc2026x_reset_engine(struct ata_port *ap)
++{
++	unsigned long ctrl = ap->host_set->ports[0]->ioaddr.bmdma_addr + 0x1F;
++
++	u8 val = inb(ctrl);
++	outb(val | 0x10, ctrl);
++	mdelay(100);
++	outb(val & ~0x10, ctrl);
++	mdelay(2000);	/* Check - seems to be overkill, plus if needed 
++			   redo locking */
++	/* Need to fix up speed info at this point */
++}
++
++/**
++ *	pdc2026x_bmdma_start		-	DMA engine begin
++ *	@qc: ATA command
++ *
++ *	In UDMA3 or higher we have to clock switch for the duration of the
++ *	DMA transfer sequence.
++ */
++ 
++static void pdc2026x_bmdma_start(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	int sel66 = ap->hard_port_no ? 0x08: 0x02;
++	/* The clock bits are in the same register for both channels */
++	unsigned long clock = ap->host_set->ports[0]->ioaddr.bmdma_addr + 0x11;
++	
++	/* Check we keep host_set level locking here */
++	if (adev->dma_mode >= XFER_UDMA_2)
++		outb(inb(clock) | sel66, clock);
++	else
++		outb(inb(clock) & ~sel66, clock);
++	/* The DMA clocks may have been trashed by a reset. FIXME: make conditional 
++	   and move to qc_issue ? */
++	pdc_set_dmamode(ap, qc->dev);
++	/* Activate DMA */	
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	pdc2026x_bmdma_end		-	DMA engine stop
++ *	@qc: ATA command
++ *
++ *	After a DMA completes we need to put the clock back to 33MHz for
++ *	PIO timings.
++ */
++ 
++static void pdc2026x_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	int sel66 = ap->hard_port_no ? 0x08: 0x02;
++	/* The clock bits are in the same register for both channels */
++	unsigned long clock = ap->host_set->ports[0]->ioaddr.bmdma_addr + 0x11;
++	
++	/* FIXME: Review LBA48 code in ide/pci driver */
++	ata_bmdma_stop(qc);
++	/* Check we keep host_set level locking here */
++	/* Flip back to 33Mhz for PIO */
++	if (adev->dma_mode >= XFER_UDMA_2)
++		outb(inb(clock) & ~sel66, clock);
++}
++
++/**
++ *	pdc2026x_eng_timeout		-	command timeout
++ *	@qc: command that timed out
++ *
++ *	When the PDC2026x times out hit the controller over the head
++ *	with a hammer before continuing. The reset unfortunately also
++ *	resets the timing registers so we must reprogram these.
++ */
++ 
++static void pdc2026x_eng_timeout(struct ata_port *ap)
++{
++	int i;
++	
++	/* Perform libata side housekeeping */
++	ata_eng_timeout(ap);
++	
++	/* Reset the controller */
++	pdc2026x_reset_engine(ap);
++	
++	/* Reprogram the device timings */
++	for (i = 0; i < 2; i++) {
++		struct ata_device *adev = &ap->device[i];
++		if (ata_dev_present(adev)) {
++			pdc_set_piomode(ap, adev);
++			if (adev->dma_mode)
++				pdc_set_dmamode(ap, adev);
++		}
++	}
++}
++
++/**
++ *	pdc2026x_dev_config	-	device setup hook
++ *	@ap: ATA port
++ *	@adev: newly found device
++ *
++ *	Perform chip specific early setup. We need to lock the transfer
++ *	sizes to 8bit to avoid making the state engine on the 2026x cards
++ *	barf.
++ */
++ 
++static void pdc2026x_dev_config(struct ata_port *ap, struct ata_device *adev)
++{
++	/* We cannot blindly set 256 as the core code may already
++	   have picked a lower limit */
++	   
++	if(ap->host->max_sectors > 256) {
++		ap->host->max_sectors = 256;
++		ap->host->hostt->max_sectors = 256;
++	}
++	adev->flags |= ATA_DFLAG_LOCK_SECTORS;
++}
++
++static struct scsi_host_template pdc_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations pdc2024x_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= pdc_set_piomode,
++	.set_dmamode	= pdc_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= pdc2024x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations pdc2026x_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= pdc_set_piomode,
++	.set_dmamode	= pdc_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++	.dev_config	= pdc2026x_dev_config,
++
++	.phy_reset	= pdc2026x_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= pdc2026x_bmdma_start,
++	.bmdma_stop	= pdc2026x_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= pdc2026x_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static int pdc_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info[3] = {
++		{
++			.sht = &pdc_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA2,
++			.port_ops = &pdc2024x_port_ops
++		}, 
++		{
++			.sht = &pdc_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA4,
++			.port_ops = &pdc2026x_port_ops
++		},
++		{
++			.sht = &pdc_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = ATA_UDMA5,
++			.port_ops = &pdc2026x_port_ops
++		}
++		
++	};
++	static struct ata_port_info *port_info[2];
++
++	port_info[0] = port_info[1] = &info[id->driver_data];
++	
++	if (dev->device == PCI_DEVICE_ID_PROMISE_20265) {
++		struct pci_dev *bridge = dev->bus->self;
++		/* Don't grab anything behind a Promise I2O RAID */
++		if (bridge && bridge->vendor == PCI_VENDOR_ID_INTEL) {
++			if( bridge->device == PCI_DEVICE_ID_INTEL_I960)
++				return -ENODEV;
++			if( bridge->device == PCI_DEVICE_ID_INTEL_I960RM)
++				return -ENODEV;
++		}
++	}
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static struct pci_device_id pdc[] = {
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20246, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20262, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20263, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20265, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ PCI_VENDOR_ID_PROMISE, PCI_DEVICE_ID_PROMISE_20267, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ 0, },
++};
++
++static struct pci_driver pdc_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= pdc,
++	.probe 		= pdc_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init pdc_init(void)
++{
++	return pci_register_driver(&pdc_pci_driver);
++}
++
++
++static void __exit pdc_exit(void)
++{
++	pci_unregister_driver(&pdc_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Promise 2024x and 20262-20267");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, pdc);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(pdc_init);
++module_exit(pdc_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_qdi.c linux-2.6.16-rc4/drivers/scsi/pata_qdi.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_qdi.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_qdi.c	2006-02-15 15:08:22.000000000 +0000
+@@ -0,0 +1,370 @@
++/*
++ *    pata_qdi.c - QDI VLB ATA controllers
++ *	(C) 2006 Red Hat <alan@redhat.com>
++ *
++ * This driver mostly exists as a proof of concept for non PCI devices under libata.
++ * While the QDI6580 was 'neat' in 1993 it is no longer terribly useful.
++ *
++ * Tuning code written from the documentation at
++ * http://www.ryston.cz/petr/vlb/qd6500.html
++ * http://www.ryston.cz/petr/vlb/qd6580.html
++ *
++ * Probe code based on drivers/ide/legacy/qd65xx.c
++ * Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
++ * Samuel Thibault <samuel.thibault@fnac.net>
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_qdi"
++#define DRV_VERSION "0.2"
++
++#define NR_HOST 4	/* Two 6580s */
++
++struct qdi_data {
++	unsigned long timing;
++	u8 clock[2];
++	u8 last;
++	int fast;
++	
++};
++
++static struct ata_host_set *qdi_host[NR_HOST];
++static struct qdi_data qdi_data[NR_HOST];
++static int nr_qdi_host = 0;
++
++static void qdi6500_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct ata_timing t;
++	struct qdi_data *qdi = ap->host_set->private_data;
++	int active, recovery;
++	u8 timing;
++
++	/* Get the timing data in cycles */
++	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
++	
++	if (qdi->fast) {
++		active = 8 - FIT(t.active, 1, 8);
++		recovery = 18 - FIT(t.recover, 3, 18);
++	} else {
++		active = 9 - FIT(t.active, 2, 9);
++		recovery = 15 - FIT(t.recover, 0, 15);
++	}
++	timing = (recovery << 4) | active | 0x08;
++	
++	qdi->clock[adev->devno] = timing;
++
++	outb(timing, qdi->timing);	
++}
++
++static void qdi6580_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct ata_timing t;
++	struct qdi_data *qdi = ap->host_set->private_data;
++	int active, recovery;
++	u8 timing;
++
++	/* Get the timing data in cycles */
++	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
++	
++	if (qdi->fast) {
++		active = 8 - FIT(t.active, 1, 8);
++		recovery = 18 - FIT(t.recover, 3, 18);
++	} else {
++		active = 9 - FIT(t.active, 2, 9);
++		recovery = 15 - FIT(t.recover, 0, 15);
++	}
++	timing = (recovery << 4) | active | 0x08;
++	
++	qdi->clock[adev->devno] = timing;
++
++	outb(timing, qdi->timing);
++	
++	/* Clear the FIFO */
++	if (adev->class != ATA_DEV_ATA)
++		outb(0x5F, (qdi->timing & 0xFFF0) + 3);
++}
++
++/**
++ *	qdi_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings.
++ */
++
++static int qdi_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	struct qdi_data *qdi = ap->host_set->private_data;
++
++	if (qdi->clock[adev->devno] != qdi->last) {
++		if (adev->pio_mode) {
++			qdi->last = qdi->clock[adev->devno];
++			outb(qdi->clock[adev->devno], qdi->timing);
++		}
++	}
++	return ata_qc_issue_prot(qc);
++}
++
++static void qdi_data_xfer(struct ata_port *ap, struct ata_device *adev, unsigned char *buf, unsigned int buflen, int write_data)
++{
++	int slop = buflen & 3;
++	
++	if (ata_id_has_dword_io(adev->id)) {
++		if (write_data)
++			outsl(ap->ioaddr.data_addr, buf, buflen >> 2);
++		else
++			insl(ap->ioaddr.data_addr, buf, buflen >> 2);
++	
++		if (unlikely(slop)) {
++			u32 pad;
++			if (write_data) {
++				memcpy(&pad, buf + buflen - slop, slop);
++				outl(le32_to_cpu(pad), ap->ioaddr.data_addr);
++			} else {
++				pad = cpu_to_le16(inl(ap->ioaddr.data_addr));
++				memcpy(buf + buflen - slop, &pad, slop);
++			}
++		}
++	} else
++		ata_pio_data_xfer(ap, adev, buf, buflen, write_data);
++}
++
++static struct scsi_host_template qdi_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations qdi6500_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= qdi6500_set_piomode,
++
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= qdi_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= qdi_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations qdi6580_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= qdi6580_set_piomode,
++
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= qdi_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= qdi_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	qdi_init_one		-	attach a qdi interface
++ *	@type: Type to display
++ *	@io: I/O port start
++ *	@irq: interrupt line
++ *	@fast: True if on a > 33Mhz VLB
++ *
++ *	Register an ISA bus IDE interface. Such interfaces are PIO and we
++ *	assume do not support IRQ sharing.
++ */
++ 
++static __init int qdi_init_one(unsigned long port, int type, unsigned long io, int irq, int fast)
++{
++	struct ata_probe_ent ae;
++	int ret;
++
++	unsigned long ctrl = io + 0x206;
++
++	/*
++	 *	Fill in a probe structure first of all
++	 */
++	
++	memset(&ae, 0, sizeof(struct ata_probe_ent));
++	INIT_LIST_HEAD(&ae.node);
++	ae.dev = NULL;
++	
++	if (type == 6580) {
++		ae.port_ops = &qdi6580_port_ops;
++		ae.pio_mask = 0x1F;
++	} else {
++		ae.port_ops = &qdi6500_port_ops;
++		ae.pio_mask = 0x07;	/* Actually PIO3 !IORDY is possible */
++	}
++	
++	ae.sht = &qdi_sht;
++	ae.n_ports = 1;
++	ae.irq = irq;
++	ae.irq_flags = 0;
++	ae.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_IRQ_MASK;
++	ae.port[0].cmd_addr = io;
++	ae.port[0].altstatus_addr = ctrl;
++	ae.port[0].ctl_addr =	ctrl;
++	ata_std_ports(&ae.port[0]);
++
++	/*
++	 *	Hook in a private data structure per channel
++	 */
++	ae.private_data = &qdi_data[nr_qdi_host];
++
++	qdi_data[nr_qdi_host].timing = port;
++	qdi_data[nr_qdi_host].fast = fast;
++
++	printk(KERN_INFO DRV_NAME": qd%d at 0x%lx.\n", type, io);
++	ret = ata_device_add(&ae);
++	if (ret == 0)
++		return -ENODEV;
++		
++	qdi_host[nr_qdi_host++] = ae.host_set;
++	return 0;	
++}
++
++/**
++ *	qdi_init		-	attach qdi interfaces
++ *
++ *	Attach qdi IDE interfaces by scanning the ports it may occupy.
++ */
++ 
++static __init int qdi_init(void)
++{
++	unsigned long flags;
++	unsigned long qd_port[2] = { 0x30, 0xB0 };
++	unsigned long ide_port[2] = { 0x170, 0x1F0 };
++	int ide_irq[2] = { 14, 15 };
++	int ct = 0;
++	int i;
++	
++	/*
++ 	 *	Check each possible QD65xx base address
++	 */
++	
++	for (i = 0; i < 2; i++) {
++		unsigned long port = qd_port[i];
++		u8 r, res;
++		
++		
++		if (request_region(port, 2, "pata_qdi")) {
++			/* Check for a card */
++			local_irq_save(flags);
++			r = inb_p(port);
++			outb_p(0x19, port);
++			res = inb_p(port);
++			outb_p(r, port);
++			local_irq_restore(flags);
++		
++			/* Fail */
++			if (res == 0x19)
++			{
++				release_region(port, 2);
++				continue;
++			}
++			
++			/* Passes the presence test */
++			r = inb_p(port + 1);	/* Check port agrees with port set */
++			if ((r & 2) >> 1 != i) {
++				release_region(port, 2);
++				continue;
++			}
++
++			/* Check card type */			
++			if ((r & 0xF0) == 0xC0) {
++				/* QD6500: single channel */
++				if (r & 8) {
++					/* Disabled ? */
++					release_region(port, 2);
++					continue;
++				}
++				ct += qdi_init_one(port, 6500, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04);
++			}
++			if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
++				/* QD6580: dual channel */
++				if (!request_region(port + 2 , 2, "pata_qdi"))
++				{
++					release_region(port, 2);
++					continue;
++				}
++				res = inb(port + 3);
++				if (res & 1) {
++					/* Single channel mode */
++					ct += qdi_init_one(port, 6580, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04);
++				} else {
++					/* Dual channel mode */
++					ct += qdi_init_one(port, 6580, 0x1F0, 14, r & 0x04);
++					ct += qdi_init_one(port + 2, 6580, 0x170, 15, r & 0x04);
++				}
++			}
++		}
++	}
++	if (ct != 0)
++		return 0;
++	return -ENODEV;
++}
++
++static __exit void qdi_exit(void)
++{
++	int i;
++
++	for (i = 0; i < nr_qdi_host; i++) {
++		ata_host_set_remove(qdi_host[i]);
++		/* Free the control resource. The 6580 dual channel has the resources
++		 * claimed as a pair of 2 byte resources so we need no special cases...
++		 */
++		release_region(qdi_data[i].timing, 2);
++	}	
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for qdi ATA");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++module_init(qdi_init);
++module_exit(qdi_exit);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_radisys.c linux-2.6.16-rc4/drivers/scsi/pata_radisys.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_radisys.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_radisys.c	2006-02-17 15:31:12.000000000 +0000
+@@ -0,0 +1,321 @@
++/*
++ *    pata_radisys.c - Intel PATA/SATA controllers
++ *
++ *	(C) 2006 Red Hat <alan@redhat.com>
++ *
++ *    Some parts based on ata_piix.c by Jeff Garzik and others.
++ *
++ *    A PIIX relative, this device has a single ATA channel and no
++ *    slave timings, SITRE or PPE. In that sense it is a close relative
++ *    of the original PIIX. It does however support UDMA 33/66 per channel
++ *    although no other modes/timings. Also lacking is 32bit I/O on the ATA
++ *    port.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_radisys"
++#define DRV_VERSION	"0.2"
++
++/**
++ *	radisys_pata_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void radisys_pata_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA80;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	radisys_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: um
++ *
++ *	Set PIO mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void radisys_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	unsigned int pio	= adev->pio_mode - XFER_PIO_0;
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	u16 idetm_data;
++	int control = 0;
++
++	/*
++	 *	See Intel Document 298600-004 for the timing programing rules
++	 *	for PIIX/ICH. Note that the early PIIX does not have the slave
++	 *	timing port at 0x44. The Radisys is a relative of the PIIX
++	 *	but not the same so be careful.
++	 */
++
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },	/* Check me */
++			    { 0, 0 },
++			    { 1, 1 },
++			    { 2, 2 },
++			    { 3, 3 }, };
++
++	if (pio > 0)
++		control |= 1;	/* TIME1 enable */
++	if (ata_pio_need_iordy(adev))
++		control |= 2;	/* IE IORDY */
++
++	pci_read_config_word(dev, 0x40, &idetm_data);
++
++	/* Enable IE and TIME as appropriate. Clear the other
++	   drive timing bits */
++	idetm_data &= 0xCCCC;
++	idetm_data |= (control << (4 * adev->devno));
++	idetm_data |= (timings[pio][0] << 12) |
++			(timings[pio][1] << 8);
++	pci_write_config_word(dev, 0x40, idetm_data);
++
++	/* Track which port is configured */
++	ap->private_data = adev;
++}
++
++/**
++ *	radisys_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *	@isich: True if the device is an ICH and has IOCFG registers
++ *
++ *	Set MWDMA mode for device, in host controller PCI config space.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void radisys_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *dev	= to_pci_dev(ap->host_set->dev);
++	u16 idetm_data;
++	u8 udma_enable;
++	
++	static const	 /* ISP  RTC */
++	u8 timings[][2]	= { { 0, 0 },
++			    { 0, 0 },
++			    { 1, 1 },
++			    { 2, 2 },
++			    { 3, 3 }, };
++
++	/*
++	 * MWDMA is driven by the PIO timings. We must also enable
++	 * IORDY unconditionally.
++	 */
++
++	pci_read_config_word(dev, 0x40, &idetm_data);
++	pci_read_config_byte(dev, 0x48, &udma_enable);
++
++	if (adev->dma_mode < XFER_UDMA_0) {
++		unsigned int mwdma	= adev->dma_mode - XFER_MW_DMA_0;
++		const unsigned int needed_pio[3] = {
++			XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
++		};
++		int pio = needed_pio[mwdma] - XFER_PIO_0;
++		int control = 3;	/* IORDY|TIME0 */
++
++		/* If the drive MWDMA is faster than it can do PIO then
++		   we must force PIO0 for PIO cycles. */
++
++		if (adev->pio_mode < needed_pio[mwdma])
++			control = 1;
++
++		/* Mask out the relevant control and timing bits we will load. Also
++		   clear the other drive TIME register as a precaution */
++		   
++		idetm_data &= 0xCCCC;
++		idetm_data |= control << (4 * adev->devno);
++		idetm_data |= (timings[pio][0] << 12) | (timings[pio][1] << 8);
++
++		udma_enable &= ~(1 << adev->devno);
++	} else {
++		u8 udma_mode;
++		
++		/* UDMA66 on. It isn't clear from the documentation whether
++		   UDMA 33 and 66 are switchable via register 0x4A */
++		
++		pci_read_config_byte(dev, 0x4A, &udma_mode);
++		
++		if (adev->xfer_mode == XFER_UDMA_2)
++			udma_mode &= ~ (1 << adev->devno);
++		else /* UDMA 4 */
++			udma_mode |= (1 << adev->devno);
++			
++		pci_write_config_byte(dev, 0x4A, udma_mode);
++		
++		udma_enable |= (1 << adev->devno);
++	}
++	pci_write_config_word(dev, 0x40, idetm_data);
++	pci_write_config_byte(dev, 0x48, udma_enable);
++
++	/* Track which port is configured */
++	ap->private_data = adev;
++}
++
++/**
++ *	radisys_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary. Our logic also clears TIME0/TIME1 for the other device so
++ *	that, even if we get this wrong, cycles to the other device will
++ *	be made PIO0.
++ */
++
++static int radisys_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++
++	if (adev != ap->private_data) {
++		/* UDMA timing is not shared */
++		if (adev->dma_mode < XFER_UDMA_0) {
++			if (adev->dma_mode)
++				radisys_set_dmamode(ap, adev);
++			else if (adev->pio_mode)
++				radisys_set_piomode(ap, adev);
++		}
++	}
++	return ata_qc_issue_prot(qc);
++}
++
++
++static struct scsi_host_template radisys_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations radisys_pata_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= radisys_set_piomode,
++	.set_dmamode		= radisys_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= radisys_pata_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= radisys_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++
++/**
++ *	radisys_init_one - Register PIIX ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in radisys_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.  We probe for combined mode (sigh),
++ *	and then hand over control to libata, for it to do the rest.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int radisys_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	static struct ata_port_info info = {
++		.sht		= &radisys_sht,
++		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask	= 0x1f,	/* pio0-4 */
++		.mwdma_mask	= 0x07, /* mwdma1-2 */
++		.udma_mask	= 0x14, /* UDMA33/66 only */
++		.port_ops	= &radisys_pata_ops,
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id radisys_pci_tbl[] = {
++	{ 0x1331, 0x8201, PCI_ANY_ID, PCI_ANY_ID, },
++	{ }	/* terminate list */
++};
++
++static struct pci_driver radisys_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= radisys_pci_tbl,
++	.probe			= radisys_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init radisys_init(void)
++{
++	return pci_register_driver(&radisys_pci_driver);
++}
++
++static void __exit radisys_exit(void)
++{
++	pci_unregister_driver(&radisys_pci_driver);
++}
++
++
++module_init(radisys_init);
++module_exit(radisys_exit);
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("SCSI low-level driver for Radisys R82600 controllers");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, radisys_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_rz1000.c linux-2.6.16-rc4/drivers/scsi/pata_rz1000.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_rz1000.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_rz1000.c	2006-02-16 15:38:18.000000000 +0000
+@@ -0,0 +1,183 @@
++/*
++ *  RZ1000/1001 driver based upon
++ *
++ *  linux/drivers/ide/pci/rz1000.c	Version 0.06	January 12, 2003
++ *  Copyright (C) 1995-1998  Linus Torvalds & author (see below)
++ *  Principal Author:  mlord@pobox.com (Mark Lord)
++ *
++ *  See linux/MAINTAINERS for address of current maintainer.
++ *
++ *  This file provides support for disabling the buggy read-ahead
++ *  mode of the RZ1000 IDE chipset, commonly used on Intel motherboards.
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"rz1000"
++#define DRV_VERSION	"0.01"
++
++static void rz1000_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	rz1000_set_mode		-	mode setting function
++ *	@ap: ATA interface
++ *
++ *	Use a non standard set_mode function. We don't want to be tuned. We
++ *	would prefer to be BIOS generic but for the fact our hardware is
++ *	whacked out.
++ */
++ 
++static void rz1000_set_mode(struct ata_port *ap)
++{
++	int i;
++
++	for (i = 0; i < ATA_MAX_DEVICES; i++) {
++		struct ata_device *dev = &ap->device[i];
++		if (ata_dev_present(dev)) {
++			/* We don't really care */
++			dev->pio_mode = XFER_PIO_0;
++			dev->xfer_mode = XFER_PIO_0;
++			dev->xfer_shift = ATA_SHIFT_PIO;
++			dev->flags |= ATA_DFLAG_PIO;
++		}
++	}
++}
++
++
++static struct scsi_host_template rz1000_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations rz1000_port_ops = {
++	.set_mode	= rz1000_set_mode,
++	
++	.port_disable	= ata_port_disable,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= rz1000_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	rz1000_init_one - Register RZ1000 ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in rz1000_pci_tbl matching with @pdev
++ *
++ *	Configure an RZ1000 interface. This doesn't require much special
++ *	handling except that we *MUST* kill the chipset readahead or the
++ *	user may experience data corruption.
++ */
++
++static int rz1000_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	struct ata_port_info *port_info[2];
++	u16 reg;
++	static struct ata_port_info info = {
++		.sht = &rz1000_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.port_ops = &rz1000_port_ops
++	};
++	
++	if (!printed_version++)
++		printk(KERN_DEBUG DRV_NAME " version " DRV_VERSION "\n");
++
++	/* Be exceptionally paranoid as we must be sure to apply the fix */
++	if (pci_read_config_word(pdev, 0x40, &reg) != 0)
++		goto fail;
++	reg &= 0xDFFF;
++	if (pci_write_config_word(pdev, 0x40, reg) != 0)
++		goto fail;
++	printk(KERN_INFO DRV_NAME ": disabled chipset readahead.\n");
++
++	port_info[0] = &info;
++	port_info[1] = &info;
++	return ata_pci_init_one(pdev, port_info, 2);
++fail:
++	printk(KERN_ERR DRV_NAME ": failed to disable read-ahead on chipset..\n");
++	/* Not safe to use so skip */
++	return -ENODEV;
++}
++
++static struct pci_device_id pata_rz1000[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_PCTECH, PCI_DEVICE_ID_PCTECH_RZ1000), },
++	{ PCI_DEVICE(PCI_VENDOR_ID_PCTECH, PCI_DEVICE_ID_PCTECH_RZ1001), },
++	{ 0, },
++};
++
++static struct pci_driver rz1000_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= pata_rz1000,
++	.probe 		= rz1000_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++
++static int __init rz1000_init(void)
++{
++	return pci_register_driver(&rz1000_pci_driver);
++}
++
++static void __exit rz1000_exit(void)
++{
++	pci_unregister_driver(&rz1000_pci_driver);
++}
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for RZ1000 PCI ATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, pata_rz1000);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(rz1000_init);
++module_exit(rz1000_exit);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sc1200.c linux-2.6.16-rc4/drivers/scsi/pata_sc1200.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sc1200.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_sc1200.c	2006-02-16 15:46:11.000000000 +0000
+@@ -0,0 +1,286 @@
++/*
++ * New ATA layer SC1200 driver		Alan Cox <alan@redhat.com>
++ *
++ * TODO: Mode selection filtering
++ * TODO: Can't enable second channel until ATA core has serialize
++ * TODO: Needs custom DMA cleanup code
++ *
++ * Based very heavily on
++ *
++ * linux/drivers/ide/pci/sc1200.c		Version 0.91	28-Jan-2003
++ *
++ * Copyright (C) 2000-2002		Mark Lord <mlord@pobox.com>
++ * May be copied or modified under the terms of the GNU General Public License
++ *
++ * Development of this chipset driver was funded
++ * by the nice folks at National Semiconductor.
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
++ * 
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME	"sc1200"
++#define DRV_VERSION	"0.2"
++
++#define SC1200_REV_A	0x00
++#define SC1200_REV_B1	0x01
++#define SC1200_REV_B3	0x02
++#define SC1200_REV_C1	0x03
++#define SC1200_REV_D1	0x04
++
++/**
++ *	sc1200_clock	-	PCI clock
++ *
++ *	Return the PCI bus clocking for the SC1200 chipset configuration
++ *	in use. We return 0 for 33MHz 1 for 48MHz and 2 for 66Mhz
++ */
++ 
++static int sc1200_clock(void)
++{
++	/* Magic registers that give us the chipset data */
++	u8 chip_id = inb(0x903C);
++	u8 silicon_rev = inb(0x903D);
++	u16 pci_clock;
++	
++	if (chip_id == 0x04 && silicon_rev < SC1200_REV_B1)
++		return 0;	/* 33 MHz mode */
++
++	/* Clock generator configuration 0x901E its 8/9 are the PCI clocking
++	   0/3 is 33Mhz 1 is 48 2 is 66 */
++
++	pci_clock = inw(0x901E);
++	pci_clock >>= 8;
++	pci_clock &= 0x03;
++	if (pci_clock == 3)
++		pci_clock = 0;
++	return pci_clock;
++}
++
++/**
++ *	sc1200_set_piomode		-	PIO setup
++ *	@ap: ATA interface
++ *	@adev: device on the interface
++ *
++ *	Set our PIO requirements. This is fairly simple on the SC1200
++ */
++ 
++static void sc1200_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u32 pio_timings[4][5] = {
++		{0x00009172, 0x00012171, 0x00020080, 0x00032010, 0x00040010},	// format0  33Mhz
++		{0xd1329172, 0x71212171, 0x30200080, 0x20102010, 0x00100010},	// format1, 33Mhz
++		{0xfaa3f4f3, 0xc23232b2, 0x513101c1, 0x31213121, 0x10211021},	// format1, 48Mhz
++		{0xfff4fff4, 0xf35353d3, 0x814102f1, 0x42314231, 0x11311131}	// format1, 66Mhz
++	};
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 format;
++	unsigned int reg = 0x40 + 0x10 * ap->hard_port_no;
++	int mode = adev->pio_mode - XFER_PIO_0;
++	
++	pci_read_config_dword(pdev, reg + 4, &format);
++	format >>= 31;
++	format += sc1200_clock();
++	pci_write_config_dword(pdev, reg + 8 * adev->devno, 
++				pio_timings[format][mode]);
++}
++
++/**
++ *	sc1200_set_dmamode		-	DMA timing setup
++ *	@ap: ATA interface
++ *	@adev: Device being configured
++ *
++ *	We cannot mix MWDMA and UDMA without reloading timings each switch
++ *	master to slave.
++ */
++ 
++static void sc1200_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u32 udma_timing[3][3] = {
++		{ 0x00921250, 0x00911140, 0x00911030 },
++		{ 0x00932470, 0x00922260, 0x00922140 },
++		{ 0x009436A1, 0x00933481, 0x00923261 }
++	};
++	
++	static u32 mwdma_timing[3][3] = {
++		{ 0x00077771, 0x00012121, 0x00002020 },
++		{ 0x000BBBB2, 0x00024241, 0x00013131 },
++		{ 0x000FFFF3, 0x00035352, 0x00015151 }
++	};
++	
++	int clock = sc1200_clock();
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	unsigned int reg = 0x40 + 0x10 * ap->hard_port_no;
++	int mode = adev->dma_mode;
++	u32 format;
++
++	if (mode >= XFER_UDMA_0)
++		format = udma_timing[clock][mode - XFER_UDMA_0];
++	else
++		format = mwdma_timing[clock][mode - XFER_MW_DMA_0];
++	
++	if (adev->devno == 0) {
++		u32 timings;
++		
++		pci_read_config_dword(pdev, reg + 4, &timings);
++		timings &= 0x80000000UL;
++		timings |= format;
++		pci_write_config_dword(pdev, reg + 4, timings);
++	} else
++		pci_write_config_dword(pdev, reg + 12, format);
++}
++
++/**
++ *	sc1200_qc_issue_prot	-	command issue
++ *	@qc: command pending
++ *
++ *	Called when the libata layer is about to issue a command. We wrap
++ *	this interface so that we can load the correct ATA timings if
++ *	neccessary.  Specifically we have a problem that there is only
++ *	one MWDMA/UDMA bit.
++ */
++
++static int sc1200_qc_issue_prot(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++	struct ata_device *adev = qc->dev;
++	struct ata_device *prev = ap->private_data;
++
++	/* See if the DMA settings could be wrong */
++	if (adev->dma_mode != 0 && adev != prev && prev != NULL) {
++		/* Maybe, but do the channels match MWDMA/UDMA ? */
++		if ((adev->dma_mode >= XFER_UDMA_0 && prev->dma_mode < XFER_UDMA_0) ||
++		    (adev->dma_mode < XFER_UDMA_0 && prev->dma_mode >= XFER_UDMA_0))
++		    	/* Switch the mode bits */
++		    	sc1200_set_dmamode(ap, adev);
++	}
++
++	return ata_qc_issue_prot(qc);
++}
++
++static struct scsi_host_template sc1200_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations sc1200_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= sc1200_set_piomode,
++	.set_dmamode	= sc1200_set_dmamode,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= sc1200_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	sc1200_init_one		-	Initialise an SC1200
++ *	@dev: PCI device
++ *	@id: Entry in match table
++ *
++ *	Just throw the needed data at the libata helper and it does all
++ *	our work.
++ */
++ 
++static int sc1200_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &sc1200_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x07,
++		.port_ops = &sc1200_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	
++	/* Can't enable port 2 yet, see top comments */
++	return ata_pci_init_one(dev, port_info, 1);
++}
++
++static struct pci_device_id sc1200[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SCx200_IDE), },
++	{ 0, },
++};
++
++static struct pci_driver sc1200_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= sc1200,
++	.probe 		= sc1200_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init sc1200_init(void)
++{
++	return pci_register_driver(&sc1200_pci_driver);
++}
++
++
++static void __exit sc1200_exit(void)
++{
++	pci_unregister_driver(&sc1200_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox, Mark Lord");
++MODULE_DESCRIPTION("low-level driver for the NS/AMD SC1200");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, sc1200);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(sc1200_init);
++module_exit(sc1200_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_serverworks.c linux-2.6.16-rc4/drivers/scsi/pata_serverworks.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_serverworks.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_serverworks.c	2006-02-16 15:37:31.000000000 +0000
+@@ -0,0 +1,586 @@
++/*
++ * ata-serverworks.c 	- Serverworks PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon
++ *
++ * serverworks.c
++ * 
++ * Copyright (C) 1998-2000 Michel Aubry
++ * Copyright (C) 1998-2000 Andrzej Krzysztofowicz
++ * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
++ * Portions copyright (c) 2001 Sun Microsystems
++ *
++ *
++ * RCC/ServerWorks IDE driver for Linux
++ *
++ *   OSB4: `Open South Bridge' IDE Interface (fn 1)
++ *         supports UDMA mode 2 (33 MB/s)
++ *
++ *   CSB5: `Champion South Bridge' IDE Interface (fn 1)
++ *         all revisions support UDMA mode 4 (66 MB/s)
++ *         revision A2.0 and up support UDMA mode 5 (100 MB/s)
++ *
++ *         *** The CSB5 does not provide ANY register ***
++ *         *** to detect 80-conductor cable presence. ***
++ *
++ *   CSB6: `Champion South Bridge' IDE Interface (optional: third channel)
++ *
++ * Documentation:
++ *	Available under NDA only. Errata info very hard to get.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "serverworks"
++#define DRV_VERSION "0.1.1"
++
++#define SVWKS_CSB5_REVISION_NEW	0x92 /* min PCI_REVISION_ID for UDMA5 (A2.0) */
++#define SVWKS_CSB6_REVISION	0xa0 /* min PCI_REVISION_ID for UDMA4 (A1.0) */
++
++/* Seagate Barracuda ATA IV Family drives in UDMA mode 5
++ * can overrun their FIFOs when used with the CSB5 */
++
++static const char *csb_bad_ata100[] = {
++	"ST320011A",
++	"ST340016A",
++	"ST360021A",
++	"ST380021A",
++	NULL
++};
++
++/**
++ *	dell_cable	-	Dell serverworks cable detection
++ *	@ap: ATA port to do cable detect
++ *
++ *	Dell hide the 40/80 pin select for their interfaces in the top two
++ *	bits of the subsystem ID. 
++ */
++ 
++static int dell_cable(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	if (pdev->subsystem_device & (1 << (ap->hard_port_no + 14)))
++		return ATA_CBL_PATA80;
++	return ATA_CBL_PATA40;
++}
++
++/**
++ *	sun_cable	-	Sun Cobalt 'Alpine' cable detection
++ *	@ap: ATA port to do cable select
++ *
++ *	Cobalt CSB5 IDE hides the 40/80pin in the top two bits of the
++ *	subsystem ID the same as dell. We could use one function but we may
++ *	need to extend the Dell one in future
++ */
++ 
++static int sun_cable(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	
++	if (pdev->subsystem_device & (1 << (ap->hard_port_no + 14)))
++		return ATA_CBL_PATA80;
++	return ATA_CBL_PATA40;
++}
++
++/**
++ *	osb4_cable	-	OSB4 cable detect
++ *	@ap: ATA port to check
++ *
++ *	The OSB4 isn't UDMA66 capable so this is easy
++ */
++
++static int osb4_cable(struct ata_port *ap) {
++	return ATA_CBL_PATA40;
++}
++
++/**
++ *	csb4_cable	-	CSB5/6 cable detect
++ *	@ap: ATA port to check
++ *
++ *	Serverworks default arrangement is to use the drive side detection
++ *	only.
++ */
++
++static int csb_cable(struct ata_port *ap) {
++	return ATA_CBL_PATA80;
++}
++
++struct sv_cable_table {
++	int device;
++	int subvendor;
++	int (*cable_detect)(struct ata_port *ap);
++};
++
++/*
++ *	Note that we don't copy the old serverworks code because the old
++ *	code contains obvious mistakes
++ */
++ 
++static struct sv_cable_table cable_detect[] = {
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_VENDOR_ID_DELL, dell_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB6IDE, PCI_VENDOR_ID_DELL, dell_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_VENDOR_ID_SUN,  sun_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_OSB4, PCI_ANY_ID, osb4_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_ANY_ID, csb_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB6IDE, PCI_ANY_ID, csb_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2, PCI_ANY_ID, csb_cable },
++	{ PCI_DEVICE_ID_SERVERWORKS_HT1000IDE, PCI_ANY_ID, csb_cable },
++	{ }
++};
++
++/**
++ *	serverworks_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection according to the device and subvendor 
++ *	identifications
++ */
++ 
++static int serverworks_cable_detect(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct sv_cable_table *cb = cable_detect;
++
++	while(cb->device) {
++		if (cb->device == pdev->device && 
++			(cb->subvendor == pdev->subsystem_vendor ||
++			 cb->subvendor == PCI_ANY_ID)) {
++			 return cb->cable_detect(ap);
++		}
++		cb++;
++	}
++	BUG();
++}
++
++static void serverworks_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = serverworks_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	serverworks_is_csb	-	Check for CSB or OSB
++ *	@pdev: PCI device to check
++ *
++ *	Returns true if the device being checked is known to be a CSB
++ *	series device.
++ */
++ 
++static u8 serverworks_is_csb(struct pci_dev *pdev)
++{
++	switch (pdev->device) {
++		case PCI_DEVICE_ID_SERVERWORKS_CSB5IDE:
++		case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE:
++		case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2:
++		case PCI_DEVICE_ID_SERVERWORKS_HT1000IDE:
++			return 1;
++		default:
++			break;
++	}
++	return 0;
++}
++
++/**
++ *	serverworks_osb4_filter	-	mode selection filter
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Filter the offered modes for the device to apply controller
++ *	specific rules. OSB4 requires no UDMA for disks due to a FIFO
++ *	bug we hit.
++ */
++ 
++static unsigned int serverworks_osb4_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++	if (adev->class == ATA_DEV_ATA)
++		return 0;
++	return mask;
++}
++
++
++/**
++ *	serverworks_csb_filter	-	mode selection filter
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Check the blacklist and disable UDMA5 if matched
++ */
++
++static unsigned int serverworks_csb_filter(const struct ata_port *ap, struct ata_device *adev, unsigned int mask, int shift)
++{
++	const char *p;
++	char model_num[40];
++	int len, i;
++
++	/* Disk, UDMA */	
++	if (shift != ATA_SHIFT_UDMA)
++		return mask;
++	if (adev->class != ATA_DEV_ATA)
++		return mask;
++
++	/* Actually do need to check */
++	ata_dev_id_string(adev->id, model_num, ATA_ID_PROD_OFS, sizeof(model_num));
++	/* Precuationary - why not do this in the libata core ?? */
++	
++	len = strlen(model_num);
++	while ((len > 0) && (model_num[len - 1] == ' ')) {
++		len--;
++		model_num[len] = 0;
++	}
++
++	for(i = 0; (p = csb_bad_ata100[i]) != NULL; i++) {
++		if (!strncmp(p, model_num, len))
++			return mask & 0x1F;
++	}
++	return mask;
++}
++
++
++/**
++ *	serverworks_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the OSB4/CSB5 timing registers for PIO. The PIO register
++ *	load is done as a simple lookup.
++ */
++static void serverworks_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u8 pio_mode[] = { 0x5d, 0x47, 0x34, 0x22, 0x20 };
++	int offset = 1 + 2 * ap->hard_port_no - adev->devno;
++	int devbits = (2 * ap->hard_port_no + adev->devno) * 4;
++	u16 csb5_pio;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int pio = adev->pio_mode - XFER_PIO_0;
++
++	pci_write_config_byte(pdev, 0x40 + offset, pio_mode[pio]);
++	
++	/* The OSB4 just requires the timing but the CSB series want the
++	   mode number as well */
++	if (serverworks_is_csb(pdev)) {
++		pci_read_config_word(pdev, 0x4A, &csb5_pio);
++		csb5_pio &= ~(0x0F << devbits);
++		pci_write_config_byte(pdev, 0x4A, csb5_pio | (pio << devbits));
++	}
++}
++
++/**
++ *	serverworks_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the MWDMA/UDMA modes for the serverworks OSB4/CSB5
++ *	chipset. The MWDMA mode values are pulled from a lookup table
++ *	while the chipset uses mode number for UDMA.
++ */
++
++static void serverworks_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u8 dma_mode[] = { 0x77, 0x21, 0x20 };
++	int offset = 1 + 2 * ap->hard_port_no - adev->devno;
++	int devbits = (2 * ap->hard_port_no + adev->devno);
++	u8 ultra;
++	u8 ultra_cfg;
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++
++	pci_read_config_byte(pdev, 0x54, &ultra_cfg);
++
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		pci_write_config_byte(pdev, 0x44 + offset,  0x20);
++
++		pci_read_config_byte(pdev, 0x56 + ap->hard_port_no, &ultra);
++		ultra &= ~(0x0F << (ap->hard_port_no * 4));
++		ultra |= (adev->dma_mode - XFER_UDMA_0)
++					<< (ap->hard_port_no * 4);
++		pci_write_config_byte(pdev, 0x56 + ap->hard_port_no, ultra);
++
++		ultra_cfg |=  (1 << devbits);
++	} else {
++		pci_write_config_byte(pdev, 0x44 + offset, 
++			dma_mode[adev->dma_mode - XFER_MW_DMA_0]);
++		ultra_cfg &= ~(1 << devbits);
++	}
++	pci_write_config_byte(pdev, 0x54, ultra_cfg);
++}
++
++static struct scsi_host_template serverworks_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations serverworks_osb4_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= serverworks_set_piomode,
++	.set_dmamode	= serverworks_set_dmamode,
++	.mode_filter	= serverworks_osb4_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= serverworks_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++	
++	.irq_handler	= ata_interrupt,
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static struct ata_port_operations serverworks_csb_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= serverworks_set_piomode,
++	.set_dmamode	= serverworks_set_dmamode,
++	.mode_filter	= serverworks_csb_filter,
++	
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= serverworks_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++	
++	.irq_handler	= ata_interrupt,
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++static int serverworks_fixup_osb4(struct pci_dev *pdev)
++{
++	u32 reg;
++	struct pci_dev *isa_dev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS,
++		  PCI_DEVICE_ID_SERVERWORKS_OSB4, NULL);
++	if (isa_dev) {
++		pci_read_config_dword(isa_dev, 0x64, &reg);
++		reg &= ~0x00002000; /* disable 600ns interrupt mask */
++		if (!(reg & 0x00004000))
++			printk(KERN_DEBUG DRV_NAME ": UDMA not BIOS enabled.\n");
++		reg |=  0x00004000; /* enable UDMA/33 support */
++		pci_write_config_dword(isa_dev, 0x64, reg);
++		pci_dev_put(isa_dev);
++		return 0;
++	}
++	printk(KERN_WARNING "ata_serverworks: Unable to find bridge.\n");
++	return -ENODEV;
++}
++
++static int serverworks_fixup_csb(struct pci_dev *pdev)
++{
++	u8 rev;
++	u8 btr;
++	
++	pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
++
++	/* Third Channel Test */
++	if (!(PCI_FUNC(pdev->devfn) & 1)) {
++		struct pci_dev * findev = NULL;
++		u32 reg4c = 0;
++		findev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS,
++			PCI_DEVICE_ID_SERVERWORKS_CSB5, NULL);
++		if (findev) {
++			pci_read_config_dword(findev, 0x4C, &reg4c);
++			reg4c &= ~0x000007FF;
++			reg4c |=  0x00000040;
++			reg4c |=  0x00000020;
++			pci_write_config_dword(findev, 0x4C, reg4c);
++			pci_dev_put(findev);
++		}
++	} else {
++		struct pci_dev * findev = NULL;
++		u8 reg41 = 0;
++
++		findev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS,
++				PCI_DEVICE_ID_SERVERWORKS_CSB6, NULL);
++		if (findev) {
++			pci_read_config_byte(findev, 0x41, &reg41);
++			reg41 &= ~0x40;
++			pci_write_config_byte(findev, 0x41, reg41);
++			pci_dev_put(findev);
++		}
++	}
++	/* setup the UDMA Control register
++	 *
++	 * 1. clear bit 6 to enable DMA
++	 * 2. enable DMA modes with bits 0-1
++	 * 	00 : legacy
++	 * 	01 : udma2
++	 * 	10 : udma2/udma4
++	 * 	11 : udma2/udma4/udma5
++	 */
++	pci_read_config_byte(pdev, 0x5A, &btr);
++	btr &= ~0x40;
++	if (!(PCI_FUNC(pdev->devfn) & 1))
++		btr |= 0x2;
++	else
++		btr |= (rev >= SVWKS_CSB5_REVISION_NEW) ? 0x3 : 0x2;
++	pci_write_config_byte(pdev, 0x5A, btr);
++	
++	return btr;
++}
++
++static void serverworks_fixup_ht1000(struct pci_dev *pdev)
++{
++	u8 btr;
++	/* Setup HT1000 SouthBridge Controller - Single Channel Only */
++	pci_read_config_byte(pdev, 0x5A, &btr);
++	btr &= ~0x40;
++	btr |= 0x3;
++	pci_write_config_byte(pdev, 0x5A, btr);
++}
++
++
++static int serverworks_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	int ports = 2;
++	static struct ata_port_info info[4] = {
++		{ /* OSB4 */
++			.sht = &serverworks_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x07,
++			.port_ops = &serverworks_osb4_port_ops
++		}, { /* OSB4 no UDMA */
++			.sht = &serverworks_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x00,
++			.port_ops = &serverworks_osb4_port_ops
++		}, { /* CSB5 */
++			.sht = &serverworks_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x1f,
++			.port_ops = &serverworks_csb_port_ops
++		}, { /* CSB5 - later revisions*/
++			.sht = &serverworks_sht,
++			.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++			.pio_mask = 0x1f,
++			.mwdma_mask = 0x07,
++			.udma_mask = 0x3f,
++			.port_ops = &serverworks_csb_port_ops
++		}
++	};
++	static struct ata_port_info *port_info[2];
++	struct ata_port_info *devinfo = &info[id->driver_data];
++	
++	/* Force master latency timer to 64 PCI clocks */
++	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x40);
++
++	/* OSB4 : South Bridge and IDE */
++	if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_OSB4IDE) {
++		/* Select non UDMA capable OSB4 if we can't do fixups */
++		if ( serverworks_fixup_osb4(pdev) < 0)
++			devinfo = &info[1];
++	}
++	/* setup CSB5/CSB6 : South Bridge and IDE option RAID */
++	else if ((pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB5IDE) ||
++		 (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE) ||
++		 (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2)) {
++		 
++		 /* If the returned btr is the newer revision then
++		    select the right info block */
++		 if (serverworks_fixup_csb(pdev) == 3)
++		 	devinfo = &info[3];
++		 	
++		/* Is this the 3rd channel CSB6 IDE ? */
++		if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2)
++			ports = 1;
++	}
++	/* setup HT1000E */
++	else if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_HT1000IDE)
++		serverworks_fixup_ht1000(pdev);
++		
++	if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB5IDE)
++		ata_pci_clear_simplex(pdev);
++		
++	port_info[0] = port_info[1] = devinfo;
++	return ata_pci_init_one(pdev, port_info, ports);
++}
++
++static struct pci_device_id serverworks[] = {
++	{ PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_OSB4IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB6IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_HT1000IDE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
++	{ 0, },
++};
++
++static struct pci_driver serverworks_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= serverworks,
++	.probe 		= serverworks_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init serverworks_init(void)
++{
++	return pci_register_driver(&serverworks_pci_driver);
++}
++
++
++static void __exit serverworks_exit(void)
++{
++	pci_unregister_driver(&serverworks_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Serverworks OSB4/CSB5/CSB6");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, serverworks);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(serverworks_init);
++module_exit(serverworks_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sil680.c linux-2.6.16-rc4/drivers/scsi/pata_sil680.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sil680.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_sil680.c	2006-02-16 15:28:00.000000000 +0000
+@@ -0,0 +1,368 @@
++/*
++ * pata_sil680.c 	- SIL680 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon
++ *
++ * linux/drivers/ide/pci/siimage.c		Version 1.07	Nov 30, 2003
++ *
++ * Copyright (C) 2001-2002	Andre Hedrick <andre@linux-ide.org>
++ * Copyright (C) 2003		Red Hat <alan@redhat.com>
++ *
++ *  May be copied or modified under the terms of the GNU General Public License
++ *
++ *  Documentation publically available.
++ *
++ *	If you have strange problems with nVidia chipset systems please
++ *	see the SI support documentation and update your system BIOS
++ *	if neccessary
++ *
++ * TODO
++ *	If we know all our devices are LBA28 (or LBA28 sized)  we could use
++ *	the command fifo mode.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_sil680"
++#define DRV_VERSION "0.2.1"
++
++/**
++ *	sil680_selreg		-	return register base
++ *	@hwif: interface
++ *	@r: config offset
++ *
++ *	Turn a config register offset into the right address in either
++ *	PCI space or MMIO space to access the control register in question
++ *	Thankfully this is a configuration operation so isnt performance
++ *	criticial.
++ */
++
++static unsigned long sil680_selreg(struct ata_port *ap, int r)
++{
++	unsigned long base = 0xA0 + r;
++	base += (ap->hard_port_no << 4);
++	return base;
++}
++
++/**
++ *	sil680_seldev		-	return register base
++ *	@hwif: interface
++ *	@r: config offset
++ *
++ *	Turn a config register offset into the right address in either
++ *	PCI space or MMIO space to access the control register in question
++ *	including accounting for the unit shift.
++ */
++
++static unsigned long sil680_seldev(struct ata_port *ap, struct ata_device *adev, int r)
++{
++	unsigned long base = 0xA0 + r;
++	base += (ap->hard_port_no << 4);
++	base |= adev->devno ? 2 : 0;
++	return base;
++}
++
++
++/**
++ *	sil680_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection. The SIL680 stores this in PCI config
++ *	space for us.
++ */
++
++static int sil680_cable_detect(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	unsigned long addr = sil680_selreg(ap, 0);
++	u8 ata66;
++	pci_read_config_byte(pdev, addr, &ata66);
++	if (ata66 & 1)
++		return ATA_CBL_PATA80;
++	else
++		return ATA_CBL_PATA40;
++}
++
++/**
++ *	sil680_bus_reset	-	reset the SIL680 bus
++ *	@ap: ATA port to reset
++ *
++ *	Perform the SIL680 housekeeping when doing an ATA bus reset
++ */
++
++static void sil680_bus_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	unsigned long addr = sil680_selreg(ap, 0);
++	u8 reset;
++
++	pci_read_config_byte(pdev, addr, &reset);
++	pci_write_config_byte(pdev, addr, reset | 0x03);
++	udelay(25);
++	pci_write_config_byte(pdev, addr, reset);
++	ata_bus_reset(ap);
++}
++
++static void sil680_phy_reset(struct ata_port *ap)
++{
++	ap->cbl = sil680_cable_detect(ap);
++	sil680_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	sil680_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the SIL680 registers for PIO mode. Note that the task speed
++ *	registers are shared between the devices so we must pick the lowest
++ *	mode for command work.
++ */
++
++static void sil680_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u16 speed_p[5] = { 0x328A, 0x2283, 0x1104, 0x10C3, 0x10C1 };
++	static u16 speed_t[5] = { 0x328A, 0x1281, 0x1281, 0x10C3, 0x10C1 };
++
++	unsigned long tfaddr = sil680_selreg(ap, 0x02);
++	unsigned long addr = sil680_seldev(ap, adev, 0x04);
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	int pio = adev->pio_mode - XFER_PIO_0;
++	int lowest_pio = pio;
++	u16 reg;
++	
++	struct ata_device *pair = ata_dev_pair(ap, adev);
++
++	if (pair != NULL) {
++		if (adev->pio_mode > pair->pio_mode)
++			lowest_pio = pair->pio_mode - XFER_PIO_0;
++	}
++	
++	pci_write_config_word(pdev, addr, speed_p[pio]);
++	pci_write_config_word(pdev, tfaddr, speed_t[lowest_pio]);
++
++	pci_read_config_word(pdev, tfaddr-2, &reg);
++	reg &= ~0x0200;			/* Clear IORDY */
++	if (ata_pio_need_iordy(adev))
++		reg |= 0x0200;		/* Enable IORDY */
++	pci_write_config_word(pdev, tfaddr-2, reg);
++}
++
++/**
++ *	sil680_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Program the MWDMA/UDMA modes for the sil680 k
++ *	chipset. The MWDMA mode values are pulled from a lookup table
++ *	while the chipset uses mode number for UDMA. 
++ */
++
++static void sil680_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	static u8 ultra_table[2][7] = {
++		{ 0x0C, 0x07, 0x05, 0x04, 0x02, 0x01, 0xFF },	/* 100MHz */
++		{ 0x0F, 0x0B, 0x07, 0x05, 0x03, 0x02, 0x01 },	/* 133Mhz */
++	};
++	static u16 dma_table[3] = { 0x2208, 0x10C2, 0x10C1 };
++
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	unsigned long ma = sil680_seldev(ap, adev, 0x08);
++	unsigned long ua = sil680_seldev(ap, adev, 0x0C);
++	unsigned long addr_mask = 0x80 + 4 * ap->hard_port_no;
++	int port_shift = adev->devno * 4;
++	u8 scsc, mode;
++	u16 multi, ultra;
++
++	pci_read_config_byte(pdev, 0x8A, &scsc);
++	pci_read_config_byte(pdev, addr_mask, &mode);
++	pci_read_config_word(pdev, ma, &multi);
++	pci_read_config_word(pdev, ua, &ultra);
++
++	/* Mask timing bits */
++	ultra &= ~0x3F;
++	mode &= ~(0x03 << port_shift);
++
++	/* Extract scsc */
++	scsc = (scsc & 0x30) ? 1: 0;
++
++	if (adev->dma_mode >= XFER_UDMA_0) {
++		multi = 0x10C1;
++		ultra |= ultra_table[scsc][adev->dma_mode - XFER_UDMA_0];
++		mode |= (0x03 << port_shift);
++	} else {
++		multi = dma_table[adev->dma_mode - XFER_MW_DMA_0];
++		mode |= (0x02 << port_shift);
++	}
++	pci_write_config_byte(pdev, addr_mask, mode);
++	pci_write_config_word(pdev, ma, multi);
++	pci_write_config_word(pdev, ua, ultra);
++}
++
++static struct scsi_host_template sil680_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations sil680_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= sil680_set_piomode,
++	.set_dmamode	= sil680_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= sil680_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int sil680_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &sil680_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7f,
++		.port_ops = &sil680_port_ops
++	};
++	static struct ata_port_info info_slow = {
++		.sht = &sil680_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &sil680_port_ops
++	};
++	static struct ata_port_info *port_info[2] = {&info, &info};
++	static int printed_version;
++	u32 class_rev	= 0;
++	u8 tmpbyte	= 0;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
++
++        pci_read_config_dword(pdev, PCI_CLASS_REVISION, &class_rev);
++        class_rev &= 0xff;
++        /* FIXME: double check */
++	pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, (class_rev) ? 1 : 255);
++
++	pci_write_config_byte(pdev, 0x80, 0x00);
++	pci_write_config_byte(pdev, 0x84, 0x00);
++	pci_read_config_byte(pdev, 0x8A, &tmpbyte);
++	switch(tmpbyte & 0x30) {
++		case 0x00:
++			/* 133 clock attempt to force it on */
++			pci_write_config_byte(pdev, 0x8A, tmpbyte|0x10);
++		case 0x30:
++			/* if clocking is disabled */
++			/* 133 clock attempt to force it on */
++			pci_write_config_byte(pdev, 0x8A, tmpbyte & ~0x20);
++		case 0x10:
++			/* 133 already */
++			break;
++		case 0x20:
++			/* BIOS set PCI x2 clocking */
++			break;
++	}
++
++	pci_read_config_byte(pdev,   0x8A, &tmpbyte);
++	if ((tmpbyte & 0x30) == 0)
++		port_info[0] = port_info[1] = &info_slow;
++
++	pci_write_config_byte(pdev,  0xA1, 0x72);
++	pci_write_config_word(pdev,  0xA2, 0x328A);
++	pci_write_config_dword(pdev, 0xA4, 0x62DD62DD);
++	pci_write_config_dword(pdev, 0xA8, 0x43924392);
++	pci_write_config_dword(pdev, 0xAC, 0x40094009);
++	pci_write_config_byte(pdev,  0xB1, 0x72);
++	pci_write_config_word(pdev,  0xB2, 0x328A);
++	pci_write_config_dword(pdev, 0xB4, 0x62DD62DD);
++	pci_write_config_dword(pdev, 0xB8, 0x43924392);
++	pci_write_config_dword(pdev, 0xBC, 0x40094009);
++
++	switch(tmpbyte & 0x30) {
++		case 0x00: printk(KERN_INFO "sil680: 100MHz clock.\n");break;
++		case 0x10: printk(KERN_INFO "sil680: 133MHz clock.\n");break;
++		case 0x20: printk(KERN_INFO "sil680: Using PCI clock.\n");break;
++		/* This last case is _NOT_ ok */
++		case 0x30: printk(KERN_ERR "sil680: Clock disabled ?\n");
++			return -EIO;
++	}
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id sil680[] = {
++	{ PCI_DEVICE(PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_SII_680), },
++	{ 0, },
++};
++
++static struct pci_driver sil680_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= sil680,
++	.probe 		= sil680_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init sil680_init(void)
++{
++	return pci_register_driver(&sil680_pci_driver);
++}
++
++
++static void __exit sil680_exit(void)
++{
++	pci_unregister_driver(&sil680_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for SI680 PATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, sil680);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(sil680_init);
++module_exit(sil680_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sis.c linux-2.6.16-rc4/drivers/scsi/pata_sis.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sis.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_sis.c	2006-02-16 15:36:13.000000000 +0000
+@@ -0,0 +1,982 @@
++/*
++ *    pata_sis.c - SiS ATA driver
++ *
++ *	(C) 2005 Red Hat <alan@redhat.com>
++ *
++ *    Based upon linux/drivers/ide/pci/sis5513.c
++ * Copyright (C) 1999-2000	Andre Hedrick <andre@linux-ide.org>
++ * Copyright (C) 2002		Lionel Bouton <Lionel.Bouton@inet6.fr>, Maintainer
++ * Copyright (C) 2003		Vojtech Pavlik <vojtech@suse.cz>
++ * SiS Taiwan		: for direct support and hardware.
++ * Daniela Engert	: for initial ATA100 advices and numerous others.
++ * John Fremlin, Manfred Spraul, Dave Morgan, Peter Kjellerstedt	:
++ *			  for checking code correctness, providing patches.
++ * Original tests and design on the SiS620 chipset.
++ * ATA100 tests and design on the SiS735 chipset.
++ * ATA16/33 support from specs
++ * ATA133 support for SiS961/962 by L.C. Chang <lcchang@sis.com.tw>
++ *
++ *
++ *	TODO
++ *	Check MWDMA on drives that don't support MWDMA speed pio cycles ?
++ *	More Testing
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <linux/device.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/ata.h>
++
++#define DRV_NAME	"pata_sis"
++#define DRV_VERSION	"0.1"
++
++struct sis_chipset {
++	u16 device;			/* PCI host ID */
++	struct ata_port_info *info;	/* Info block */
++	/* Probably add family, cable detect type etc here to clean
++	   up code later */
++};
++
++/**
++ *	sis_133_cable_detect	-	check for 40/80 pin
++ *	@ap: Port
++ *
++ *	Perform cable detection for the later UDMA133 capable
++ *	SiS chipset.
++ */
++ 
++static int sis_133_cable_detect(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u16 tmp;
++	
++	pci_read_config_word(pdev, 0x50 + 2 * ap->hard_port_no, &tmp);
++	if (tmp & 0x8000)
++		return ATA_CBL_PATA40;
++	return ATA_CBL_PATA80;
++}
++
++/**
++ *	sis_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_133_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits sis_enable_bits[] = {
++		{ 0x4aU, 1U, 0x02UL, 0x02UL },	/* port 0 */
++		{ 0x4aU, 1U, 0x04UL, 0x04UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &sis_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = sis_133_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++
++/**
++ *	sis_66_cable_detect	-	check for 40/80 pin
++ *	@ap: Port
++ *
++ *	Perform cable detection on the UDMA66, UDMA100 and early UDMA133
++ *	SiS IDE controllers.
++ */
++ 
++static int sis_66_cable_detect(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 tmp;
++	
++	pci_read_config_byte(pdev, 0x48, &tmp);
++	tmp >>= ap->hard_port_no;
++	if (tmp & 0x10)
++		return ATA_CBL_PATA40;
++	return ATA_CBL_PATA80;
++}
++
++/**
++ *	sis_66_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_66_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits sis_enable_bits[] = {
++		{ 0x4aU, 1U, 0x02UL, 0x02UL },	/* port 0 */
++		{ 0x4aU, 1U, 0x04UL, 0x04UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &sis_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = sis_66_cable_detect(ap);
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++
++/**
++ *	sis_old_phy_reset - Probe specified port on PATA host controller
++ *	@ap: Port to probe
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_old_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits sis_enable_bits[] = {
++		{ 0x4aU, 1U, 0x02UL, 0x02UL },	/* port 0 */
++		{ 0x4aU, 1U, 0x04UL, 0x04UL },	/* port 1 */
++	};
++
++	if (!pci_test_config_bits(pdev, &sis_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	sis_set_fifo	-	Set RWP fifo bits for this device
++ *	@ap: Port
++ *	@adev: Device
++ *
++ *	SIS chipsets implement prefetch/postwrite bits for each device
++ *	on both channels. This functionality is not ATAPI compatible and
++ *	must be configured according to the class of device present
++ */
++ 
++static void sis_set_fifo(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u8 reg4b;
++	u8 mask = 0x11;
++	
++	mask <<= (2 * ap->hard_port_no);
++	mask <<= adev->devno;
++	
++	pci_read_config_byte(pdev, 0x4B, &reg4b);
++	reg4b &= ~mask;
++	
++	/* Enable for ATA (disk) only */
++	if (adev->class == ATA_DEV_ATA)
++		reg4b |= mask;
++	pci_write_config_byte(pdev, 0x4B, reg4b);
++}
++
++/**
++ *	sis_old_set_piomode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring for.
++ *
++ *	Set PIO mode for device, in host controller PCI config space. This
++ *	function handles PIO set up for all chips that are pre ATA100 and
++ *	also early ATA100 devices.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_old_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int port = 0x40 + 4 * ap->hard_port_no +  2 * adev->devno;
++	u8 t1, t2;
++	int speed = adev->pio_mode - XFER_PIO_0;
++	
++	const u8 active[]   = { 0x00, 0x07, 0x04, 0x03, 0x01 };
++	const u8 recovery[] = { 0x00, 0x06, 0x04, 0x03, 0x03 };
++	
++	sis_set_fifo(ap, adev);
++	
++	pci_read_config_byte(pdev, port, &t1);
++	pci_read_config_byte(pdev, port + 1, &t2);
++	
++	t1 &= ~0x0F;	/* Clear active/recovery timings */
++	t2 &= ~0x07;
++	
++	t1 |= active[speed];
++	t2 |= recovery[speed];
++	
++	pci_write_config_byte(pdev, port, t1);
++	pci_write_config_byte(pdev, port + 1, t2);
++}
++
++/**
++ *	sis_100_set_pioode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring for.
++ *
++ *	Set PIO mode for device, in host controller PCI config space. This
++ *	function handles PIO set up for ATA100 devices and early ATA133.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_100_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int port = 0x40 + 4 * ap->hard_port_no +  2 * adev->devno;
++	int speed = adev->pio_mode - XFER_PIO_0;
++	
++	const u8 actrec[] = { 0x00, 0x67, 0x44, 0x33, 0x31 };
++	
++	sis_set_fifo(ap, adev);
++	
++	pci_write_config_byte(pdev, port, actrec[speed]);
++}
++
++/**
++ *	sis_133_set_pioode - Initialize host controller PATA PIO timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device we are configuring for.
++ *
++ *	Set PIO mode for device, in host controller PCI config space. This
++ *	function handles PIO set up for the later ATA133 devices.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_133_set_piomode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int port = 0x40;
++	u32 t1;
++	u32 reg54;
++	int speed = adev->pio_mode - XFER_PIO_0;
++
++	const u32 timing100[] = {
++		0x28269000,	/* Recovery << 24 | Act << 16 | Ini << 12 */
++		0x0C266000,
++		0x04263000,
++		0x0C0A3000,
++		0x05093000
++	};
++	const u32 timing133[] = {
++		0x1E1C6000,	/* Recovery << 24 | Act << 16 | Ini << 12 */
++		0x091C4000,
++		0x031C2000,
++		0x09072000,
++		0x04062000
++	};
++
++	sis_set_fifo(ap, adev);
++
++	pci_read_config_dword(pdev, 0x54, &reg54);
++	if (reg54 & 0x40000000)
++		port = 0x70;
++	port += 8 * ap->hard_port_no +  4 * adev->devno;
++
++	pci_read_config_dword(pdev, port, &t1);
++	t1 &= 0xC0C00FFF;	/* Mask out timing */
++	
++	if (t1 & 0x08)		/* 100 or 133 ? */
++		t1 |= timing133[speed];
++	else
++		t1 |= timing100[speed];
++	pci_write_config_byte(pdev, port, t1);
++}
++
++/**
++ *	sis_old_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *	Handles pre UDMA and UDMA33 devices. Supports MWDMA as well unlike
++ *	the old ide/pci driver.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_old_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int speed = adev->dma_mode - XFER_MW_DMA_0;
++	int drive_pci = 0x40 + 4 * ap->hard_port_no + 2 * adev->devno;
++	u16 timing;
++	
++	const u16 mwdma_bits[] = { 0x707, 0x202, 0x202 };
++	const u16 udma_bits[]  = {
++		0xE000, 0xC000, 0xA000 
++	};
++	
++	pci_read_config_word(pdev, drive_pci, &timing);
++	
++	if (adev->dma_mode < XFER_UDMA_0) {
++		/* bits 3-0 hold recovery timing bits 8-10 active timing and
++		   the higer bits are dependant on the device */
++		timing &= ~ 0x870F;
++		timing |= mwdma_bits[speed];
++		pci_write_config_word(pdev, drive_pci, timing);
++	} else {
++		/* Bit 15 is UDMA on/off, bit 13-14 are cycle time */
++		speed = adev->dma_mode - XFER_UDMA_0;
++		timing &= ~0x6000;
++		timing |= udma_bits[speed];
++	}
++}
++
++/**
++ *	sis_66_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *	Handles UDMA66 and early UDMA100 devices. Supports MWDMA as well unlike
++ *	the old ide/pci driver.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_66_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int speed = adev->dma_mode - XFER_MW_DMA_0;
++	int drive_pci = 0x40 + 4 * ap->hard_port_no + 2 * adev->devno;
++	u16 timing;
++	
++	const u16 mwdma_bits[] = { 0x707, 0x202, 0x202 };
++	const u16 udma_bits[]  = { 0xF000, 0xD000, 0xB000, 0xA000, 0x9000};
++	
++	pci_read_config_word(pdev, drive_pci, &timing);
++	
++	if (adev->dma_mode < XFER_UDMA_0) {
++		/* bits 3-0 hold recovery timing bits 8-10 active timing and
++		   the higer bits are dependant on the device, bit 15 udma */
++		timing &= ~ 0x870F;
++		timing |= mwdma_bits[speed];
++	} else {
++		/* Bit 15 is UDMA on/off, bit 12-14 are cycle time */
++		speed = adev->dma_mode - XFER_UDMA_0;
++		timing &= ~0x6000;
++		timing |= udma_bits[speed];
++	}
++	pci_write_config_word(pdev, drive_pci, timing);
++}
++
++/**
++ *	sis_100_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *	Handles UDMA66 and early UDMA100 devices. 
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_100_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int speed = adev->dma_mode - XFER_MW_DMA_0;
++	int drive_pci = 0x40 + 4 * ap->hard_port_no + 2 * adev->devno;
++	u16 timing;
++
++	const u16 udma_bits[]  = { 0x8B00, 0x8700, 0x8500, 0x8300, 0x8200, 0x8100};
++	
++	pci_read_config_word(pdev, drive_pci, &timing);
++	
++	if (adev->dma_mode < XFER_UDMA_0) {
++		/* NOT SUPPORTED YET: NEED DATA SHEET. DITTO IN OLD DRIVER */
++	} else {
++		/* Bit 15 is UDMA on/off, bit 12-14 are cycle time */
++		speed = adev->dma_mode - XFER_UDMA_0;
++		timing &= ~0x0F00;
++		timing |= udma_bits[speed];
++	}
++	pci_write_config_word(pdev, drive_pci, timing);
++}
++
++/**
++ *	sis_133_early_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *	Handles early SiS 961 bridges. Supports MWDMA as well unlike
++ *	the old ide/pci driver.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_133_early_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int speed = adev->dma_mode - XFER_MW_DMA_0;
++	int drive_pci = 0x40 + 4 * ap->hard_port_no + 2 * adev->devno;
++	u16 timing;
++	
++	const u16 udma_bits[]  = { 0x8F00, 0x8A00, 0x8700, 0x8500, 0x8300, 0x8200, 0x8100};
++	
++	pci_read_config_word(pdev, drive_pci, &timing);
++	
++	if (adev->dma_mode < XFER_UDMA_0) {
++		/* NOT SUPPORTED YET: NEED DATA SHEET. DITTO IN OLD DRIVER */
++	} else {
++		/* Bit 15 is UDMA on/off, bit 12-14 are cycle time */
++		speed = adev->dma_mode - XFER_UDMA_0;
++		timing &= ~0x0F00;
++		timing |= udma_bits[speed];
++	}
++	pci_write_config_word(pdev, drive_pci, timing);
++}
++
++/**
++ *	sis_133_set_dmamode - Initialize host controller PATA DMA timings
++ *	@ap: Port whose timings we are configuring
++ *	@adev: Device to program
++ *
++ *	Set UDMA/MWDMA mode for device, in host controller PCI config space.
++ *	Handles early SiS 961 bridges. Supports MWDMA as well unlike
++ *	the old ide/pci driver.
++ *
++ *	LOCKING:
++ *	None (inherited from caller).
++ */
++
++static void sis_133_set_dmamode (struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev	= to_pci_dev(ap->host_set->dev);
++	int speed = adev->dma_mode - XFER_MW_DMA_0;
++	int port = 0x40;
++	u32 t1;
++	u32 reg54;
++	
++	/* bits 4- cycle time 8 - cvs time */
++	const u32 timing_u100[] = { 0x6B0, 0x470, 0x350, 0x140, 0x120, 0x110, 0x000 };
++	const u32 timing_u133[] = { 0x9F0, 0x6A0, 0x470, 0x250, 0x230, 0x220, 0x210 };
++	
++	pci_read_config_dword(pdev, 0x54, &reg54);
++	if (reg54 & 0x40000000)
++		port = 0x70;
++	port += 8 * ap->hard_port_no +  4 * adev->devno;
++	
++	pci_read_config_dword(pdev, port, &t1);
++	
++	if (adev->dma_mode < XFER_UDMA_0) {
++		t1 &= ~0x00000004;
++		/* FIXME: need data sheet to add MWDMA here. Also lacking on
++		   ide/pci driver */
++	} else {
++		speed = adev->dma_mode - XFER_UDMA_0;
++		/* if & 8 no UDMA133 - need info for ... */
++		t1 &= ~0x00000FF0;
++		t1 |= 0x00000004;
++		if (t1 & 0x08)
++			t1 |= timing_u133[speed];
++		else
++			t1 |= timing_u100[speed];
++	}
++	pci_write_config_dword(pdev, port, t1);
++}
++
++static struct scsi_host_template sis_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static const struct ata_port_operations sis_133_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= sis_133_set_piomode,
++	.set_dmamode		= sis_133_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= sis_133_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations sis_133_early_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= sis_100_set_piomode,
++	.set_dmamode		= sis_133_early_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= sis_66_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations sis_100_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= sis_100_set_piomode,
++	.set_dmamode		= sis_100_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= sis_66_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations sis_66_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= sis_old_set_piomode,
++	.set_dmamode		= sis_66_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= sis_66_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static const struct ata_port_operations sis_old_ops = {
++	.port_disable		= ata_port_disable,
++	.set_piomode		= sis_old_set_piomode,
++	.set_dmamode		= sis_old_set_dmamode,
++
++	.tf_load		= ata_tf_load,
++	.tf_read		= ata_tf_read,
++	.check_status		= ata_check_status,
++	.exec_command		= ata_exec_command,
++	.dev_select		= ata_std_dev_select,
++
++	.phy_reset		= sis_old_phy_reset,
++
++	.bmdma_setup		= ata_bmdma_setup,
++	.bmdma_start		= ata_bmdma_start,
++	.bmdma_stop		= ata_bmdma_stop,
++	.bmdma_status		= ata_bmdma_status,
++	.qc_prep		= ata_qc_prep,
++	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
++
++	.eng_timeout		= ata_eng_timeout,
++
++	.irq_handler		= ata_interrupt,
++	.irq_clear		= ata_bmdma_irq_clear,
++
++	.port_start		= ata_port_start,
++	.port_stop		= ata_port_stop,
++	.host_stop		= ata_host_stop,
++};
++
++static struct ata_port_info sis_info = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.mwdma_mask	= 0x07,
++	.udma_mask	= 0,
++	.port_ops	= &sis_old_ops,
++};
++static struct ata_port_info sis_info33 = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.mwdma_mask	= 0x07,
++	.udma_mask	= ATA_UDMA2,	/* UDMA 33 */
++	.port_ops	= &sis_old_ops,
++};
++static struct ata_port_info sis_info66 = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.udma_mask	= ATA_UDMA4,	/* UDMA 66 */
++	.port_ops	= &sis_66_ops,
++};
++static struct ata_port_info sis_info100 = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.udma_mask	= ATA_UDMA5,
++	.port_ops	= &sis_100_ops,
++};
++static struct ata_port_info sis_info100_early = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.udma_mask	= ATA_UDMA5,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.port_ops	= &sis_66_ops,
++};
++static struct ata_port_info sis_info133 = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.udma_mask	= ATA_UDMA6,
++	.port_ops	= &sis_133_ops,
++};
++static struct ata_port_info sis_info133_early = {
++	.sht		= &sis_sht,
++	.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++	.pio_mask	= 0x1f,	/* pio0-4 */
++	.udma_mask	= ATA_UDMA6,
++	.port_ops	= &sis_133_early_ops,
++};
++
++
++static void sis_fixup(struct pci_dev *pdev, struct sis_chipset *sis)
++{
++	u16 regw;
++	u8 reg;
++	
++	if (sis->info == &sis_info133) {
++		pci_read_config_word(pdev, 0x50, &regw);
++		if (regw & 0x08)
++			pci_write_config_word(pdev, 0x50, regw & ~0x08);
++		pci_read_config_word(pdev, 0x52, &regw);
++		if (regw & 0x08)
++			pci_write_config_word(pdev, 0x52, regw & ~0x08);
++		return;
++	}
++	
++	if (sis->info == &sis_info133_early || sis->info == &sis_info100) {
++		/* Fix up latency */
++		pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);
++		/* Set compatibility bit */
++		pci_read_config_byte(pdev, 0x49, &reg);
++		if (!(reg & 0x01))
++			pci_write_config_byte(pdev, 0x49, reg | 0x01);
++		return;
++	}
++	
++	if (sis->info == &sis_info66 || sis->info == &sis_info100_early) {
++		/* Fix up latency */
++		pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);
++		/* Set compatibility bit */
++		pci_read_config_byte(pdev, 0x52, &reg);
++		if (!(reg & 0x04))
++			pci_write_config_byte(pdev, 0x52, reg | 0x04);
++		return;
++	}
++	
++	if (sis->info == &sis_info33) {
++		pci_read_config_byte(pdev, PCI_CLASS_PROG, &reg);
++		if (( reg & 0x0F ) != 0x00)
++			pci_write_config_byte(pdev, PCI_CLASS_PROG, reg & 0xF0);
++		/* Fall through to ATA16 fixup below */
++	}
++	
++	if (sis->info == &sis_info || sis->info == &sis_info33) {
++		/* force per drive recovery and active timings
++		   needed on ATA_33 and below chips */
++		pci_read_config_byte(pdev, 0x52, &reg);
++		if (!(reg & 0x08))
++			pci_write_config_byte(pdev, 0x52, reg|0x08);
++		return;
++	}
++	
++	BUG();
++}
++
++/**
++ *	sis_init_one - Register SiS ATA PCI device with kernel services
++ *	@pdev: PCI device to register
++ *	@ent: Entry in sis_pci_tbl matching with @pdev
++ *
++ *	Called from kernel PCI layer.  We probe for combined mode (sigh),
++ *	and then hand over control to libata, for it to do the rest.
++ *
++ *	LOCKING:
++ *	Inherited from PCI layer (may sleep).
++ *
++ *	RETURNS:
++ *	Zero on success, or -ERRNO value.
++ */
++
++static int sis_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
++{
++	static int printed_version;
++	static struct ata_port_info *port_info[2];
++	struct ata_port_info *port;
++	struct pci_dev *host;
++	struct sis_chipset *chipset = NULL;
++	
++	static struct sis_chipset sis_chipsets[] = {
++		{ 0x0745, &sis_info100 },
++		{ 0x0735, &sis_info100 },
++		{ 0x0733, &sis_info100 },
++		{ 0x0635, &sis_info100 },
++		{ 0x0633, &sis_info100 },
++		
++		{ 0x0730, &sis_info100_early },	/* 100 with ATA 66 layout */
++		{ 0x0550, &sis_info100_early },	/* 100 with ATA 66 layout */
++		
++		{ 0x0640, &sis_info66 },
++		{ 0x0630, &sis_info66 },
++		{ 0x0620, &sis_info66 },
++		{ 0x0540, &sis_info66 },
++		{ 0x0530, &sis_info66 },
++		
++		{ 0x5600, &sis_info33 },
++		{ 0x5598, &sis_info33 },
++		{ 0x5597, &sis_info33 },
++		{ 0x5591, &sis_info33 },
++		{ 0x5582, &sis_info33 },
++		{ 0x5581, &sis_info33 },
++		
++		{ 0x5596, &sis_info },
++		{ 0x5571, &sis_info },
++		{ 0x5517, &sis_info },
++		{ 0x5511, &sis_info },
++		
++		{0}
++	};
++	static struct sis_chipset sis133_early = {
++		0x0, &sis_info133_early
++	};
++	static struct sis_chipset sis133 = {
++		0x0, &sis_info133
++	};
++	static struct sis_chipset sis100_early = {
++		0x0, &sis_info100_early
++	};
++	static struct sis_chipset sis100 = {
++		0x0, &sis_info100
++	};
++	
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev,
++			   "version " DRV_VERSION "\n");
++			   
++	/* We have to find the bridge first */
++	
++	for (chipset = &sis_chipsets[0]; chipset->device; chipset++) {
++		host = pci_get_device(0x1039, chipset->device, NULL);
++		if (host != NULL) {
++			if (chipset->device == 0x630) {	/* SIS630 */
++				u8 host_rev;
++				pci_read_config_byte(host, PCI_REVISION_ID, &host_rev);
++				if (host_rev >= 0x30)	/* 630 ET */
++					chipset = &sis100_early;
++			}
++			break;
++		}
++	}
++	
++	/* Look for concealed bridges */
++	if (host == NULL) {
++		/* Second check */
++		u32 idemisc;
++		u16 trueid;
++		
++		/* Disable ID masking and register remapping then
++		   see what the real ID is */
++		
++		pci_read_config_dword(pdev, 0x54, &idemisc);
++		pci_write_config_dword(pdev, 0x54, idemisc & 0x7fffffff);
++		pci_read_config_word(pdev, PCI_DEVICE_ID, &trueid);
++		pci_write_config_dword(pdev, 0x54, idemisc);
++
++		switch(trueid) {
++		case 0x5518:	/* SIS 962/963 */
++			chipset = &sis133;
++			if ((idemisc & 0x40000000) == 0) {
++				pci_write_config_dword(pdev, 0x54, idemisc | 0x40000000);
++				printk(KERN_INFO "SIS5513: Switching to 5513 register mapping\n");
++			}
++			break;
++		case 0x0180:	/* SIS 965/965L */
++			chipset =  &sis133;
++			break;
++		case 0x1180:	/* SIS 966/966L */
++			chipset =  &sis133;
++			break;
++		}
++	}
++
++	/* Further check */	
++	if (chipset == NULL) {
++		struct pci_dev *lpc_bridge;
++		u16 trueid;
++		u8 prefctl;
++		u8 idecfg;
++		u8 sbrev;
++		
++		/* Try the second unmasking technique */
++		pci_read_config_byte(pdev, 0x4a, &idecfg);
++		pci_write_config_byte(pdev, 0x4a, idecfg | 0x10);
++		pci_read_config_word(pdev, PCI_DEVICE_ID, &trueid);
++		pci_write_config_byte(pdev, 0x4a, idecfg);
++		
++		switch(trueid) {
++		case 0x5517:
++			lpc_bridge = pci_get_slot(0x00, 0x10); /* Bus 0 Dev 2 Fn 0 */
++			if (lpc_bridge == NULL)
++				break;
++			pci_read_config_byte(lpc_bridge, PCI_REVISION_ID, &sbrev);
++			pci_read_config_byte(pdev, 0x49, &prefctl);
++			pci_dev_put(lpc_bridge);
++		
++			if (sbrev == 0x10 && (prefctl & 0x80)) {
++				chipset = &sis133_early;
++				break;
++			} 
++			chipset = &sis100;
++			break;
++		}
++	}		
++	pci_dev_put(host);
++	
++	/* No chipset info, no support */
++	if (chipset == NULL)
++		return -ENODEV;
++		
++	port = chipset->info;
++	port->private_data = chipset;
++
++	sis_fixup(pdev, chipset);
++		
++	port_info[0] = port_info[1] = port;
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id sis_pci_tbl[] = {
++	{ 0x1039, 0x5513, PCI_ANY_ID, PCI_ANY_ID, },
++	{ 0x1039, 0x5518, PCI_ANY_ID, PCI_ANY_ID, },
++	{ }	/* terminate list */
++};
++
++static struct pci_driver sis_pci_driver = {
++	.name			= DRV_NAME,
++	.id_table		= sis_pci_tbl,
++	.probe			= sis_init_one,
++	.remove			= ata_pci_remove_one,
++};
++
++static int __init sis_init(void)
++{
++	return pci_register_driver(&sis_pci_driver);
++}
++
++static void __exit sis_exit(void)
++{
++	pci_unregister_driver(&sis_pci_driver);
++}
++
++
++module_init(sis_init);
++module_exit(sis_exit);
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("SCSI low-level driver for SiS ATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, sis_pci_tbl);
++MODULE_VERSION(DRV_VERSION);
++
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sl82c105.c linux-2.6.16-rc4/drivers/scsi/pata_sl82c105.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_sl82c105.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_sl82c105.c	2006-02-16 15:36:32.000000000 +0000
+@@ -0,0 +1,376 @@
++/*
++ * pata_sl82c105.c 	- SL82C105 PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * Based in part on linux/drivers/ide/pci/sl82c105.c
++ * 		SL82C105/Winbond 553 IDE driver
++ *
++ * and in part on the documentation and errata sheet
++ */
++ 
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_sl82c105"
++#define DRV_VERSION "0.1.1"
++
++enum {
++	/*
++	 * SL82C105 PCI config register 0x40 bits.
++	 */
++	CTRL_IDE_IRQB	=	(1 << 30),
++	CTRL_IDE_IRQA   =	(1 << 28),
++	CTRL_LEGIRQ     =	(1 << 11),
++	CTRL_P1F16      =	(1 << 5),
++	CTRL_P1EN       =	(1 << 4),
++	CTRL_P0F16      =	(1 << 1),
++	CTRL_P0EN       =	(1 << 0)
++};
++
++static void sl82c105_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits sl82c105_enable_bits[] = {
++		{ 0x40, 1, 0x01, 0x01 },
++		{ 0x40, 1, 0x10, 0x10 }
++	};
++
++	if (ap->hard_port_no && !pci_test_config_bits(pdev, &sl82c105_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		dev_printk(KERN_INFO, &pdev->dev, "port disabled. ignoring.\n");
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++
++/**
++ *	sl82c105_configure_piomode	-	set chip PIO timing
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *	@pio: PIO mode
++ *
++ *	Called to do the PIO mode setup. Our timing registers are shared
++ *	so a configure_dmamode call will undo any work we do here and vice
++ *	versa
++ */
++ 
++static void sl82c105_configure_piomode(struct ata_port *ap, struct ata_device *adev, int pio)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static u16 pio_timing[5] = {
++		0x50D, 0x407, 0x304, 0x242, 0x240
++	};
++	u16 dummy;
++	int timing = 0x44 + 8 * ap->hard_port_no + 4 * adev->devno;
++	
++	pci_write_config_word(pdev, timing, pio_timing[pio]);
++	/* Can we lose this oddity of the old driver */
++	pci_read_config_word(pdev, timing, &dummy);
++}
++
++/**
++ *	sl82c105_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the PIO mode setup. Our timing registers are shared
++ *	but we want to set the PIO timing by default.
++ */
++ 
++static void sl82c105_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	sl82c105_configure_piomode(ap, adev, adev->pio_mode - XFER_PIO_0);
++}
++
++/**
++ *	sl82c105_configure_dmamode	-	set DMA mode in chip
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Load DMA cycle times into the chip ready for a DMA transfer
++ *	to occur.
++ */
++ 
++static void sl82c105_configure_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static u16 dma_timing[3] = {
++		0x707, 0x201, 0x200
++	};
++	u16 dummy;
++	int timing = 0x44 + 8 * ap->hard_port_no + 4 * adev->devno;
++	int dma = adev->dma_mode - XFER_MW_DMA_0;
++	
++	pci_write_config_word(pdev, timing, dma_timing[dma]);
++	/* Can we lose this oddity of the old driver */
++	pci_read_config_word(pdev, timing, &dummy);
++}
++
++/**
++ *	sl82c105_set_dmamode	-	set initial DMA mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Called to do the DMA mode setup. This replaces the PIO timings
++ *	for the device in question. Set appropriate PIO timings not DMA
++ *	timings at this point.
++ */
++ 
++static void sl82c105_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	switch(adev->dma_mode) {
++		case XFER_MW_DMA_0:
++			sl82c105_configure_piomode(ap, adev, 1);
++			break;
++		case XFER_MW_DMA_1:
++			sl82c105_configure_piomode(ap, adev, 3);
++			break;
++		case XFER_MW_DMA_2:
++			sl82c105_configure_piomode(ap, adev, 3);
++			break;
++		default:
++			BUG();
++	}			
++}
++
++/**
++ *	sl82c105_reset_engine	-	Reset the DMA engine
++ *	@ap: ATA interface
++ *
++ *	The sl82c105 has some serious problems with the DMA engine
++ *	when transfers don't run as expected or ATAPI is used. The 
++ *	recommended fix is to reset the engine each use using a chip
++ *	test register.
++ */
++ 
++static void sl82c105_reset_engine(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u16 val;
++	
++	pci_read_config_word(pdev, 0x7E, &val);
++	pci_write_config_word(pdev, 0x7E, val | 4);
++	pci_write_config_word(pdev, 0x7E, val & ~4);
++}
++
++/**
++ *	sl82c105_bmdma_start		-	DMA engine begin
++ *	@qc: ATA command
++ *
++ *	Reset the DMA engine each use as recommended by the errata
++ *	document. 
++ *
++ *	FIXME: if we switch clock at BMDMA start/end we might get better
++ *	PIO performance on DMA capable devices.
++ */
++ 
++static void sl82c105_bmdma_start(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++
++	sl82c105_reset_engine(ap);
++	
++	/* Set the clocks for DMA */
++	sl82c105_configure_dmamode(ap, qc->dev);
++	/* Activate DMA */	
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	sl82c105_bmdma_end		-	DMA engine stop
++ *	@qc: ATA command
++ *
++ *	Reset the DMA engine each use as recommended by the errata
++ *	document.
++ *
++ *	This function is also called to turn off DMA when a timeout occurs
++ *	during DMA operation. In both cases we need to reset the engine,
++ *	so no actual eng_timeout handler is required.
++ *
++ *	We assume bmdma_stop is always called if bmdma_start as called. If
++ *	not then we may need to wrap qc_issue.
++ */
++ 
++static void sl82c105_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	struct ata_port *ap = qc->ap;
++
++	ata_bmdma_stop(qc);
++	sl82c105_reset_engine(ap);
++	
++	/* This will redo the initial setup of the DMA device to matching
++	   PIO timings */
++	sl82c105_set_dmamode(ap, qc->dev);
++}
++
++static struct scsi_host_template sl82c105_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations sl82c105_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= sl82c105_set_piomode,
++	.set_dmamode	= sl82c105_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= sl82c105_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= sl82c105_bmdma_start,
++	.bmdma_stop	= sl82c105_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++	
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};	
++
++/**
++ *	sl82c105_bridge_revision	-	find bridge version
++ *	@pdev: PCI device for the ATA function
++ *
++ *	Locates the PCI bridge associated with the ATA function and
++ *	providing it is a Winbond 553 reports the revision. If it cannot
++ *	find a revision or the right device it returns -1
++ */
++ 
++static int sl82c105_bridge_revision(struct pci_dev *pdev)
++{
++	struct pci_dev *bridge;
++	u8 rev;
++
++	/*
++	 * The bridge should be part of the same device, but function 0.
++	 */
++	bridge = pci_get_slot(pdev->bus,
++			       PCI_DEVFN(PCI_SLOT(pdev->devfn), 0));
++	if (!bridge)
++		return -1;
++
++	/*
++	 * Make sure it is a Winbond 553 and is an ISA bridge.
++	 */
++	if (bridge->vendor != PCI_VENDOR_ID_WINBOND ||
++	    bridge->device != PCI_DEVICE_ID_WINBOND_83C553 ||
++	    bridge->class >> 8 != PCI_CLASS_BRIDGE_ISA) {
++	    	pci_dev_put(bridge);
++		return -1;
++	}
++	/*
++	 * We need to find function 0's revision, not function 1
++	 */
++	pci_read_config_byte(bridge, PCI_REVISION_ID, &rev);
++
++	pci_dev_put(bridge);
++	return rev;
++}
++
++	
++static int sl82c105_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info_dma = {
++		.sht = &sl82c105_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &sl82c105_port_ops
++	};
++	static struct ata_port_info info_early = {
++		.sht = &sl82c105_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.port_ops = &sl82c105_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info_early, &info_early };
++	u32 val;
++	int rev;
++
++	rev = sl82c105_bridge_revision(dev);
++	
++	if (rev == -1)
++		dev_printk(KERN_WARNING, &dev->dev, "pata_sl82c105: Unable to find bridge, disabling DMA.\n");
++	else if (rev <= 5)
++		dev_printk(KERN_WARNING, &dev->dev, "pata_sl82c105: Early bridge revision, no DMA available.\n");
++	else {
++		port_info[0] = &info_dma;
++		port_info[1] = &info_dma;
++	}
++	
++	pci_read_config_dword(dev, 0x40, &val);
++	val |= CTRL_P0EN | CTRL_P0F16 | CTRL_P1F16;
++	pci_write_config_dword(dev, 0x40, val);
++
++
++	return ata_pci_init_one(dev, port_info, 1); /* For now */
++}
++
++static struct pci_device_id sl82c105[] = {
++	{ PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_82C105, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0, },
++};
++
++static struct pci_driver sl82c105_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= sl82c105,
++	.probe 		= sl82c105_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init sl82c105_init(void)
++{
++	return pci_register_driver(&sl82c105_pci_driver);
++}
++
++
++static void __exit sl82c105_exit(void)
++{
++	pci_unregister_driver(&sl82c105_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Sl82c105");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, sl82c105);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(sl82c105_init);
++module_exit(sl82c105_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_triflex.c linux-2.6.16-rc4/drivers/scsi/pata_triflex.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_triflex.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_triflex.c	2006-02-16 15:36:23.000000000 +0000
+@@ -0,0 +1,268 @@
++/*
++ * pata_triflex.c 	- Compaq PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ * based upon
++ *
++ * triflex.c
++ *
++ * IDE Chipset driver for the Compaq TriFlex IDE controller.
++ *
++ * Known to work with the Compaq Workstation 5x00 series.
++ *
++ * Copyright (C) 2002 Hewlett-Packard Development Group, L.P.
++ * Author: Torben Mathiasen <torben.mathiasen@hp.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2 as
++ * published by the Free Software Foundation.
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
++ *
++ * Loosely based on the piix & svwks drivers.
++ *
++ * Documentation:
++ *	Not publically available.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_triflex"
++#define DRV_VERSION "0.2.1"
++
++static void triflex_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	static struct pci_bits triflex_enable_bits[] = {
++		{ 0x80, 1, 0x01, 0x01 },
++		{ 0x80, 1, 0x02, 0x02 }
++	};
++
++	if (!pci_test_config_bits(pdev, &triflex_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = ATA_CBL_PATA40;
++	ata_port_probe(ap);
++	ata_bus_reset(ap);
++}
++
++/**
++ *	triflex_load_timing		-	timing configuration
++ *	@ap: ATA interface
++ *	@adev: Device on the bus
++ *	@speed: speed to configure
++ *
++ *	The Triflex has one set of timings per device per channel. This
++ *	means we must do some switching. As the PIO and DMA timings don't
++ *	match we have to do some reloading unlike PIIX devices where tuning
++ *	tricks can avoid it.
++ */
++
++static void triflex_load_timing(struct ata_port *ap, struct ata_device *adev, int speed)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 timing = 0;
++	u32 triflex_timing, old_triflex_timing;
++	int channel_offset = ap->hard_port_no ? 0x74: 0x70;
++	unsigned int is_slave	= (adev->devno != 0);
++
++
++	pci_read_config_dword(pdev, channel_offset, &old_triflex_timing);
++	triflex_timing = old_triflex_timing;
++
++	switch(speed)
++	{
++		case XFER_MW_DMA_2:
++			timing = 0x0103;break;
++		case XFER_MW_DMA_1:
++			timing = 0x0203;break;
++		case XFER_MW_DMA_0:
++			timing = 0x0808;break;
++		case XFER_SW_DMA_2:
++		case XFER_SW_DMA_1:
++		case XFER_SW_DMA_0:
++			timing = 0x0F0F;break;
++		case XFER_PIO_4:
++			timing = 0x0202;break;
++		case XFER_PIO_3:
++			timing = 0x0204;break;
++		case XFER_PIO_2:
++			timing = 0x0404;break;
++		case XFER_PIO_1:
++			timing = 0x0508;break;
++		case XFER_PIO_0:
++			timing = 0x0808;break;
++		default:
++			BUG();
++	}
++	triflex_timing &= ~ (0xFFFF << (16 * is_slave));
++	triflex_timing |= (timing << (16 * is_slave));
++
++	if (triflex_timing != old_triflex_timing)
++		pci_write_config_dword(pdev, channel_offset, triflex_timing);
++}
++
++/**
++ *	triflex_set_piomode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	Use the timing loader to set up the PIO mode. We have to do this
++ *	because DMA start/stop will only be called once DMA occurs. If there
++ *	has been no DMA then the PIO timings are still needed.
++ */
++static void triflex_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	triflex_load_timing(ap, adev, adev->pio_mode);
++}
++
++/**
++ *	triflex_dma_start	-	DMA start callback
++ *	@qc: Command in progress
++ *
++ *	Usually drivers set the DMA timing at the point the set_dmamode call
++ *	is made. Triflex however requires we load new timings on the
++ *	transition or keep matching PIO/DMA pairs (ie MWDMA2/PIO4 etc).
++ *	We load the DMA timings just before starting DMA and then restore
++ *	the PIO timing when the DMA is finished.
++ */
++
++static void triflex_bmdma_start(struct ata_queued_cmd *qc)
++{
++	triflex_load_timing(qc->ap, qc->dev, qc->dev->dma_mode);
++	ata_bmdma_start(qc);
++}
++
++/**
++ *	triflex_dma_stop	-	DMA stop callback
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *
++ *	We loaded new timings in dma_start, as a result we need to restore
++ *	the PIO timings in dma_stop so that the next command issue gets the
++ *	right clock values.
++ */
++
++static void triflex_bmdma_stop(struct ata_queued_cmd *qc)
++{
++	ata_bmdma_stop(qc);
++	triflex_load_timing(qc->ap, qc->dev, qc->dev->pio_mode);
++}
++
++static struct scsi_host_template triflex_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations triflex_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= triflex_set_piomode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= triflex_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= triflex_bmdma_start,
++	.bmdma_stop	= triflex_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static int triflex_init_one(struct pci_dev *dev, const struct pci_device_id *id)
++{
++	static struct ata_port_info info = {
++		.sht = &triflex_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &triflex_port_ops
++	};
++	static struct ata_port_info *port_info[2] = { &info, &info };
++	static int printed_version;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &dev->dev, "version " DRV_VERSION "\n");
++
++	return ata_pci_init_one(dev, port_info, 2);
++}
++
++static const struct pci_device_id triflex[] = {
++	{ PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE,
++				  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
++	{ 0, },
++};
++
++static struct pci_driver triflex_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= triflex,
++	.probe 		= triflex_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init triflex_init(void)
++{
++	return pci_register_driver(&triflex_pci_driver);
++}
++
++
++static void __exit triflex_exit(void)
++{
++	pci_unregister_driver(&triflex_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for Compaq Triflex");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, triflex);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(triflex_init);
++module_exit(triflex_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/pata_via.c linux-2.6.16-rc4/drivers/scsi/pata_via.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/pata_via.c	1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.16-rc4/drivers/scsi/pata_via.c	2006-02-16 15:28:17.000000000 +0000
+@@ -0,0 +1,547 @@
++/*
++ * pata_via.c 	- VIA PATA for new ATA layer
++ *			  (C) 2005 Red Hat Inc
++ *			  Alan Cox <alan@redhat.com>
++ *
++ *  Documentation
++ *	Most chipset documentation available under NDA only
++ *
++ *  VIA version guide
++ *	VIA VT82C561	-	early design, uses ata_generic currently
++ *	VIA VT82C576	-	MWDMA, 33Mhz
++ *	VIA VT82C586	-	MWDMA, 33Mhz
++ *	VIA VT82C586a	-	Added UDMA to 33Mhz
++ *	VIA VT82C586b	-	UDMA33
++ *	VIA VT82C596a	-	Nonfunctional UDMA66
++ *	VIA VT82C596b	-	Working UDMA66
++ *	VIA VT82C686	-	Nonfunctional UDMA66
++ *	VIA VT82C686a	-	Working UDMA66
++ *	VIA VT82C686b	-	Updated to UDMA100
++ *	VIA VT8231	-	UDMA100
++ *	VIA VT8233	-	UDMA100
++ *	VIA VT8233a	-	UDMA133
++ *	VIA VT8233c	-	UDMA100
++ *	VIA VT8235	-	UDMA133
++ *	VIA VT8237	-	UDMA133
++ *
++ *	Most registers remain compatible across chips. Others start reserved
++ *	and acquire sensible semantics if set to 1 (eg cable detect). A few
++ *	exceptions exist, notably around the FIFO settings.
++ *
++ *	One additional quirk of the VIA design is that like ALi they use few
++ *	PCI IDs for a lot of chips.
++ *
++ *	Based heavily on:
++ *
++ * Version 3.38
++ *
++ * VIA IDE driver for Linux. Supported southbridges:
++ *
++ *   vt82c576, vt82c586, vt82c586a, vt82c586b, vt82c596a, vt82c596b,
++ *   vt82c686, vt82c686a, vt82c686b, vt8231, vt8233, vt8233c, vt8233a,
++ *   vt8235, vt8237
++ *
++ * Copyright (c) 2000-2002 Vojtech Pavlik
++ *
++ * Based on the work of:
++ *	Michel Aubry
++ *	Jeff Garzik
++ *	Andre Hedrick
++
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/pci.h>
++#include <linux/init.h>
++#include <linux/blkdev.h>
++#include <linux/delay.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++
++#define DRV_NAME "pata_via"
++#define DRV_VERSION "0.1.4"
++
++/*
++ *	The following comes directly from Vojtech Pavlik's ide/pci/via82cxxx
++ *	driver.
++ */
++
++enum {
++	VIA_UDMA	= 0x007,
++	VIA_UDMA_NONE	= 0x000,
++	VIA_UDMA_33	= 0x001,
++	VIA_UDMA_66	= 0x002,
++	VIA_UDMA_100	= 0x003,
++	VIA_UDMA_133	= 0x004,
++	VIA_BAD_PREQ	= 0x010, /* Crashes if PREQ# till DDACK# set */
++	VIA_BAD_CLK66	= 0x020, /* 66 MHz clock doesn't work correctly */
++	VIA_SET_FIFO	= 0x040, /* Needs to have FIFO split set */
++	VIA_NO_UNMASK	= 0x080, /* Doesn't work with IRQ unmasking on */
++	VIA_BAD_ID	= 0x100, /* Has wrong vendor ID (0x1107) */
++	VIA_BAD_AST	= 0x200, /* Don't touch Address Setup Timing */
++};
++
++/*
++ * VIA SouthBridge chips.
++ */
++
++static const struct via_isa_bridge {
++	const char *name;
++	u16 id;
++	u8 rev_min;
++	u8 rev_max;
++	u16 flags;
++} via_isa_bridges[] = {
++	{ "vt8237",	PCI_DEVICE_ID_VIA_8237,     0x00, 0x2f, VIA_UDMA_133 | VIA_BAD_AST },
++	{ "vt8235",	PCI_DEVICE_ID_VIA_8235,     0x00, 0x2f, VIA_UDMA_133 | VIA_BAD_AST },
++	{ "vt8233a",	PCI_DEVICE_ID_VIA_8233A,    0x00, 0x2f, VIA_UDMA_133 | VIA_BAD_AST },
++	{ "vt8233c",	PCI_DEVICE_ID_VIA_8233C_0,  0x00, 0x2f, VIA_UDMA_100 },
++	{ "vt8233",	PCI_DEVICE_ID_VIA_8233_0,   0x00, 0x2f, VIA_UDMA_100 },
++	{ "vt8231",	PCI_DEVICE_ID_VIA_8231,     0x00, 0x2f, VIA_UDMA_100 },
++	{ "vt82c686b",	PCI_DEVICE_ID_VIA_82C686,   0x40, 0x4f, VIA_UDMA_100 },
++	{ "vt82c686a",	PCI_DEVICE_ID_VIA_82C686,   0x10, 0x2f, VIA_UDMA_66 },
++	{ "vt82c686",	PCI_DEVICE_ID_VIA_82C686,   0x00, 0x0f, VIA_UDMA_33 | VIA_BAD_CLK66 },
++	{ "vt82c596b",	PCI_DEVICE_ID_VIA_82C596,   0x10, 0x2f, VIA_UDMA_66 },
++	{ "vt82c596a",	PCI_DEVICE_ID_VIA_82C596,   0x00, 0x0f, VIA_UDMA_33 | VIA_BAD_CLK66 },
++	{ "vt82c586b",	PCI_DEVICE_ID_VIA_82C586_0, 0x47, 0x4f, VIA_UDMA_33 | VIA_SET_FIFO },
++	{ "vt82c586b",	PCI_DEVICE_ID_VIA_82C586_0, 0x40, 0x46, VIA_UDMA_33 | VIA_SET_FIFO | VIA_BAD_PREQ },
++	{ "vt82c586b",	PCI_DEVICE_ID_VIA_82C586_0, 0x30, 0x3f, VIA_UDMA_33 | VIA_SET_FIFO },
++	{ "vt82c586a",	PCI_DEVICE_ID_VIA_82C586_0, 0x20, 0x2f, VIA_UDMA_33 | VIA_SET_FIFO },
++	{ "vt82c586",	PCI_DEVICE_ID_VIA_82C586_0, 0x00, 0x0f, VIA_UDMA_NONE | VIA_SET_FIFO },
++	{ "vt82c576",	PCI_DEVICE_ID_VIA_82C576,   0x00, 0x2f, VIA_UDMA_NONE | VIA_SET_FIFO | VIA_NO_UNMASK },
++	{ "vt82c576",	PCI_DEVICE_ID_VIA_82C576,   0x00, 0x2f, VIA_UDMA_NONE | VIA_SET_FIFO | VIA_NO_UNMASK | VIA_BAD_ID },
++	{ NULL }
++};
++
++/**
++ *	via_cable_detect	-	cable detection
++ *	@ap: ATA port
++ *
++ *	Perform cable detection. Actually for the VIA case the BIOS
++ *	already did this for us. We read the values provided by the
++ *	BIOS. If you are using an 8235 in a non-PC configuration you
++ *	may need to update this code.
++ *
++ *	Hotplug also impacts on this.
++ */
++
++static int via_cable_detect(struct ata_port *ap) {
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	u32 ata66;
++	pci_read_config_dword(pdev, 0x50, &ata66);
++	/* Check both the drive cable reporting bits, we might not have
++	   two drives */
++	if (ata66 & (0x1010 << (16 * ap->hard_port_no)))
++		return ATA_CBL_PATA80;
++	else
++		return ATA_CBL_PATA40;
++}
++
++/**
++ *	via_phy_reset		-	reset for eary chip
++ *	@ap: ATA port
++ *
++ *	Handle the reset callback for the later chips with cable detect
++ */
++
++static void via_phy_reset(struct ata_port *ap)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++
++	/* Note: When we add VIA 6410 remember it doesn't have enable bits */
++	static struct pci_bits via_enable_bits[] = {
++		{ 0x40, 1, 0x02, 0x02 },
++		{ 0x40, 1, 0x01, 0x01 }
++	};
++
++	if (!pci_test_config_bits(pdev, &via_enable_bits[ap->hard_port_no])) {
++		ata_port_disable(ap);
++		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);
++		return;
++	}
++	ap->cbl = via_cable_detect(ap);
++	ata_bus_reset(ap);
++	ata_port_probe(ap);
++}
++
++/**
++ *	via_do_set_mode	-	set initial PIO mode data
++ *	@ap: ATA interface
++ *	@adev: ATA device
++ *	@mode: ATA mode being programmed
++ *	@tdiv: Clocks per PCI clock
++ *	@set_ast: Set to program address setup
++ *	@udma_type: UDMA mode/format of registers
++ *
++ *	Program the VIA registers for DMA and PIO modes. Uses the ata timing
++ *	support in order to compute modes.
++ *
++ *	FIXME: Hotplug will require we serialize multiple mode changes
++ *	on the two channels.
++ */
++
++static void via_do_set_mode(struct ata_port *ap, struct ata_device *adev, int mode, int tdiv, int set_ast, int udma_type)
++{
++	struct pci_dev *pdev = to_pci_dev(ap->host_set->dev);
++	struct ata_device *peer = ata_dev_pair(ap, adev);
++	struct ata_timing t, p;
++	static int via_clock = 33000;	/* Bus clock in kHZ - ought to be tunable one day */
++	unsigned long T =  1000000000 / via_clock;
++	unsigned long UT = T/tdiv;
++	int ut;
++	int offset = 3 - (2*ap->hard_port_no) - adev->devno;
++
++	printk("via_do_set_mode: Mode=%d ast broken=%c udma=%d mul=%d\n",
++		mode, "YN"[set_ast], udma_type, tdiv);
++	/* Calculate the timing values we require */
++	ata_timing_compute(adev, adev->pio_mode, &t, T, UT);
++
++	/* We share 8bit timing so we must merge the constraints */
++	if (peer) {
++		if (peer->pio_mode) {
++			ata_timing_compute(peer, peer->pio_mode, &p, T, UT);
++			ata_timing_merge(&p, &t, &t, ATA_TIMING_8BIT);
++		}
++		if (peer->dma_mode) {
++			ata_timing_compute(peer, peer->dma_mode, &p, T, UT);
++			ata_timing_merge(&p, &t, &t, ATA_TIMING_8BIT);
++		}
++	}
++
++	/* Address setup is programmable but breaks on UDMA133 setups */
++	if (set_ast) {
++		u8 setup;	/* 2 bits per drive */
++		int shift = 2 * offset;
++
++		pci_read_config_byte(pdev, 0x4C, &setup);
++		setup &= ~(3 << shift);
++		setup |= FIT(t.setup, 1, 4) << shift;
++		pci_write_config_byte(pdev, 0x4C, setup);
++	}
++
++	/* Load the PIO mode bits */
++	pci_write_config_byte(pdev, 0x4F - ap->hard_port_no,
++		((FIT(t.act8b, 1, 16) - 1) << 4) | (FIT(t.rec8b, 1, 16) - 1));
++	pci_write_config_byte(pdev, 0x48 + offset,
++		((FIT(t.active, 1, 16) - 1) << 4) | (FIT(t.recover, 1, 16) - 1));
++
++	/* Load the UDMA bits according to type */
++	switch(udma_type) {
++		default:
++			/* BUG() ? */
++			/* fall through */
++		case 33:
++			ut = t.udma ? (0xe0 | (FIT(t.udma, 2, 5) - 2)) : 0x03;
++			break;
++		case 66:
++			ut = t.udma ? (0xe8 | (FIT(t.udma, 2, 9) - 2)) : 0x0f;
++			break;
++		case 100:
++			ut = t.udma ? (0xe0 | (FIT(t.udma, 2, 9) - 2)) : 0x07;
++			break;
++		case 133:
++			ut = t.udma ? (0xe0 | (FIT(t.udma, 2, 9) - 2)) : 0x07;
++			break;
++	}
++	/* Set UDMA unless device is not UDMA capable */
++	if (udma_type)
++		pci_write_config_byte(pdev, 0x50 + offset, ut);
++}
++
++static void via_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++	const struct via_isa_bridge *config = ap->host_set->private_data;
++	int set_ast = (config->flags & VIA_BAD_AST) ? 0 : 1;
++	int mode = config->flags & VIA_UDMA;
++	static u8 tclock[5] = { 1, 1, 2, 3, 4 };
++	static u8 udma[5] = { 0, 33, 66, 100, 133 };
++
++	via_do_set_mode(ap, adev, adev->pio_mode, tclock[mode], set_ast, udma[mode]);
++}
++
++static void via_set_dmamode(struct ata_port *ap, struct ata_device *adev)
++{
++	const struct via_isa_bridge *config = ap->host_set->private_data;
++	int set_ast = (config->flags & VIA_BAD_AST) ? 0 : 1;
++	int mode = config->flags & VIA_UDMA;
++	static u8 tclock[5] = { 1, 1, 2, 3, 4 };
++	static u8 udma[5] = { 0, 33, 66, 100, 133 };
++
++	via_do_set_mode(ap, adev, adev->dma_mode, tclock[mode], set_ast, udma[mode]);
++}
++
++static struct scsi_host_template via_sht = {
++	.module			= THIS_MODULE,
++	.name			= DRV_NAME,
++	.ioctl			= ata_scsi_ioctl,
++	.queuecommand		= ata_scsi_queuecmd,
++	.eh_strategy_handler	= ata_scsi_error,
++	.can_queue		= ATA_DEF_QUEUE,
++	.this_id		= ATA_SHT_THIS_ID,
++	.sg_tablesize		= LIBATA_MAX_PRD,
++	.max_sectors		= ATA_MAX_SECTORS,
++	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
++	.emulated		= ATA_SHT_EMULATED,
++	.use_clustering		= ATA_SHT_USE_CLUSTERING,
++	.proc_name		= DRV_NAME,
++	.dma_boundary		= ATA_DMA_BOUNDARY,
++	.slave_configure	= ata_scsi_slave_config,
++	.bios_param		= ata_std_bios_param,
++//	.ordered_flush		= 1,
++};
++
++static struct ata_port_operations via_port_ops = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= via_set_piomode,
++	.set_dmamode	= via_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= via_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++static struct ata_port_operations via_port_ops_noirq = {
++	.port_disable	= ata_port_disable,
++	.set_piomode	= via_set_piomode,
++	.set_dmamode	= via_set_dmamode,
++	.tf_load	= ata_tf_load,
++	.tf_read	= ata_tf_read,
++	.check_status 	= ata_check_status,
++	.exec_command	= ata_exec_command,
++	.dev_select 	= ata_std_dev_select,
++
++	.phy_reset	= via_phy_reset,
++
++	.bmdma_setup 	= ata_bmdma_setup,
++	.bmdma_start 	= ata_bmdma_start,
++	.bmdma_stop	= ata_bmdma_stop,
++	.bmdma_status 	= ata_bmdma_status,
++
++	.qc_prep 	= ata_qc_prep,
++	.qc_issue	= ata_qc_issue_prot,
++	.eng_timeout	= ata_eng_timeout,
++	.data_xfer	= ata_pio_data_xfer_noirq,
++
++	.irq_handler	= ata_interrupt,
++	.irq_clear	= ata_bmdma_irq_clear,
++
++	.port_start	= ata_port_start,
++	.port_stop	= ata_port_stop,
++	.host_stop	= ata_host_stop
++};
++
++/**
++ *	via_init_one		-	discovery callback
++ *	@pdev: PCI device ID
++ *	@id: PCI table info
++ *
++ *	A VIA IDE interface has been discovered. Figure out what revision
++ *	and perform configuration work before handing it to the ATA layer
++ */
++
++static int via_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
++{
++	/* Early VIA without UDMA support */
++	static struct ata_port_info via_mwdma_info = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &via_port_ops
++	};
++	/* Ditto with IRQ masking required */
++	static struct ata_port_info via_mwdma_info_borked = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | ATA_FLAG_IRQ_MASK,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.port_ops = &via_port_ops_noirq,
++	};
++	/* VIA UDMA 33 devices (and borked 66) */
++	static struct ata_port_info via_udma33_info = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x7,
++		.port_ops = &via_port_ops
++	};
++	/* VIA UDMA 66 devices */
++	static struct ata_port_info via_udma66_info = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x1f,
++		.port_ops = &via_port_ops
++	};
++	/* VIA UDMA 100 devices */
++	static struct ata_port_info via_udma100_info = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,
++		.port_ops = &via_port_ops
++	};
++	/* UDMA133 with bad AST (All current 133) */
++	static struct ata_port_info via_udma133_info = {
++		.sht = &via_sht,
++		.host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
++		.pio_mask = 0x1f,
++		.mwdma_mask = 0x07,
++		.udma_mask = 0x3f,	/* 0x7F but need to fix north bridge */
++		.port_ops = &via_port_ops
++	};
++	struct ata_port_info *port_info[2], *type;
++	struct pci_dev *isa = NULL;
++	const struct via_isa_bridge *config;
++	static int printed_version;
++	u8 t;
++	u8 enable;
++	u32 timing;
++
++	if (!printed_version++)
++		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
++
++	/* To find out how the IDE will behave and what features we
++	   actually have to look at the bridge not the IDE controller */
++	for (config = via_isa_bridges; config->id; config++)
++		if ((isa = pci_get_device(PCI_VENDOR_ID_VIA +
++			!!(config->flags & VIA_BAD_ID),
++			config->id, NULL))) {
++
++			pci_read_config_byte(isa, PCI_REVISION_ID, &t);
++			if (t >= config->rev_min &&
++			    t <= config->rev_max)
++				break;
++			pci_dev_put(isa);
++		}
++
++	if (!config->id) {
++		printk(KERN_WARNING "via: Unknown VIA SouthBridge, disabling.\n");
++		return -ENODEV;
++	}
++
++	/* 0x40 low bits indicate enabled channels */
++	pci_read_config_byte(pdev, 0x40 , &enable);
++	enable &= 3;
++	if (enable == 0) {
++		pci_dev_put(isa);
++		return -ENODEV;
++	}
++
++	/* Initialise the FIFO for the enabled channels. */
++	if (config->flags & VIA_SET_FIFO) {
++		u8 fifo_setting[4] = {0x00, 0x60, 0x00, 0x20};
++		u8 fifo;
++
++		pci_read_config_byte(pdev, 0x43, &fifo);
++
++		/* Clear PREQ# until DDACK# for errata */
++		if (config->flags & VIA_BAD_PREQ)
++			fifo &= 0x7F;
++		else
++			fifo &= 0x9f;
++		/* Turn on FIFO for enabled channels */
++		fifo |= fifo_setting[enable];
++		pci_write_config_byte(pdev, 0x43, fifo);
++	}
++	/* Clock set up */
++	switch(config->flags & VIA_UDMA) {
++		case VIA_UDMA_NONE:
++			if (config->flags & VIA_NO_UNMASK)
++				type = &via_mwdma_info_borked;
++			else
++				type = &via_mwdma_info;
++			break;
++		case VIA_UDMA_33:
++			type = &via_udma33_info;
++			break;
++		case VIA_UDMA_66:
++			type = &via_udma66_info;
++			/* The 66 MHz devices require we enable the clock */
++			pci_read_config_dword(pdev, 0x50, &timing);
++			timing |= 0x80008;
++			pci_write_config_dword(pdev, 0x50, timing);
++			break;
++		case VIA_UDMA_100:
++			type = &via_udma100_info;
++			break;
++		case VIA_UDMA_133:
++			type = &via_udma133_info;
++			break;
++		default:
++			type = NULL;
++			BUG();
++			break;
++	}
++
++	if (config->flags & VIA_BAD_CLK66) {
++		/* Disable the 66MHz clock on problem devices */
++		pci_read_config_dword(pdev, 0x50, &timing);
++		timing &= ~0x80008;
++		pci_write_config_dword(pdev, 0x50, timing);
++	}
++
++	/* We have established the device type, now fire it up */
++	type->private_data = (void *)config;
++
++	port_info[0] = port_info[1] = type;
++	return ata_pci_init_one(pdev, port_info, 2);
++}
++
++static const struct pci_device_id via[] = {
++	{ PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C576_1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
++	{ 0, },
++};
++
++static struct pci_driver via_pci_driver = {
++        .name 		= DRV_NAME,
++	.id_table	= via,
++	.probe 		= via_init_one,
++	.remove		= ata_pci_remove_one
++};
++
++static int __init via_init(void)
++{
++	return pci_register_driver(&via_pci_driver);
++}
++
++
++static void __exit via_exit(void)
++{
++	pci_unregister_driver(&via_pci_driver);
++}
++
++
++MODULE_AUTHOR("Alan Cox");
++MODULE_DESCRIPTION("low-level driver for VIA PATA");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(pci, via);
++MODULE_VERSION(DRV_VERSION);
++
++module_init(via_init);
++module_exit(via_exit);
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_mv.c linux-2.6.16-rc4/drivers/scsi/sata_mv.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_mv.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_mv.c	2006-02-20 11:28:03.000000000 +0000
+@@ -389,6 +389,7 @@
+ 
+ 	.qc_prep		= mv_qc_prep,
+ 	.qc_issue		= mv_qc_issue,
++	.data_xfer		= ata_mmio_data_xfer,
+ 
+ 	.eng_timeout		= mv_eng_timeout,
+ 
+@@ -416,6 +417,7 @@
+ 
+ 	.qc_prep		= mv_qc_prep,
+ 	.qc_issue		= mv_qc_issue,
++	.data_xfer		= ata_mmio_data_xfer,
+ 
+ 	.eng_timeout		= mv_eng_timeout,
+ 
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_nv.c linux-2.6.16-rc4/drivers/scsi/sata_nv.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_nv.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_nv.c	2006-01-21 17:08:58.000000000 +0000
+@@ -258,6 +258,7 @@
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
+ 	.eng_timeout		= ata_eng_timeout,
++	.data_xfer		= ata_pio_data_xfer,
+ 	.irq_handler		= nv_interrupt,
+ 	.irq_clear		= ata_bmdma_irq_clear,
+ 	.scr_read		= nv_scr_read,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_promise.c linux-2.6.16-rc4/drivers/scsi/sata_promise.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_promise.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_promise.c	2006-02-06 12:36:12.000000000 +0000
+@@ -130,6 +130,7 @@
+ 	.qc_prep		= pdc_qc_prep,
+ 	.qc_issue		= pdc_qc_issue_prot,
+ 	.eng_timeout		= pdc_eng_timeout,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.irq_handler		= pdc_interrupt,
+ 	.irq_clear		= pdc_irq_clear,
+ 
+@@ -152,6 +153,7 @@
+ 
+ 	.qc_prep		= pdc_qc_prep,
+ 	.qc_issue		= pdc_qc_issue_prot,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.eng_timeout		= pdc_eng_timeout,
+ 	.irq_handler		= pdc_interrupt,
+ 	.irq_clear		= pdc_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_qstor.c linux-2.6.16-rc4/drivers/scsi/sata_qstor.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_qstor.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_qstor.c	2006-01-21 17:09:57.000000000 +0000
+@@ -158,6 +158,7 @@
+ 	.phy_reset		= qs_phy_reset,
+ 	.qc_prep		= qs_qc_prep,
+ 	.qc_issue		= qs_qc_issue,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.eng_timeout		= qs_eng_timeout,
+ 	.irq_handler		= qs_intr,
+ 	.irq_clear		= qs_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sil24.c linux-2.6.16-rc4/drivers/scsi/sata_sil24.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sil24.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_sil24.c	2006-01-21 17:10:52.000000000 +0000
+@@ -309,6 +309,7 @@
+ 
+ 	.qc_prep		= sil24_qc_prep,
+ 	.qc_issue		= sil24_qc_issue,
++	.data_xfer		= ata_mmio_data_xfer,
+ 
+ 	.eng_timeout		= sil24_eng_timeout,
+ 
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sil.c linux-2.6.16-rc4/drivers/scsi/sata_sil.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sil.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_sil.c	2006-02-14 17:23:28.000000000 +0000
+@@ -165,6 +165,7 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.eng_timeout		= ata_eng_timeout,
+ 	.irq_handler		= ata_interrupt,
+ 	.irq_clear		= ata_bmdma_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sis.c linux-2.6.16-rc4/drivers/scsi/sata_sis.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sis.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_sis.c	2006-01-21 17:11:23.000000000 +0000
+@@ -115,6 +115,7 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
+ 	.eng_timeout		= ata_eng_timeout,
+ 	.irq_handler		= ata_interrupt,
+ 	.irq_clear		= ata_bmdma_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_svw.c linux-2.6.16-rc4/drivers/scsi/sata_svw.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_svw.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_svw.c	2006-02-06 12:30:23.000000000 +0000
+@@ -320,6 +320,7 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.eng_timeout		= ata_eng_timeout,
+ 	.irq_handler		= ata_interrupt,
+ 	.irq_clear		= ata_bmdma_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sx4.c linux-2.6.16-rc4/drivers/scsi/sata_sx4.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_sx4.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_sx4.c	2006-01-21 17:12:01.000000000 +0000
+@@ -206,6 +206,7 @@
+ 	.phy_reset		= pdc_20621_phy_reset,
+ 	.qc_prep		= pdc20621_qc_prep,
+ 	.qc_issue		= pdc20621_qc_issue_prot,
++	.data_xfer		= ata_mmio_data_xfer,
+ 	.eng_timeout		= pdc_eng_timeout,
+ 	.irq_handler		= pdc20621_interrupt,
+ 	.irq_clear		= pdc20621_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_uli.c linux-2.6.16-rc4/drivers/scsi/sata_uli.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_uli.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_uli.c	2006-01-21 17:12:24.000000000 +0000
+@@ -106,6 +106,7 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
+ 
+ 	.eng_timeout		= ata_eng_timeout,
+ 
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_via.c linux-2.6.16-rc4/drivers/scsi/sata_via.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_via.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_via.c	2006-01-21 17:12:51.000000000 +0000
+@@ -126,6 +126,7 @@
+ 
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
+ 
+ 	.eng_timeout		= ata_eng_timeout,
+ 
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/drivers/scsi/sata_vsc.c linux-2.6.16-rc4/drivers/scsi/sata_vsc.c
+--- linux.vanilla-2.6.16-rc4/drivers/scsi/sata_vsc.c	2006-02-20 11:22:25.000000000 +0000
++++ linux-2.6.16-rc4/drivers/scsi/sata_vsc.c	2006-02-20 11:28:11.000000000 +0000
+@@ -280,6 +280,7 @@
+ 	.bmdma_status		= ata_bmdma_status,
+ 	.qc_prep		= ata_qc_prep,
+ 	.qc_issue		= ata_qc_issue_prot,
++	.data_xfer		= ata_pio_data_xfer,
+ 	.eng_timeout		= ata_eng_timeout,
+ 	.irq_handler		= vsc_sata_interrupt,
+ 	.irq_clear		= ata_bmdma_irq_clear,
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/include/linux/ata.h linux-2.6.16-rc4/include/linux/ata.h
+--- linux.vanilla-2.6.16-rc4/include/linux/ata.h	2006-02-20 11:22:26.000000000 +0000
++++ linux-2.6.16-rc4/include/linux/ata.h	2006-02-15 14:39:41.000000000 +0000
+@@ -134,6 +134,8 @@
+ 	ATA_CMD_PIO_READ_EXT	= 0x24,
+ 	ATA_CMD_PIO_WRITE	= 0x30,
+ 	ATA_CMD_PIO_WRITE_EXT	= 0x34,
++	ATA_CMD_READ_NATIVE_MAX	= 0xF8,
++	ATA_CMD_READ_NATIVE_MAX_EXT = 0x27,
+ 	ATA_CMD_READ_MULTI	= 0xC4,
+ 	ATA_CMD_READ_MULTI_EXT	= 0x29,
+ 	ATA_CMD_WRITE_MULTI	= 0xC5,
+@@ -247,18 +249,22 @@
+ };
+ 
+ #define ata_id_is_ata(id)	(((id)[0] & (1 << 15)) == 0)
++#define ata_id_is_cfa(id)	((id)[0] == 0x848A)
+ #define ata_id_is_sata(id)	((id)[93] == 0)
+ #define ata_id_rahead_enabled(id) ((id)[85] & (1 << 6))
+ #define ata_id_wcache_enabled(id) ((id)[85] & (1 << 5))
++#define ata_id_hpa_enabled(id)	((id)[85] & (1 << 10))
+ #define ata_id_has_fua(id)	((id)[84] & (1 << 6))
+ #define ata_id_has_flush(id)	((id)[83] & (1 << 12))
+ #define ata_id_has_flush_ext(id) ((id)[83] & (1 << 13))
+ #define ata_id_has_lba48(id)	((id)[83] & (1 << 10))
++#define ata_id_has_hpa(id)	((id)[82] & (1 << 10))
+ #define ata_id_has_wcache(id)	((id)[82] & (1 << 5))
+ #define ata_id_has_pm(id)	((id)[82] & (1 << 3))
+ #define ata_id_has_lba(id)	((id)[49] & (1 << 9))
+ #define ata_id_has_dma(id)	((id)[49] & (1 << 8))
+ #define ata_id_removeable(id)	((id)[0] & (1 << 7))
++#define ata_id_has_dword_io(id)	((id)[50] & (1 << 0))
+ #define ata_id_u32(id,n)	\
+ 	(((u32) (id)[(n) + 1] << 16) | ((u32) (id)[(n)]))
+ #define ata_id_u64(id,n)	\
+diff -u --new-file --recursive --exclude-from /usr/src/exclude linux.vanilla-2.6.16-rc4/include/linux/libata.h linux-2.6.16-rc4/include/linux/libata.h
+--- linux.vanilla-2.6.16-rc4/include/linux/libata.h	2006-02-20 11:22:26.000000000 +0000
++++ linux-2.6.16-rc4/include/linux/libata.h	2006-02-16 15:41:24.000000000 +0000
+@@ -41,7 +41,7 @@
+ #undef ATA_VERBOSE_DEBUG	/* yet more debugging output */
+ #undef ATA_IRQ_TRAP		/* define to ack screaming irqs */
+ #undef ATA_NDEBUG		/* define to disable quick runtime checks */
+-#undef ATA_ENABLE_PATA		/* define to enable PATA support in some
++#define ATA_ENABLE_PATA		/* define to enable PATA support in some
+ 				 * low-level drivers */
+ #undef ATAPI_ENABLE_DMADIR	/* enables ATAPI DMADIR bridge support */
+ 
+@@ -101,6 +101,7 @@
+ 	ATA_DFLAG_PIO		= (1 << 1), /* device currently in PIO mode */
+ 	ATA_DFLAG_LOCK_SECTORS	= (1 << 2), /* don't adjust max_sectors */
+ 	ATA_DFLAG_LBA		= (1 << 3), /* device supports LBA */
++	ATA_DFLAG_HPA		= (1 << 4), /* device has an HPA */
+ 
+ 	ATA_DEV_UNKNOWN		= 0,	/* unknown device */
+ 	ATA_DEV_ATA		= 1,	/* ATA device */
+@@ -133,6 +134,8 @@
+ 	ATA_QCFLAG_SG		= (1 << 3), /* have s/g table? */
+ 	ATA_QCFLAG_SINGLE	= (1 << 4), /* no s/g, just a single buffer */
+ 	ATA_QCFLAG_DMAMAP	= ATA_QCFLAG_SG | ATA_QCFLAG_SINGLE,
++	
++	ATA_HOST_SIMPLEX	= (1 << 0),	/* Host is simplex, one DMA channel per host_set only */
+ 
+ 	/* various lengths of time */
+ 	ATA_TMOUT_EDD		= 5 * HZ,	/* heuristic */
+@@ -197,6 +200,7 @@
+ 
+ /* forward declarations */
+ struct scsi_device;
++struct ata_host_set;
+ struct ata_port_operations;
+ struct ata_port;
+ struct ata_queued_cmd;
+@@ -237,8 +241,10 @@
+ 	unsigned long		irq;
+ 	unsigned int		irq_flags;
+ 	unsigned long		host_flags;
++	unsigned long		host_set_flags;
+ 	void __iomem		*mmio_base;
+ 	void			*private_data;
++	struct ata_host_set	*host_set;	/* Return not input value */
+ };
+ 
+ struct ata_host_set {
+@@ -250,6 +256,9 @@
+ 	void			*private_data;
+ 	const struct ata_port_operations *ops;
+ 	struct ata_port *	ports[0];
++	unsigned long		host_set_flags;
++	int			simplex_claimed;	/* Keep seperate in case we
++							   ever need to do this locked */
+ };
+ 
+ struct ata_queued_cmd {
+@@ -369,6 +378,7 @@
+ 
+ 	void (*set_piomode) (struct ata_port *, struct ata_device *);
+ 	void (*set_dmamode) (struct ata_port *, struct ata_device *);
++	unsigned int (*mode_filter) (const struct ata_port *, struct ata_device *, unsigned int, int);
+ 
+ 	void (*tf_load) (struct ata_port *ap, const struct ata_taskfile *tf);
+ 	void (*tf_read) (struct ata_port *ap, struct ata_taskfile *tf);
+@@ -379,12 +389,15 @@
+ 	void (*dev_select)(struct ata_port *ap, unsigned int device);
+ 
+ 	void (*phy_reset) (struct ata_port *ap);
++	void (*set_mode) (struct ata_port *ap);
+ 	void (*post_set_mode) (struct ata_port *ap);
+ 
+ 	int (*check_atapi_dma) (struct ata_queued_cmd *qc);
+ 
+ 	void (*bmdma_setup) (struct ata_queued_cmd *qc);
+ 	void (*bmdma_start) (struct ata_queued_cmd *qc);
++	
++	void (*data_xfer) (struct ata_port *, struct ata_device *, unsigned char *, unsigned int, int);
+ 
+ 	void (*qc_prep) (struct ata_queued_cmd *qc);
+ 	int (*qc_issue) (struct ata_queued_cmd *qc);
+@@ -443,8 +456,9 @@
+ extern void ata_pci_remove_one (struct pci_dev *pdev);
+ extern int ata_pci_device_suspend(struct pci_dev *pdev, pm_message_t state);
+ extern int ata_pci_device_resume(struct pci_dev *pdev);
++extern int ata_pci_clear_simplex(struct pci_dev *pdev);
+ #endif /* CONFIG_PCI */
+-extern int ata_device_add(const struct ata_probe_ent *ent);
++extern int ata_device_add(struct ata_probe_ent *ent);
+ extern void ata_host_set_remove(struct ata_host_set *host_set);
+ extern int ata_scsi_detect(struct scsi_host_template *sht);
+ extern int ata_scsi_ioctl(struct scsi_device *dev, int cmd, void __user *arg);
+@@ -491,6 +505,15 @@
+ extern void ata_bmdma_irq_clear(struct ata_port *ap);
+ extern void ata_qc_complete(struct ata_queued_cmd *qc);
+ extern void ata_eng_timeout(struct ata_port *ap);
++extern void ata_mmio_data_xfer(struct ata_port *ap, struct ata_device *adev, unsigned char *buf,
++			       unsigned int buflen, int write_data);
++extern void ata_pio_data_xfer(struct ata_port *ap, struct ata_device *adev, unsigned char *buf,
++			      unsigned int buflen, int write_data);
++extern void ata_mmio_data_xfer_noirq(struct ata_port *ap, struct ata_device *adev, unsigned char *buf,
++			  unsigned int buflen, int do_write);
++extern void ata_pio_data_xfer_noirq(struct ata_port *ap, struct ata_device *adev, unsigned char *buf,
++			  unsigned int buflen, int do_write);
++
+ extern void ata_scsi_simulate(struct ata_port *ap, struct ata_device *dev,
+ 			      struct scsi_cmnd *cmd,
+ 			      void (*done)(struct scsi_cmnd *));
+@@ -498,6 +521,8 @@
+ 			      struct block_device *bdev,
+ 			      sector_t capacity, int geom[]);
+ extern int ata_scsi_slave_config(struct scsi_device *sdev);
++extern struct ata_device *ata_dev_pair(struct ata_port *ap, 
++				       struct ata_device *adev);
+ 
+ /*
+  * Timing helpers
diff --git a/packages/linux/ixp4xx-kernel_2.6.16-rc2.bb b/packages/linux/ixp4xx-kernel_2.6.16-rc4.bb
index a034fca982..af4aa91972 100644
--- a/packages/linux/ixp4xx-kernel_2.6.16-rc2.bb
+++ b/packages/linux/ixp4xx-kernel_2.6.16-rc4.bb
@@ -3,12 +3,12 @@
 # Increment PR_CONFIG for changes to the ixp4xx-kernel specific
 # defconfig (do *NOT* increment anything in here for changes
 # to other kernel configs!)
-PR_CONFIG = "2"
+PR_CONFIG = "0"
 #
 # Increment the number below (i.e. the digits after PR) when
 # making changes within this file or for changes to the patches
 # applied to the kernel.
-PR = "r3.${PR_CONFIG}"
+PR = "r0.${PR_CONFIG}"
 
 include ixp4xx-kernel.inc
 
@@ -17,28 +17,18 @@ RPSRC = "http://www.rpsys.net/openzaurus/patches"
 # IXP4XX_PATCHES - full list of patches to apply
 IXP4XX_PATCHES  = ""
 
-IXP4XX_PATCHES += "file://05-patch-2.6.16-rc2-ide2;patch=1"
+IXP4XX_PATCHES += "file://patch-2.6.16-rc4-ide1;patch=1"
+IXP4XX_PATCHES += "file://leds-class.patch;patch=1"
 IXP4XX_PATCHES += "file://06-remove-extraversion.patch;patch=1"
 IXP4XX_PATCHES += "file://10-mtdpart-redboot-fis-byteswap.patch;patch=1"
-IXP4XX_PATCHES += "file://10-nslu2-fix-flash.patch;patch=1"
 IXP4XX_PATCHES += "file://11-mtdpart-redboot-config-byteswap.patch;patch=1"
 IXP4XX_PATCHES += "file://15-jffs2-endian-config.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_core-r11.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_triggers-r9.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_trig_timer-r4.patch;patch=1"
-# IXP4XX_PATCHES += "${RPSRC}/led_trig_sharpsl_pm-r4a.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_zaurus-r8.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_locomo-r5.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_ixp4xx-r0.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_tosa-r3.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_ide-r2.patch;patch=1"
-IXP4XX_PATCHES += "${RPSRC}/led_nand-r2.patch;patch=1"
-IXP4XX_PATCHES += "file://950-leds-timer.patch;patch=1"
 IXP4XX_PATCHES += "file://951-ixp4xx-leds-cpu-activity.patch;patch=1"
 IXP4XX_PATCHES += "file://40-rtc-class.patch;patch=1"
 IXP4XX_PATCHES += "file://45-eeprom-notifier.patch;patch=1"
 IXP4XX_PATCHES += "file://48-setup-byteswap-cmdline.patch;patch=1"
-IXP4XX_PATCHES += "file://61-ixp4xx-beeper-irq.patch;patch=1"
+IXP4XX_PATCHES += "file://50-i2c-bus-ixp4xx-hwmon.patch;patch=1"
+IXP4XX_PATCHES += "file://50-hwmon-ad741x.patch;patch=1"
 IXP4XX_PATCHES += "file://61-nslu2-beeper.patch;patch=1"
 IXP4XX_PATCHES += "file://65-loft-config.patch;patch=1"
 IXP4XX_PATCHES += "file://80-nas100d-fix-i2c.patch;patch=1"
@@ -60,5 +50,5 @@ IXP4XX_PATCHES += "file://96-nslu2-leds.patch;patch=1"
 IXP4XX_PATCHES += "file://97-ds101-includes.patch;patch=1"
 IXP4XX_PATCHES += "file://97-ds101-misc.patch;patch=1"
 IXP4XX_PATCHES += "file://97-ds101-pci.patch;patch=1"
-IXP4XX_PATCHES += "file://97-ds101-power.patch;patch=1"
+IXP4XX_PATCHES += "file://97-ds101-buttons.patch;patch=1"
 IXP4XX_PATCHES += "file://97-ds101-setup.patch;patch=1"