[linux-2.6-block.git] / drivers / ide / ht6560b.c

/*
 *  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>
 *
 */

#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

static inline u8 HT_CONFIG(ide_drive_t *drive)
{
	return ((unsigned long)ide_get_drivedata(drive) & 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.
 */
static inline u8 HT_TIMING(ide_drive_t *drive)
{
	return (unsigned long)ide_get_drivedata(drive) & 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_dev_select(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);

	outb(drive->select | ATA_DEVICE_OBS, hwif->io_ports.device_addr);
}

/*
 * 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, config;
	int t = HT_PREFETCH_MODE << 8;

	spin_lock_irqsave(&ht6560b_lock, flags);

	config = (unsigned long)ide_get_drivedata(drive);

	/*
	 *  Prefetch mode and unmask irq seems to conflict
	 */
	if (state) {
		config |= t;   /* enable prefetch mode */
		drive->dev_flags |= IDE_DFLAG_NO_UNMASK;
		drive->dev_flags &= ~IDE_DFLAG_UNMASK;
	} else {
		config &= ~t;  /* disable prefetch mode */
		drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK;
	}

	ide_set_drivedata(drive, (void *)config);

	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_hwif_t *hwif, ide_drive_t *drive)
{
	unsigned long flags, config;
	const u8 pio = drive->pio_mode - XFER_PIO_0;
	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);
	config = (unsigned long)ide_get_drivedata(drive);
	config &= 0xff00;
	config |= timing;
	ide_set_drivedata(drive, (void *)config);
	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);

	ide_set_drivedata(drive, (void *)t);
}

static bool probe_ht6560b;

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

static const struct ide_tp_ops ht6560b_tp_ops = {
	.exec_command		= ide_exec_command,
	.read_status		= ide_read_status,
	.read_altstatus		= ide_read_altstatus,
	.write_devctl		= ide_write_devctl,

	.dev_select		= ht6560b_dev_select,
	.tf_load		= ide_tf_load,
	.tf_read		= ide_tf_read,

	.input_data		= ide_input_data,
	.output_data		= ide_output_data,
};

static const struct ide_port_ops ht6560b_port_ops = {
	.init_dev		= ht6560b_init_dev,
	.set_pio_mode		= ht6560b_set_pio_mode,
};

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