1 files changed, 351 insertions, 0 deletions
diff --git a/drivers/ide/ht6560b.c b/drivers/ide/ht6560b.c
new file mode 100644
index 000000000000..c7e5c2246b79
--- /dev/null
+++ b/drivers/ide/ht6560b.c
@@ -0,0 +1,351 @@
+/*
+ *  Copyright (C) 1995-2000  Linus Torvalds & author (see below)
+ */
+/*
+ *  HT-6560B EIDE-controller support
+ *  To activate controller support use kernel parameter "ide0=ht6560b".
+ *  Use hdparm utility to enable PIO mode support.
+ *
+ *  Author:    Mikko Ala-Fossi            <maf@iki.fi>
+ *             Jan Evert van Grootheest   <j.e.van.grootheest@caiway.nl>
+ *
+ *  Try:  http://www.maf.iki.fi/~maf/ht6560b/
+ */
+#define DRV_NAME        "ht6560b"
+#define HT6560B_VERSION "v0.08"
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/timer.h>
+#include <linux/mm.h>
+#include <linux/ioport.h>
+#include <linux/blkdev.h>
+#include <linux/ide.h>
+#include <linux/init.h>
+#include <asm/io.h>
+/* #define DEBUG */  /* remove comments for DEBUG messages */
+/*
+ * The special i/o-port that HT-6560B uses to configuration:
+ *    bit0 (0x01): "1" selects secondary interface
+ *    bit2 (0x04): "1" enables FIFO function
+ *    bit5 (0x20): "1" enables prefetched data read function  (???)
+ *
+ * The special i/o-port that HT-6560A uses to configuration:
+ *    bit0 (0x01): "1" selects secondary interface
+ *    bit1 (0x02): "1" enables prefetched data read function
+ *    bit2 (0x04): "0" enables multi-master system            (?)
+ *    bit3 (0x08): "1" 3 cycle time, "0" 2 cycle time         (?)
+ */
+#define HT_CONFIG_PORT    0x3e6
+#define HT_CONFIG(drivea) (u8)(((drivea)->drive_data & 0xff00) >> 8)
+/*
+ * FIFO + PREFETCH (both a/b-model)
+ */
+#define HT_CONFIG_DEFAULT 0x1c /* no prefetch */
+/* #define HT_CONFIG_DEFAULT 0x3c */ /* with prefetch */
+#define HT_SECONDARY_IF   0x01
+#define HT_PREFETCH_MODE  0x20
+/*
+ * ht6560b Timing values:
+ *
+ * I reviewed some assembler source listings of htide drivers and found
+ * out how they setup those cycle time interfacing values, as they at Holtek
+ * call them. IDESETUP.COM that is supplied with the drivers figures out
+ * optimal values and fetches those values to drivers. I found out that
+ * they use Select register to fetch timings to the ide board right after
+ * interface switching. After that it was quite easy to add code to
+ * ht6560b.c.
+ *
+ * IDESETUP.COM gave me values 0x24, 0x45, 0xaa, 0xff that worked fine
+ * for hda and hdc. But hdb needed higher values to work, so I guess
+ * that sometimes it is necessary to give higher value than IDESETUP
+ * gives.   [see cmd640.c for an extreme example of this. -ml]
+ *
+ * Perhaps I should explain something about these timing values:
+ * The higher nibble of value is the Recovery Time  (rt) and the lower nibble
+ * of the value is the Active Time  (at). Minimum value 2 is the fastest and
+ * the maximum value 15 is the slowest. Default values should be 15 for both.
+ * So 0x24 means 2 for rt and 4 for at. Each of the drives should have
+ * both values, and IDESETUP gives automatically rt=15 st=15 for CDROMs or
+ * similar. If value is too small there will be all sorts of failures.
+ *
+ * Timing byte consists of
+ *      High nibble:  Recovery Cycle Time  (rt)
+ *           The valid values range from 2 to 15. The default is 15.
+ *
+ *      Low nibble:   Active Cycle Time    (at)
+ *           The valid values range from 2 to 15. The default is 15.
+ *
+ * You can obtain optimized timing values by running Holtek IDESETUP.COM
+ * for DOS. DOS drivers get their timing values from command line, where
+ * the first value is the Recovery Time and the second value is the
+ * Active Time for each drive. Smaller value gives higher speed.
+ * In case of failures you should probably fall back to a higher value.
+ */
+#define HT_TIMING(drivea) (u8)((drivea)->drive_data & 0x00ff)
+#define HT_TIMING_DEFAULT 0xff
+/*
+ * This routine handles interface switching for the peculiar hardware design
+ * on the F.G.I./Holtek HT-6560B VLB IDE interface.
+ * The HT-6560B can only enable one IDE port at a time, and requires a
+ * silly sequence (below) whenever we switch between primary and secondary.
+ */
+/*
+ * This routine is invoked from ide.c to prepare for access to a given drive.
+ */
+static void ht6560b_selectproc (ide_drive_t *drive)
+{
+        ide_hwif_t *hwif = drive->hwif;
+        unsigned long flags;
+        static u8 current_select = 0;
+        static u8 current_timing = 0;
+        u8 select, timing;
+        
+        local_irq_save(flags);
+        select = HT_CONFIG(drive);
+        timing = HT_TIMING(drive);
+        /*
+         * Need to enforce prefetch sometimes because otherwise
+         * it'll hang (hard).
+         */
+        if (drive->media != ide_disk ||
+            (drive->dev_flags & IDE_DFLAG_PRESENT) == 0)
+                select |= HT_PREFETCH_MODE;
+        if (select != current_select || timing != current_timing) {
+                current_select = select;
+                current_timing = timing;
+                (void)inb(HT_CONFIG_PORT);
+                (void)inb(HT_CONFIG_PORT);
+                (void)inb(HT_CONFIG_PORT);
+                (void)inb(HT_CONFIG_PORT);
+                outb(select, HT_CONFIG_PORT);
+                /*
+                 * Set timing for this drive:
+                 */
+                outb(timing, hwif->io_ports.device_addr);
+                (void)inb(hwif->io_ports.status_addr);
+#ifdef DEBUG
+                printk("ht6560b: %s: select=%#x timing=%#x\n",
+                        drive->name, select, timing);
+#endif
+        }
+        local_irq_restore(flags);
+}
+/*
+ * Autodetection and initialization of ht6560b
+ */
+static int __init try_to_init_ht6560b(void)
+{
+        u8 orig_value;
+        int i;
+        
+        /* Autodetect ht6560b */
+        if ((orig_value = inb(HT_CONFIG_PORT)) == 0xff)
+                return 0;
+        
+        for (i=3;i>0;i--) {
+                outb(0x00, HT_CONFIG_PORT);
+                if (!( (~inb(HT_CONFIG_PORT)) & 0x3f )) {
+                        outb(orig_value, HT_CONFIG_PORT);
+                        return 0;
+                }
+        }
+        outb(0x00, HT_CONFIG_PORT);
+        if ((~inb(HT_CONFIG_PORT))& 0x3f) {
+                outb(orig_value, HT_CONFIG_PORT);
+                return 0;
+        }
+        /*
+         * Ht6560b autodetected
+         */
+        outb(HT_CONFIG_DEFAULT, HT_CONFIG_PORT);
+        outb(HT_TIMING_DEFAULT, 0x1f6); /* Select register */
+        (void)inb(0x1f7);               /* Status register */
+        printk("ht6560b " HT6560B_VERSION
+               ": chipset detected and initialized"
+#ifdef DEBUG
+               " with debug enabled"
+#endif
+               "\n"
+                );
+        return 1;
+}
+static u8 ht_pio2timings(ide_drive_t *drive, const u8 pio)
+{
+        int active_time, recovery_time;
+        int active_cycles, recovery_cycles;
+        int bus_speed = ide_vlb_clk ? ide_vlb_clk : 50;
+        if (pio) {
+                unsigned int cycle_time;
+                struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio);
+                cycle_time = ide_pio_cycle_time(drive, pio);
+                /*
+                 *  Just like opti621.c we try to calculate the
+                 *  actual cycle time for recovery and activity
+                 *  according system bus speed.
+                 */
+                active_time = t->active;
+                recovery_time = cycle_time - active_time - t->setup;
+                /*
+                 *  Cycle times should be Vesa bus cycles
+                 */
+                active_cycles   = (active_time   * bus_speed + 999) / 1000;
+                recovery_cycles = (recovery_time * bus_speed + 999) / 1000;
+                /*
+                 *  Upper and lower limits
+                 */
+                if (active_cycles   < 2)  active_cycles   = 2;
+                if (recovery_cycles < 2)  recovery_cycles = 2;
+                if (active_cycles   > 15) active_cycles   = 15;
+                if (recovery_cycles > 15) recovery_cycles = 0;  /* 0==16 */
+                
+#ifdef DEBUG
+                printk("ht6560b: drive %s setting pio=%d recovery=%d (%dns) active=%d (%dns)\n", drive->name, pio, recovery_cycles, recovery_time, active_cycles, active_time);
+#endif
+                
+                return (u8)((recovery_cycles << 4) | active_cycles);
+        } else {
+                
+#ifdef DEBUG
+                printk("ht6560b: drive %s setting pio=0\n", drive->name);
+#endif
+                
+                return HT_TIMING_DEFAULT;    /* default setting */
+        }
+}
+static DEFINE_SPINLOCK(ht6560b_lock);
+/*
+ *  Enable/Disable so called prefetch mode
+ */
+static void ht_set_prefetch(ide_drive_t *drive, u8 state)
+{
+        unsigned long flags;
+        int t = HT_PREFETCH_MODE << 8;
+        spin_lock_irqsave(&ht6560b_lock, flags);
+        /*
+         *  Prefetch mode and unmask irq seems to conflict
+         */
+        if (state) {
+                drive->drive_data |= t;   /* enable prefetch mode */
+                drive->dev_flags |= IDE_DFLAG_NO_UNMASK;
+                drive->dev_flags &= ~IDE_DFLAG_UNMASK;
+        } else {
+                drive->drive_data &= ~t;  /* disable prefetch mode */
+                drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK;
+        }
+        spin_unlock_irqrestore(&ht6560b_lock, flags);
+#ifdef DEBUG
+        printk("ht6560b: drive %s prefetch mode %sabled\n", drive->name, (state ? "en" : "dis"));
+#endif
+}
+static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio)
+{
+        unsigned long flags;
+        u8 timing;
+        
+        switch (pio) {
+        case 8:         /* set prefetch off */
+        case 9:         /* set prefetch on */
+                ht_set_prefetch(drive, pio & 1);
+                return;
+        }
+        timing = ht_pio2timings(drive, pio);
+        spin_lock_irqsave(&ht6560b_lock, flags);
+        drive->drive_data &= 0xff00;
+        drive->drive_data |= timing;
+        spin_unlock_irqrestore(&ht6560b_lock, flags);
+#ifdef DEBUG
+        printk("ht6560b: drive %s tuned to pio mode %#x timing=%#x\n", drive->name, pio, timing);
+#endif
+}
+static void __init ht6560b_init_dev(ide_drive_t *drive)
+{
+        ide_hwif_t *hwif = drive->hwif;
+        /* Setting default configurations for drives. */
+        int t = (HT_CONFIG_DEFAULT << 8) | HT_TIMING_DEFAULT;
+        if (hwif->channel)
+                t |= (HT_SECONDARY_IF << 8);
+        drive->drive_data = t;
+}
+static int probe_ht6560b;
+module_param_named(probe, probe_ht6560b, bool, 0);
+MODULE_PARM_DESC(probe, "probe for HT6560B chipset");
+static const struct ide_port_ops ht6560b_port_ops = {
+        .init_dev               = ht6560b_init_dev,
+        .set_pio_mode           = ht6560b_set_pio_mode,
+        .selectproc             = ht6560b_selectproc,
+};
+static const struct ide_port_info ht6560b_port_info __initdata = {
+        .name                   = DRV_NAME,
+        .chipset                = ide_ht6560b,
+        .port_ops               = &ht6560b_port_ops,
+        .host_flags             = IDE_HFLAG_SERIALIZE | /* is this needed? */
+                                  IDE_HFLAG_NO_DMA |
+                                  IDE_HFLAG_ABUSE_PREFETCH,
+        .pio_mask               = ATA_PIO4,
+};
+static int __init ht6560b_init(void)
+{
+        if (probe_ht6560b == 0)
+                return -ENODEV;
+        if (!request_region(HT_CONFIG_PORT, 1, DRV_NAME)) {
+                printk(KERN_NOTICE "%s: HT_CONFIG_PORT not found\n",
+                        __func__);
+                return -ENODEV;
+        }
+        if (!try_to_init_ht6560b()) {
+                printk(KERN_NOTICE "%s: HBA not found\n", __func__);
+                goto release_region;
+        }
+        return ide_legacy_device_add(&ht6560b_port_info, 0);
+release_region:
+        release_region(HT_CONFIG_PORT, 1);
+        return -ENODEV;
+}
+module_init(ht6560b_init);
+MODULE_AUTHOR("See Local File");
+MODULE_DESCRIPTION("HT-6560B EIDE-controller support");
+MODULE_LICENSE("GPL");

