drivers/ide/legacy/ht6560b.c - LeafOS-Devices/android_kernel_realme_mt6785 - Gitiles

 /*
  *  Copyright (C) 1995-2000  Linus Torvalds & author (see below)
  */

 /*
  *
  *  Version 0.01        Initial version hacked out of ide.c
  *
  *  Version 0.02        Added support for PIO modes, auto-tune
  *
  *  Version 0.03        Some cleanups
  *
  *  Version 0.05        PIO mode cycle timings auto-tune using bus-speed
  *
  *  Version 0.06        Prefetch mode now defaults no OFF. To set
  *                      prefetch mode OFF/ON use "hdparm -p8/-p9".
  *                      Unmask irq is disabled when prefetch mode
  *                      is enabled.
  *
  *  Version 0.07        Trying to fix CD-ROM detection problem.
  *                      "Prefetch" mode bit OFF for ide disks and
  *                      ON for anything else.
  *
  *  Version 0.08        Need to force prefetch for CDs and other non-disk
  *                      devices. (not sure which devices exactly need
  *                      prefetch)
  *
  *  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   <janevert@caiway.nl>
  *
  *  Try:  http://www.maf.iki.fi/~maf/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/hdreg.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->present)
 		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[IDE_SELECT_OFFSET]);
 		(void)inb(hwif->io_ports[IDE_STATUS_OFFSET]);
 #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 = system_bus_clock();

         if (pio) {
 		unsigned int cycle_time;

 		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 = ide_pio_timings[pio].active_time;
 		recovery_time = cycle_time
 			- active_time
 			- ide_pio_timings[pio].setup_time;
 		/*
 		 *  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->no_unmask = 1;
 		drive->unmask = 0;
 	} else {
 		drive->drive_data &= ~t;  /* disable prefetch mode */
 		drive->no_unmask = 0;
 	}

 	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_port_init_devs(ide_hwif_t *hwif)
 {
 	/* Setting default configurations for drives. */
 	int t = (HT_CONFIG_DEFAULT << 8) | HT_TIMING_DEFAULT;

 	if (hwif->channel)
 		t |= (HT_SECONDARY_IF << 8);

 	hwif->drives[0].drive_data = t;
 	hwif->drives[1].drive_data = t;
 }

 int probe_ht6560b = 0;

 module_param_named(probe, probe_ht6560b, bool, 0);
 MODULE_PARM_DESC(probe, "probe for HT6560B chipset");

 static const struct ide_port_info ht6560b_port_info __initdata = {
 	.chipset		= ide_ht6560b,
 	.host_flags		= IDE_HFLAG_SERIALIZE | /* is this needed? */
 				  IDE_HFLAG_NO_DMA |
 				  IDE_HFLAG_NO_AUTOTUNE |
 				  IDE_HFLAG_ABUSE_PREFETCH,
 	.pio_mask		= ATA_PIO4,
 };

 static int __init ht6560b_init(void)
 {
 	ide_hwif_t *hwif, *mate;
 	static u8 idx[4] = { 0, 1, 0xff, 0xff };
 	hw_regs_t hw[2];

 	if (probe_ht6560b == 0)
 		return -ENODEV;

 	hwif = &ide_hwifs[0];
 	mate = &ide_hwifs[1];

 	if (!request_region(HT_CONFIG_PORT, 1, hwif->name)) {
 		printk(KERN_NOTICE "%s: HT_CONFIG_PORT not found\n",
 			__FUNCTION__);
 		return -ENODEV;
 	}

 	if (!try_to_init_ht6560b()) {
 		printk(KERN_NOTICE "%s: HBA not found\n", __FUNCTION__);
 		goto release_region;
 	}

 	memset(&hw, 0, sizeof(hw));

 	ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
 	hw[0].irq = 14;

 	ide_std_init_ports(&hw[1], 0x170, 0x376);
 	hw[1].irq = 15;

 	ide_init_port_hw(hwif, &hw[0]);
 	ide_init_port_hw(mate, &hw[1]);

 	hwif->selectproc = &ht6560b_selectproc;
 	hwif->set_pio_mode = &ht6560b_set_pio_mode;

 	mate->selectproc = &ht6560b_selectproc;
 	mate->set_pio_mode = &ht6560b_set_pio_mode;

 	hwif->port_init_devs = ht6560b_port_init_devs;
 	mate->port_init_devs = ht6560b_port_init_devs;

 	ide_device_add(idx, &ht6560b_port_info);

 	return 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");
	/*
	* Copyright (C) 1995-2000 Linus Torvalds & author (see below)
	*/

	/*
	*
	* Version 0.01 Initial version hacked out of ide.c
	*
	* Version 0.02 Added support for PIO modes, auto-tune
	*
	* Version 0.03 Some cleanups
	*
	* Version 0.05 PIO mode cycle timings auto-tune using bus-speed
	*
	* Version 0.06 Prefetch mode now defaults no OFF. To set
	* prefetch mode OFF/ON use "hdparm -p8/-p9".
	* Unmask irq is disabled when prefetch mode
	* is enabled.
	*
	* Version 0.07 Trying to fix CD-ROM detection problem.
	* "Prefetch" mode bit OFF for ide disks and
	* ON for anything else.
	*
	* Version 0.08 Need to force prefetch for CDs and other non-disk
	* devices. (not sure which devices exactly need
	* prefetch)
	*
	* 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 <janevert@caiway.nl>
	*
	* Try: http://www.maf.iki.fi/~maf/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/hdreg.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->present)
	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[IDE_SELECT_OFFSET]);
	(void)inb(hwif->io_ports[IDE_STATUS_OFFSET]);
	#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 = system_bus_clock();

	if (pio) {
	unsigned int cycle_time;

	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 = ide_pio_timings[pio].active_time;
	recovery_time = cycle_time
	- active_time
	- ide_pio_timings[pio].setup_time;
	/*
	* 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->no_unmask = 1;
	drive->unmask = 0;
	} else {
	drive->drive_data &= ~t; /* disable prefetch mode */
	drive->no_unmask = 0;
	}

	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_port_init_devs(ide_hwif_t *hwif)
	{
	/* Setting default configurations for drives. */
	int t = (HT_CONFIG_DEFAULT << 8) \| HT_TIMING_DEFAULT;

	if (hwif->channel)
	t \|= (HT_SECONDARY_IF << 8);

	hwif->drives[0].drive_data = t;
	hwif->drives[1].drive_data = t;
	}

	int probe_ht6560b = 0;

	module_param_named(probe, probe_ht6560b, bool, 0);
	MODULE_PARM_DESC(probe, "probe for HT6560B chipset");

	static const struct ide_port_info ht6560b_port_info __initdata = {
	.chipset = ide_ht6560b,
	.host_flags = IDE_HFLAG_SERIALIZE \| /* is this needed? */
	IDE_HFLAG_NO_DMA \|
	IDE_HFLAG_NO_AUTOTUNE \|
	IDE_HFLAG_ABUSE_PREFETCH,
	.pio_mask = ATA_PIO4,
	};

	static int __init ht6560b_init(void)
	{
	ide_hwif_t hwif, mate;
	static u8 idx[4] = { 0, 1, 0xff, 0xff };
	hw_regs_t hw[2];

	if (probe_ht6560b == 0)
	return -ENODEV;

	hwif = &ide_hwifs[0];
	mate = &ide_hwifs[1];

	if (!request_region(HT_CONFIG_PORT, 1, hwif->name)) {
	printk(KERN_NOTICE "%s: HT_CONFIG_PORT not found\n",
	__FUNCTION__);
	return -ENODEV;
	}

	if (!try_to_init_ht6560b()) {
	printk(KERN_NOTICE "%s: HBA not found\n", __FUNCTION__);
	goto release_region;
	}

	memset(&hw, 0, sizeof(hw));

	ide_std_init_ports(&hw[0], 0x1f0, 0x3f6);
	hw[0].irq = 14;

	ide_std_init_ports(&hw[1], 0x170, 0x376);
	hw[1].irq = 15;

	ide_init_port_hw(hwif, &hw[0]);
	ide_init_port_hw(mate, &hw[1]);

	hwif->selectproc = &ht6560b_selectproc;
	hwif->set_pio_mode = &ht6560b_set_pio_mode;

	mate->selectproc = &ht6560b_selectproc;
	mate->set_pio_mode = &ht6560b_set_pio_mode;

	hwif->port_init_devs = ht6560b_port_init_devs;
	mate->port_init_devs = ht6560b_port_init_devs;

	ide_device_add(idx, &ht6560b_port_info);

	return 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");