diff --git a/drivers/ide/ht6560b.c b/drivers/ide/ht6560b.c new file mode 100644 index 000000000000..c7e5c2246b79 --- /dev/null +++ b/drivers/ide/ht6560b.c
@@ -0,0 +1,351 @@
	1	/*
	2	* Copyright (C) 1995-2000 Linus Torvalds & author (see below)
	3	*/
	4
	5	/*
	6	* HT-6560B EIDE-controller support
	7	* To activate controller support use kernel parameter "ide0=ht6560b".
	8	* Use hdparm utility to enable PIO mode support.
	9	*
	10	* Author: Mikko Ala-Fossi <maf@iki.fi>
	11	* Jan Evert van Grootheest <j.e.van.grootheest@caiway.nl>
	12	*
	13	* Try: http://www.maf.iki.fi/~maf/ht6560b/
	14	*/
	15
	16	#define DRV_NAME "ht6560b"
	17	#define HT6560B_VERSION "v0.08"
	18
	19	#include <linux/module.h>
	20	#include <linux/types.h>
	21	#include <linux/kernel.h>
	22	#include <linux/delay.h>
	23	#include <linux/timer.h>
	24	#include <linux/mm.h>
	25	#include <linux/ioport.h>
	26	#include <linux/blkdev.h>
	27	#include <linux/ide.h>
	28	#include <linux/init.h>
	29
	30	#include <asm/io.h>
	31
	32	/* #define DEBUG / / remove comments for DEBUG messages */
	33
	34	/*
	35	* The special i/o-port that HT-6560B uses to configuration:
	36	* bit0 (0x01): "1" selects secondary interface
	37	* bit2 (0x04): "1" enables FIFO function
	38	* bit5 (0x20): "1" enables prefetched data read function (???)
	39	*
	40	* The special i/o-port that HT-6560A uses to configuration:
	41	* bit0 (0x01): "1" selects secondary interface
	42	* bit1 (0x02): "1" enables prefetched data read function
	43	* bit2 (0x04): "0" enables multi-master system (?)
	44	* bit3 (0x08): "1" 3 cycle time, "0" 2 cycle time (?)
	45	*/
	46	#define HT_CONFIG_PORT 0x3e6
	47	#define HT_CONFIG(drivea) (u8)(((drivea)->drive_data & 0xff00) >> 8)
	48	/*
	49	* FIFO + PREFETCH (both a/b-model)
	50	*/
	51	#define HT_CONFIG_DEFAULT 0x1c /* no prefetch */
	52	/* #define HT_CONFIG_DEFAULT 0x3c / / with prefetch */
	53	#define HT_SECONDARY_IF 0x01
	54	#define HT_PREFETCH_MODE 0x20
	55
	56	/*
	57	* ht6560b Timing values:
	58	*
	59	* I reviewed some assembler source listings of htide drivers and found
	60	* out how they setup those cycle time interfacing values, as they at Holtek
	61	* call them. IDESETUP.COM that is supplied with the drivers figures out
	62	* optimal values and fetches those values to drivers. I found out that
	63	* they use Select register to fetch timings to the ide board right after
	64	* interface switching. After that it was quite easy to add code to
	65	* ht6560b.c.
	66	*
	67	* IDESETUP.COM gave me values 0x24, 0x45, 0xaa, 0xff that worked fine
	68	* for hda and hdc. But hdb needed higher values to work, so I guess
	69	* that sometimes it is necessary to give higher value than IDESETUP
	70	* gives. [see cmd640.c for an extreme example of this. -ml]
	71	*
	72	* Perhaps I should explain something about these timing values:
	73	* The higher nibble of value is the Recovery Time (rt) and the lower nibble
	74	* of the value is the Active Time (at). Minimum value 2 is the fastest and
	75	* the maximum value 15 is the slowest. Default values should be 15 for both.
	76	* So 0x24 means 2 for rt and 4 for at. Each of the drives should have
	77	* both values, and IDESETUP gives automatically rt=15 st=15 for CDROMs or
	78	* similar. If value is too small there will be all sorts of failures.
	79	*
	80	* Timing byte consists of
	81	* High nibble: Recovery Cycle Time (rt)
	82	* The valid values range from 2 to 15. The default is 15.
	83	*
	84	* Low nibble: Active Cycle Time (at)
	85	* The valid values range from 2 to 15. The default is 15.
	86	*
	87	* You can obtain optimized timing values by running Holtek IDESETUP.COM
	88	* for DOS. DOS drivers get their timing values from command line, where
	89	* the first value is the Recovery Time and the second value is the
	90	* Active Time for each drive. Smaller value gives higher speed.
	91	* In case of failures you should probably fall back to a higher value.
	92	*/
	93	#define HT_TIMING(drivea) (u8)((drivea)->drive_data & 0x00ff)
	94	#define HT_TIMING_DEFAULT 0xff
	95
	96	/*
	97	* This routine handles interface switching for the peculiar hardware design
	98	* on the F.G.I./Holtek HT-6560B VLB IDE interface.
	99	* The HT-6560B can only enable one IDE port at a time, and requires a
	100	* silly sequence (below) whenever we switch between primary and secondary.
	101	*/
	102
	103	/*
	104	* This routine is invoked from ide.c to prepare for access to a given drive.
	105	*/
	106	static void ht6560b_selectproc (ide_drive_t *drive)
	107	{
	108	ide_hwif_t *hwif = drive->hwif;
	109	unsigned long flags;
	110	static u8 current_select = 0;
	111	static u8 current_timing = 0;
	112	u8 select, timing;
	113
	114	local_irq_save(flags);
	115
	116	select = HT_CONFIG(drive);
	117	timing = HT_TIMING(drive);
	118
	119	/*
	120	* Need to enforce prefetch sometimes because otherwise
	121	* it'll hang (hard).
	122	*/
	123	if (drive->media != ide_disk \|\|
	124	(drive->dev_flags & IDE_DFLAG_PRESENT) == 0)
	125	select \|= HT_PREFETCH_MODE;
	126
	127	if (select != current_select \|\| timing != current_timing) {
	128	current_select = select;
	129	current_timing = timing;
	130	(void)inb(HT_CONFIG_PORT);
	131	(void)inb(HT_CONFIG_PORT);
	132	(void)inb(HT_CONFIG_PORT);
	133	(void)inb(HT_CONFIG_PORT);
	134	outb(select, HT_CONFIG_PORT);
	135	/*
	136	* Set timing for this drive:
	137	*/
	138	outb(timing, hwif->io_ports.device_addr);
	139	(void)inb(hwif->io_ports.status_addr);
	140	#ifdef DEBUG
	141	printk("ht6560b: %s: select=%#x timing=%#x\n",
	142	drive->name, select, timing);
	143	#endif
	144	}
	145	local_irq_restore(flags);
	146	}
	147
	148	/*
	149	* Autodetection and initialization of ht6560b
	150	*/
	151	static int __init try_to_init_ht6560b(void)
	152	{
	153	u8 orig_value;
	154	int i;
	155
	156	/* Autodetect ht6560b */
	157	if ((orig_value = inb(HT_CONFIG_PORT)) == 0xff)
	158	return 0;
	159
	160	for (i=3;i>0;i--) {
	161	outb(0x00, HT_CONFIG_PORT);
	162	if (!( (~inb(HT_CONFIG_PORT)) & 0x3f )) {
	163	outb(orig_value, HT_CONFIG_PORT);
	164	return 0;
	165	}
	166	}
	167	outb(0x00, HT_CONFIG_PORT);
	168	if ((~inb(HT_CONFIG_PORT))& 0x3f) {
	169	outb(orig_value, HT_CONFIG_PORT);
	170	return 0;
	171	}
	172	/*
	173	* Ht6560b autodetected
	174	*/
	175	outb(HT_CONFIG_DEFAULT, HT_CONFIG_PORT);
	176	outb(HT_TIMING_DEFAULT, 0x1f6); /* Select register */
	177	(void)inb(0x1f7); /* Status register */
	178
	179	printk("ht6560b " HT6560B_VERSION
	180	": chipset detected and initialized"
	181	#ifdef DEBUG
	182	" with debug enabled"
	183	#endif
	184	"\n"
	185	);
	186	return 1;
	187	}
	188
	189	static u8 ht_pio2timings(ide_drive_t *drive, const u8 pio)
	190	{
	191	int active_time, recovery_time;
	192	int active_cycles, recovery_cycles;
	193	int bus_speed = ide_vlb_clk ? ide_vlb_clk : 50;
	194
	195	if (pio) {
	196	unsigned int cycle_time;
	197	struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio);
	198
	199	cycle_time = ide_pio_cycle_time(drive, pio);
	200
	201	/*
	202	* Just like opti621.c we try to calculate the
	203	* actual cycle time for recovery and activity
	204	* according system bus speed.
	205	*/
	206	active_time = t->active;
	207	recovery_time = cycle_time - active_time - t->setup;
	208	/*
	209	* Cycle times should be Vesa bus cycles
	210	*/
	211	active_cycles = (active_time * bus_speed + 999) / 1000;
	212	recovery_cycles = (recovery_time * bus_speed + 999) / 1000;
	213	/*
	214	* Upper and lower limits
	215	*/
	216	if (active_cycles < 2) active_cycles = 2;
	217	if (recovery_cycles < 2) recovery_cycles = 2;
	218	if (active_cycles > 15) active_cycles = 15;
	219	if (recovery_cycles > 15) recovery_cycles = 0; /* 0==16 */
	220
	221	#ifdef DEBUG
	222	printk("ht6560b: drive %s setting pio=%d recovery=%d (%dns) active=%d (%dns)\n", drive->name, pio, recovery_cycles, recovery_time, active_cycles, active_time);
	223	#endif
	224
	225	return (u8)((recovery_cycles << 4) \| active_cycles);
	226	} else {
	227
	228	#ifdef DEBUG
	229	printk("ht6560b: drive %s setting pio=0\n", drive->name);
	230	#endif
	231
	232	return HT_TIMING_DEFAULT; /* default setting */
	233	}
	234	}
	235
	236	static DEFINE_SPINLOCK(ht6560b_lock);
	237
	238	/*
	239	* Enable/Disable so called prefetch mode
	240	*/
	241	static void ht_set_prefetch(ide_drive_t *drive, u8 state)
	242	{
	243	unsigned long flags;
	244	int t = HT_PREFETCH_MODE << 8;
	245
	246	spin_lock_irqsave(&ht6560b_lock, flags);
	247
	248	/*
	249	* Prefetch mode and unmask irq seems to conflict
	250	*/
	251	if (state) {
	252	drive->drive_data \|= t; /* enable prefetch mode */
	253	drive->dev_flags \|= IDE_DFLAG_NO_UNMASK;
	254	drive->dev_flags &= ~IDE_DFLAG_UNMASK;
	255	} else {
	256	drive->drive_data &= ~t; /* disable prefetch mode */
	257	drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK;
	258	}
	259
	260	spin_unlock_irqrestore(&ht6560b_lock, flags);
	261
	262	#ifdef DEBUG
	263	printk("ht6560b: drive %s prefetch mode %sabled\n", drive->name, (state ? "en" : "dis"));
	264	#endif
	265	}
	266
	267	static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio)
	268	{
	269	unsigned long flags;
	270	u8 timing;
	271
	272	switch (pio) {
	273	case 8: /* set prefetch off */
	274	case 9: /* set prefetch on */
	275	ht_set_prefetch(drive, pio & 1);
	276	return;
	277	}
	278
	279	timing = ht_pio2timings(drive, pio);
	280
	281	spin_lock_irqsave(&ht6560b_lock, flags);
	282	drive->drive_data &= 0xff00;
	283	drive->drive_data \|= timing;
	284	spin_unlock_irqrestore(&ht6560b_lock, flags);
	285
	286	#ifdef DEBUG
	287	printk("ht6560b: drive %s tuned to pio mode %#x timing=%#x\n", drive->name, pio, timing);
	288	#endif
	289	}
	290
	291	static void __init ht6560b_init_dev(ide_drive_t *drive)
	292	{
	293	ide_hwif_t *hwif = drive->hwif;
	294	/* Setting default configurations for drives. */
	295	int t = (HT_CONFIG_DEFAULT << 8) \| HT_TIMING_DEFAULT;
	296
	297	if (hwif->channel)
	298	t \|= (HT_SECONDARY_IF << 8);
	299
	300	drive->drive_data = t;
	301	}
	302
	303	static int probe_ht6560b;
	304
	305	module_param_named(probe, probe_ht6560b, bool, 0);
	306	MODULE_PARM_DESC(probe, "probe for HT6560B chipset");
	307
	308	static const struct ide_port_ops ht6560b_port_ops = {
	309	.init_dev = ht6560b_init_dev,
	310	.set_pio_mode = ht6560b_set_pio_mode,
	311	.selectproc = ht6560b_selectproc,
	312	};
	313
	314	static const struct ide_port_info ht6560b_port_info __initdata = {
	315	.name = DRV_NAME,
	316	.chipset = ide_ht6560b,
	317	.port_ops = &ht6560b_port_ops,
	318	.host_flags = IDE_HFLAG_SERIALIZE \| /* is this needed? */
	319	IDE_HFLAG_NO_DMA \|
	320	IDE_HFLAG_ABUSE_PREFETCH,
	321	.pio_mask = ATA_PIO4,
	322	};
	323
	324	static int __init ht6560b_init(void)
	325	{
	326	if (probe_ht6560b == 0)
	327	return -ENODEV;
	328
	329	if (!request_region(HT_CONFIG_PORT, 1, DRV_NAME)) {
	330	printk(KERN_NOTICE "%s: HT_CONFIG_PORT not found\n",
	331	__func__);
	332	return -ENODEV;
	333	}
	334
	335	if (!try_to_init_ht6560b()) {
	336	printk(KERN_NOTICE "%s: HBA not found\n", __func__);
	337	goto release_region;
	338	}
	339
	340	return ide_legacy_device_add(&ht6560b_port_info, 0);
	341
	342	release_region:
	343	release_region(HT_CONFIG_PORT, 1);
	344	return -ENODEV;
	345	}
	346
	347	module_init(ht6560b_init);
	348
	349	MODULE_AUTHOR("See Local File");
	350	MODULE_DESCRIPTION("HT-6560B EIDE-controller support");
	351	MODULE_LICENSE("GPL");