Linux Audio

Check our new training course

Loading...
v6.8
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *   pata-legacy.c - Legacy port PATA/SATA controller driver.
   4 *   Copyright 2005/2006 Red Hat, all rights reserved.
   5 *
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   6 *   An ATA driver for the legacy ATA ports.
   7 *
   8 *   Data Sources:
   9 *	Opti 82C465/82C611 support: Data sheets at opti-inc.com
  10 *	HT6560 series:
  11 *	Promise 20230/20620:
  12 *		http://www.ryston.cz/petr/vlb/pdc20230b.html
  13 *		http://www.ryston.cz/petr/vlb/pdc20230c.html
  14 *		http://www.ryston.cz/petr/vlb/pdc20630.html
  15 *	QDI65x0:
  16 *		http://www.ryston.cz/petr/vlb/qd6500.html
  17 *		http://www.ryston.cz/petr/vlb/qd6580.html
  18 *
  19 *	QDI65x0 probe code based on drivers/ide/legacy/qd65xx.c
  20 *	Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
  21 *	Samuel Thibault <samuel.thibault@ens-lyon.org>
  22 *
  23 *  Unsupported but docs exist:
  24 *	Appian/Adaptec AIC25VL01/Cirrus Logic PD7220
  25 *
  26 *  This driver handles legacy (that is "ISA/VLB side") IDE ports found
  27 *  on PC class systems. There are three hybrid devices that are exceptions
  28 *  The Cyrix 5510/5520 where a pre SFF ATA device is on the bridge and
  29 *  the MPIIX where the tuning is PCI side but the IDE is "ISA side".
  30 *
  31 *  Specific support is included for the ht6560a/ht6560b/opti82c611a/
  32 *  opti82c465mv/promise 20230c/20630/qdi65x0/winbond83759A
  33 *
  34 *  Support for the Winbond 83759A when operating in advanced mode.
  35 *  Multichip mode is not currently supported.
  36 *
  37 *  Use the autospeed and pio_mask options with:
  38 *	Appian ADI/2 aka CLPD7220 or AIC25VL01.
  39 *  Use the jumpers, autospeed and set pio_mask to the mode on the jumpers with
  40 *	Goldstar GM82C711, PIC-1288A-125, UMC 82C871F, Winbond W83759,
  41 *	Winbond W83759A, Promise PDC20230-B
  42 *
  43 *  For now use autospeed and pio_mask as above with the W83759A. This may
  44 *  change.
 
  45 */
  46
  47#include <linux/async.h>
  48#include <linux/kernel.h>
  49#include <linux/module.h>
  50#include <linux/pci.h>
  51#include <linux/init.h>
  52#include <linux/blkdev.h>
  53#include <linux/delay.h>
  54#include <scsi/scsi_host.h>
  55#include <linux/ata.h>
  56#include <linux/libata.h>
  57#include <linux/platform_device.h>
  58
  59#define DRV_NAME "pata_legacy"
  60#define DRV_VERSION "0.6.5"
  61
  62#define NR_HOST 6
  63
  64static int all;
  65module_param(all, int, 0444);
  66MODULE_PARM_DESC(all,
  67		 "Set to probe unclaimed pri/sec ISA port ranges even if PCI");
  68
  69static int probe_all;
  70module_param(probe_all, int, 0);
  71MODULE_PARM_DESC(probe_all,
  72		 "Set to probe tertiary+ ISA port ranges even if PCI");
  73
  74static int probe_mask = ~0;
  75module_param(probe_mask, int, 0);
  76MODULE_PARM_DESC(probe_mask, "Probe mask for legacy ISA PATA ports");
  77
  78static int autospeed;
  79module_param(autospeed, int, 0);
  80MODULE_PARM_DESC(autospeed, "Chip present that snoops speed changes");
  81
  82static int pio_mask = ATA_PIO4;
  83module_param(pio_mask, int, 0);
  84MODULE_PARM_DESC(pio_mask, "PIO range for autospeed devices");
  85
  86static int iordy_mask = 0xFFFFFFFF;
  87module_param(iordy_mask, int, 0);
  88MODULE_PARM_DESC(iordy_mask, "Use IORDY if available");
  89
  90static int ht6560a;
  91module_param(ht6560a, int, 0);
  92MODULE_PARM_DESC(ht6560a, "HT 6560A on primary 1, second 2, both 3");
  93
  94static int ht6560b;
  95module_param(ht6560b, int, 0);
  96MODULE_PARM_DESC(ht6560b, "HT 6560B on primary 1, secondary 2, both 3");
  97
  98static int opti82c611a;
  99module_param(opti82c611a, int, 0);
 100MODULE_PARM_DESC(opti82c611a,
 101		 "Opti 82c611A on primary 1, secondary 2, both 3");
 102
 103static int opti82c46x;
 104module_param(opti82c46x, int, 0);
 105MODULE_PARM_DESC(opti82c46x,
 106		 "Opti 82c465MV on primary 1, secondary 2, both 3");
 107
 108#ifdef CONFIG_PATA_QDI_MODULE
 109static int qdi = 1;
 110#else
 111static int qdi;
 112#endif
 113module_param(qdi, int, 0);
 114MODULE_PARM_DESC(qdi, "Set to probe QDI controllers");
 115
 116#ifdef CONFIG_PATA_WINBOND_VLB_MODULE
 117static int winbond = 1;
 118#else
 119static int winbond;
 120#endif
 121module_param(winbond, int, 0);
 122MODULE_PARM_DESC(winbond,
 123		 "Set to probe Winbond controllers, "
 124		 "give I/O port if non standard");
 125
 126
 127enum controller {
 128	BIOS = 0,
 129	SNOOP = 1,
 130	PDC20230 = 2,
 131	HT6560A = 3,
 132	HT6560B = 4,
 133	OPTI611A = 5,
 134	OPTI46X = 6,
 135	QDI6500 = 7,
 136	QDI6580 = 8,
 137	QDI6580DP = 9,		/* Dual channel mode is different */
 138	W83759A = 10,
 139
 140	UNKNOWN = -1
 141};
 142
 143struct legacy_data {
 144	unsigned long timing;
 145	u8 clock[2];
 146	u8 last;
 147	int fast;
 148	enum controller type;
 149	struct platform_device *platform_dev;
 150};
 151
 152struct legacy_probe {
 153	unsigned char *name;
 154	unsigned long port;
 155	unsigned int irq;
 156	unsigned int slot;
 157	enum controller type;
 158	unsigned long private;
 159};
 160
 161struct legacy_controller {
 162	const char *name;
 163	struct ata_port_operations *ops;
 164	unsigned int pio_mask;
 165	unsigned int flags;
 166	unsigned int pflags;
 167	int (*setup)(struct platform_device *, struct legacy_probe *probe,
 168		struct legacy_data *data);
 169};
 170
 171static int legacy_port[NR_HOST] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
 172
 173static struct legacy_probe probe_list[NR_HOST];
 174static struct legacy_data legacy_data[NR_HOST];
 175static struct ata_host *legacy_host[NR_HOST];
 176static int nr_legacy_host;
 177
 178
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 179/**
 180 *	legacy_probe_add	-	Add interface to probe list
 181 *	@port: Controller port
 182 *	@irq: IRQ number
 183 *	@type: Controller type
 184 *	@private: Controller specific info
 185 *
 186 *	Add an entry into the probe list for ATA controllers. This is used
 187 *	to add the default ISA slots and then to build up the table
 188 *	further according to other ISA/VLB/Weird device scans
 189 *
 190 *	An I/O port list is used to keep ordering stable and sane, as we
 191 *	don't have any good way to talk about ordering otherwise
 192 */
 193
 194static int legacy_probe_add(unsigned long port, unsigned int irq,
 195				enum controller type, unsigned long private)
 196{
 197	struct legacy_probe *lp = &probe_list[0];
 198	int i;
 199	struct legacy_probe *free = NULL;
 200
 201	for (i = 0; i < NR_HOST; i++) {
 202		if (lp->port == 0 && free == NULL)
 203			free = lp;
 204		/* Matching port, or the correct slot for ordering */
 205		if (lp->port == port || legacy_port[i] == port) {
 206			if (!(probe_mask & 1 << i))
 207				return -1;
 208			free = lp;
 209			break;
 210		}
 211		lp++;
 212	}
 213	if (free == NULL) {
 214		printk(KERN_ERR "pata_legacy: Too many interfaces.\n");
 215		return -1;
 216	}
 217	/* Fill in the entry for later probing */
 218	free->port = port;
 219	free->irq = irq;
 220	free->type = type;
 221	free->private = private;
 222	return 0;
 223}
 224
 225
 226/**
 227 *	legacy_set_mode		-	mode setting
 228 *	@link: IDE link
 229 *	@unused: Device that failed when error is returned
 230 *
 231 *	Use a non standard set_mode function. We don't want to be tuned.
 232 *
 233 *	The BIOS configured everything. Our job is not to fiddle. Just use
 234 *	whatever PIO the hardware is using and leave it at that. When we
 235 *	get some kind of nice user driven API for control then we can
 236 *	expand on this as per hdparm in the base kernel.
 237 */
 238
 239static int legacy_set_mode(struct ata_link *link, struct ata_device **unused)
 240{
 241	struct ata_device *dev;
 242
 243	ata_for_each_dev(dev, link, ENABLED) {
 244		ata_dev_info(dev, "configured for PIO\n");
 245		dev->pio_mode = XFER_PIO_0;
 246		dev->xfer_mode = XFER_PIO_0;
 247		dev->xfer_shift = ATA_SHIFT_PIO;
 248		dev->flags |= ATA_DFLAG_PIO;
 249	}
 250	return 0;
 251}
 252
 253static const struct scsi_host_template legacy_sht = {
 254	ATA_PIO_SHT(DRV_NAME),
 255};
 256
 257static const struct ata_port_operations legacy_base_port_ops = {
 258	.inherits	= &ata_sff_port_ops,
 259	.cable_detect	= ata_cable_40wire,
 260};
 261
 262/*
 263 *	These ops are used if the user indicates the hardware
 264 *	snoops the commands to decide on the mode and handles the
 265 *	mode selection "magically" itself. Several legacy controllers
 266 *	do this. The mode range can be set if it is not 0x1F by setting
 267 *	pio_mask as well.
 268 */
 269
 270static struct ata_port_operations simple_port_ops = {
 271	.inherits	= &legacy_base_port_ops,
 272	.sff_data_xfer	= ata_sff_data_xfer32,
 273};
 274
 275static struct ata_port_operations legacy_port_ops = {
 276	.inherits	= &legacy_base_port_ops,
 277	.sff_data_xfer	= ata_sff_data_xfer32,
 278	.set_mode	= legacy_set_mode,
 279};
 280
 281/*
 282 *	Promise 20230C and 20620 support
 283 *
 284 *	This controller supports PIO0 to PIO2. We set PIO timings
 285 *	conservatively to allow for 50MHz Vesa Local Bus. The 20620 DMA
 286 *	support is weird being DMA to controller and PIO'd to the host
 287 *	and not supported.
 288 */
 289
 290static void pdc20230_set_piomode(struct ata_port *ap, struct ata_device *adev)
 291{
 292	int tries = 5;
 293	int pio = adev->pio_mode - XFER_PIO_0;
 294	u8 rt;
 295	unsigned long flags;
 296
 297	/* Safe as UP only. Force I/Os to occur together */
 298
 299	local_irq_save(flags);
 300
 301	/* Unlock the control interface */
 302	do {
 303		inb(0x1F5);
 304		outb(inb(0x1F2) | 0x80, 0x1F2);
 305		inb(0x1F2);
 306		inb(0x3F6);
 307		inb(0x3F6);
 308		inb(0x1F2);
 309		inb(0x1F2);
 310	}
 311	while ((inb(0x1F2) & 0x80) && --tries);
 312
 313	local_irq_restore(flags);
 314
 315	outb(inb(0x1F4) & 0x07, 0x1F4);
 316
 317	rt = inb(0x1F3);
 318	rt &= ~(0x07 << (3 * !adev->devno));
 319	if (pio)
 320		rt |= (1 + 3 * pio) << (3 * !adev->devno);
 321	outb(rt, 0x1F3);
 322
 323	udelay(100);
 324	outb(inb(0x1F2) | 0x01, 0x1F2);
 325	udelay(100);
 326	inb(0x1F5);
 327
 328}
 329
 330static unsigned int pdc_data_xfer_vlb(struct ata_queued_cmd *qc,
 331			unsigned char *buf, unsigned int buflen, int rw)
 332{
 333	struct ata_device *dev = qc->dev;
 334	struct ata_port *ap = dev->link->ap;
 335	int slop = buflen & 3;
 
 336
 337	/* 32bit I/O capable *and* we need to write a whole number of dwords */
 338	if (ata_id_has_dword_io(dev->id) && (slop == 0 || slop == 3)
 339					&& (ap->pflags & ATA_PFLAG_PIO32)) {
 340		unsigned long flags;
 341
 342		local_irq_save(flags);
 343
 344		/* Perform the 32bit I/O synchronization sequence */
 345		ioread8(ap->ioaddr.nsect_addr);
 346		ioread8(ap->ioaddr.nsect_addr);
 347		ioread8(ap->ioaddr.nsect_addr);
 348
 349		/* Now the data */
 350		if (rw == READ)
 351			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 352		else
 353			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 354
 355		if (unlikely(slop)) {
 356			__le32 pad = 0;
 357
 358			if (rw == READ) {
 359				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
 360				memcpy(buf + buflen - slop, &pad, slop);
 361			} else {
 362				memcpy(&pad, buf + buflen - slop, slop);
 363				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
 364			}
 365			buflen += 4 - slop;
 366		}
 367		local_irq_restore(flags);
 368	} else
 369		buflen = ata_sff_data_xfer32(qc, buf, buflen, rw);
 370
 371	return buflen;
 372}
 373
 374static struct ata_port_operations pdc20230_port_ops = {
 375	.inherits	= &legacy_base_port_ops,
 376	.set_piomode	= pdc20230_set_piomode,
 377	.sff_data_xfer	= pdc_data_xfer_vlb,
 378};
 379
 380/*
 381 *	Holtek 6560A support
 382 *
 383 *	This controller supports PIO0 to PIO2 (no IORDY even though higher
 384 *	timings can be loaded).
 385 */
 386
 387static void ht6560a_set_piomode(struct ata_port *ap, struct ata_device *adev)
 388{
 389	u8 active, recover;
 390	struct ata_timing t;
 391
 392	/* Get the timing data in cycles. For now play safe at 50Mhz */
 393	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 394
 395	active = clamp_val(t.active, 2, 15);
 396	recover = clamp_val(t.recover, 4, 15);
 397
 398	inb(0x3E6);
 399	inb(0x3E6);
 400	inb(0x3E6);
 401	inb(0x3E6);
 402
 403	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
 404	ioread8(ap->ioaddr.status_addr);
 405}
 406
 407static struct ata_port_operations ht6560a_port_ops = {
 408	.inherits	= &legacy_base_port_ops,
 409	.set_piomode	= ht6560a_set_piomode,
 410};
 411
 412/*
 413 *	Holtek 6560B support
 414 *
 415 *	This controller supports PIO0 to PIO4. We honour the BIOS/jumper FIFO
 416 *	setting unless we see an ATAPI device in which case we force it off.
 417 *
 418 *	FIXME: need to implement 2nd channel support.
 419 */
 420
 421static void ht6560b_set_piomode(struct ata_port *ap, struct ata_device *adev)
 422{
 423	u8 active, recover;
 424	struct ata_timing t;
 425
 426	/* Get the timing data in cycles. For now play safe at 50Mhz */
 427	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 428
 429	active = clamp_val(t.active, 2, 15);
 430	recover = clamp_val(t.recover, 2, 16) & 0x0F;
 431
 432	inb(0x3E6);
 433	inb(0x3E6);
 434	inb(0x3E6);
 435	inb(0x3E6);
 436
 437	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
 438
 439	if (adev->class != ATA_DEV_ATA) {
 440		u8 rconf = inb(0x3E6);
 441		if (rconf & 0x24) {
 442			rconf &= ~0x24;
 443			outb(rconf, 0x3E6);
 444		}
 445	}
 446	ioread8(ap->ioaddr.status_addr);
 447}
 448
 449static struct ata_port_operations ht6560b_port_ops = {
 450	.inherits	= &legacy_base_port_ops,
 451	.set_piomode	= ht6560b_set_piomode,
 452};
 453
 454/*
 455 *	Opti core chipset helpers
 456 */
 457
 458/**
 459 *	opti_syscfg	-	read OPTI chipset configuration
 460 *	@reg: Configuration register to read
 461 *
 462 *	Returns the value of an OPTI system board configuration register.
 463 */
 464
 465static u8 opti_syscfg(u8 reg)
 466{
 467	unsigned long flags;
 468	u8 r;
 469
 470	/* Uniprocessor chipset and must force cycles adjancent */
 471	local_irq_save(flags);
 472	outb(reg, 0x22);
 473	r = inb(0x24);
 474	local_irq_restore(flags);
 475	return r;
 476}
 477
 478/*
 479 *	Opti 82C611A
 480 *
 481 *	This controller supports PIO0 to PIO3.
 482 */
 483
 484static void opti82c611a_set_piomode(struct ata_port *ap,
 485						struct ata_device *adev)
 486{
 487	u8 active, recover, setup;
 488	struct ata_timing t;
 489	struct ata_device *pair = ata_dev_pair(adev);
 490	int clock;
 491	int khz[4] = { 50000, 40000, 33000, 25000 };
 492	u8 rc;
 493
 494	/* Enter configuration mode */
 495	ioread16(ap->ioaddr.error_addr);
 496	ioread16(ap->ioaddr.error_addr);
 497	iowrite8(3, ap->ioaddr.nsect_addr);
 498
 499	/* Read VLB clock strapping */
 500	clock = 1000000000 / khz[ioread8(ap->ioaddr.lbah_addr) & 0x03];
 501
 502	/* Get the timing data in cycles */
 503	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
 504
 505	/* Setup timing is shared */
 506	if (pair) {
 507		struct ata_timing tp;
 508		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
 509
 510		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
 511	}
 512
 513	active = clamp_val(t.active, 2, 17) - 2;
 514	recover = clamp_val(t.recover, 1, 16) - 1;
 515	setup = clamp_val(t.setup, 1, 4) - 1;
 516
 517	/* Select the right timing bank for write timing */
 518	rc = ioread8(ap->ioaddr.lbal_addr);
 519	rc &= 0x7F;
 520	rc |= (adev->devno << 7);
 521	iowrite8(rc, ap->ioaddr.lbal_addr);
 522
 523	/* Write the timings */
 524	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
 525
 526	/* Select the right bank for read timings, also
 527	   load the shared timings for address */
 528	rc = ioread8(ap->ioaddr.device_addr);
 529	rc &= 0xC0;
 530	rc |= adev->devno;	/* Index select */
 531	rc |= (setup << 4) | 0x04;
 532	iowrite8(rc, ap->ioaddr.device_addr);
 533
 534	/* Load the read timings */
 535	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
 536
 537	/* Ensure the timing register mode is right */
 538	rc = ioread8(ap->ioaddr.lbal_addr);
 539	rc &= 0x73;
 540	rc |= 0x84;
 541	iowrite8(rc, ap->ioaddr.lbal_addr);
 542
 543	/* Exit command mode */
 544	iowrite8(0x83,  ap->ioaddr.nsect_addr);
 545}
 546
 547
 548static struct ata_port_operations opti82c611a_port_ops = {
 549	.inherits	= &legacy_base_port_ops,
 550	.set_piomode	= opti82c611a_set_piomode,
 551};
 552
 553/*
 554 *	Opti 82C465MV
 555 *
 556 *	This controller supports PIO0 to PIO3. Unlike the 611A the MVB
 557 *	version is dual channel but doesn't have a lot of unique registers.
 558 */
 559
 560static void opti82c46x_set_piomode(struct ata_port *ap, struct ata_device *adev)
 561{
 562	u8 active, recover, setup;
 563	struct ata_timing t;
 564	struct ata_device *pair = ata_dev_pair(adev);
 565	int clock;
 566	int khz[4] = { 50000, 40000, 33000, 25000 };
 567	u8 rc;
 568	u8 sysclk;
 569
 570	/* Get the clock */
 571	sysclk = (opti_syscfg(0xAC) & 0xC0) >> 6;	/* BIOS set */
 572
 573	/* Enter configuration mode */
 574	ioread16(ap->ioaddr.error_addr);
 575	ioread16(ap->ioaddr.error_addr);
 576	iowrite8(3, ap->ioaddr.nsect_addr);
 577
 578	/* Read VLB clock strapping */
 579	clock = 1000000000 / khz[sysclk];
 580
 581	/* Get the timing data in cycles */
 582	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
 583
 584	/* Setup timing is shared */
 585	if (pair) {
 586		struct ata_timing tp;
 587		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
 588
 589		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
 590	}
 591
 592	active = clamp_val(t.active, 2, 17) - 2;
 593	recover = clamp_val(t.recover, 1, 16) - 1;
 594	setup = clamp_val(t.setup, 1, 4) - 1;
 595
 596	/* Select the right timing bank for write timing */
 597	rc = ioread8(ap->ioaddr.lbal_addr);
 598	rc &= 0x7F;
 599	rc |= (adev->devno << 7);
 600	iowrite8(rc, ap->ioaddr.lbal_addr);
 601
 602	/* Write the timings */
 603	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
 604
 605	/* Select the right bank for read timings, also
 606	   load the shared timings for address */
 607	rc = ioread8(ap->ioaddr.device_addr);
 608	rc &= 0xC0;
 609	rc |= adev->devno;	/* Index select */
 610	rc |= (setup << 4) | 0x04;
 611	iowrite8(rc, ap->ioaddr.device_addr);
 612
 613	/* Load the read timings */
 614	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
 615
 616	/* Ensure the timing register mode is right */
 617	rc = ioread8(ap->ioaddr.lbal_addr);
 618	rc &= 0x73;
 619	rc |= 0x84;
 620	iowrite8(rc, ap->ioaddr.lbal_addr);
 621
 622	/* Exit command mode */
 623	iowrite8(0x83,  ap->ioaddr.nsect_addr);
 624
 625	/* We need to know this for quad device on the MVB */
 626	ap->host->private_data = ap;
 627}
 628
 629/**
 630 *	opti82c46x_qc_issue		-	command issue
 631 *	@qc: command pending
 632 *
 633 *	Called when the libata layer is about to issue a command. We wrap
 634 *	this interface so that we can load the correct ATA timings. The
 635 *	MVB has a single set of timing registers and these are shared
 636 *	across channels. As there are two registers we really ought to
 637 *	track the last two used values as a sort of register window. For
 638 *	now we just reload on a channel switch. On the single channel
 639 *	setup this condition never fires so we do nothing extra.
 640 *
 641 *	FIXME: dual channel needs ->serialize support
 642 */
 643
 644static unsigned int opti82c46x_qc_issue(struct ata_queued_cmd *qc)
 645{
 646	struct ata_port *ap = qc->ap;
 647	struct ata_device *adev = qc->dev;
 648
 649	/* If timings are set and for the wrong channel (2nd test is
 650	   due to a libata shortcoming and will eventually go I hope) */
 651	if (ap->host->private_data != ap->host
 652	    && ap->host->private_data != NULL)
 653		opti82c46x_set_piomode(ap, adev);
 654
 655	return ata_sff_qc_issue(qc);
 656}
 657
 658static struct ata_port_operations opti82c46x_port_ops = {
 659	.inherits	= &legacy_base_port_ops,
 660	.set_piomode	= opti82c46x_set_piomode,
 661	.qc_issue	= opti82c46x_qc_issue,
 662};
 663
 664/**
 665 *	qdi65x0_set_piomode		-	PIO setup for QDI65x0
 666 *	@ap: Port
 667 *	@adev: Device
 668 *
 669 *	In single channel mode the 6580 has one clock per device and we can
 670 *	avoid the requirement to clock switch. We also have to load the timing
 671 *	into the right clock according to whether we are master or slave.
 672 *
 673 *	In dual channel mode the 6580 has one clock per channel and we have
 674 *	to software clockswitch in qc_issue.
 675 */
 676
 677static void qdi65x0_set_piomode(struct ata_port *ap, struct ata_device *adev)
 678{
 679	struct ata_timing t;
 680	struct legacy_data *ld_qdi = ap->host->private_data;
 681	int active, recovery;
 682	u8 timing;
 683
 684	/* Get the timing data in cycles */
 685	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
 686
 687	if (ld_qdi->fast) {
 688		active = 8 - clamp_val(t.active, 1, 8);
 689		recovery = 18 - clamp_val(t.recover, 3, 18);
 690	} else {
 691		active = 9 - clamp_val(t.active, 2, 9);
 692		recovery = 15 - clamp_val(t.recover, 0, 15);
 693	}
 694	timing = (recovery << 4) | active | 0x08;
 695	ld_qdi->clock[adev->devno] = timing;
 696
 697	if (ld_qdi->type == QDI6580)
 698		outb(timing, ld_qdi->timing + 2 * adev->devno);
 699	else
 700		outb(timing, ld_qdi->timing + 2 * ap->port_no);
 701
 702	/* Clear the FIFO */
 703	if (ld_qdi->type != QDI6500 && adev->class != ATA_DEV_ATA)
 704		outb(0x5F, (ld_qdi->timing & 0xFFF0) + 3);
 705}
 706
 707/**
 708 *	qdi_qc_issue		-	command issue
 709 *	@qc: command pending
 710 *
 711 *	Called when the libata layer is about to issue a command. We wrap
 712 *	this interface so that we can load the correct ATA timings.
 713 */
 714
 715static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
 716{
 717	struct ata_port *ap = qc->ap;
 718	struct ata_device *adev = qc->dev;
 719	struct legacy_data *ld_qdi = ap->host->private_data;
 720
 721	if (ld_qdi->clock[adev->devno] != ld_qdi->last) {
 722		if (adev->pio_mode) {
 723			ld_qdi->last = ld_qdi->clock[adev->devno];
 724			outb(ld_qdi->clock[adev->devno], ld_qdi->timing +
 725							2 * ap->port_no);
 726		}
 727	}
 728	return ata_sff_qc_issue(qc);
 729}
 730
 731static unsigned int vlb32_data_xfer(struct ata_queued_cmd *qc,
 732				    unsigned char *buf,
 733				    unsigned int buflen, int rw)
 734{
 735	struct ata_device *adev = qc->dev;
 736	struct ata_port *ap = adev->link->ap;
 737	int slop = buflen & 3;
 738
 739	if (ata_id_has_dword_io(adev->id) && (slop == 0 || slop == 3)
 740					&& (ap->pflags & ATA_PFLAG_PIO32)) {
 741		if (rw == WRITE)
 742			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 743		else
 744			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 745
 746		if (unlikely(slop)) {
 747			__le32 pad = 0;
 748
 749			if (rw == WRITE) {
 750				memcpy(&pad, buf + buflen - slop, slop);
 751				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
 752			} else {
 753				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
 754				memcpy(buf + buflen - slop, &pad, slop);
 755			}
 756		}
 757		return (buflen + 3) & ~3;
 758	} else
 759		return ata_sff_data_xfer(qc, buf, buflen, rw);
 760}
 761
 762static int qdi_port(struct platform_device *dev,
 763			struct legacy_probe *lp, struct legacy_data *ld)
 764{
 765	if (devm_request_region(&dev->dev, lp->private, 4, "qdi") == NULL)
 766		return -EBUSY;
 767	ld->timing = lp->private;
 768	return 0;
 769}
 770
 771static struct ata_port_operations qdi6500_port_ops = {
 772	.inherits	= &legacy_base_port_ops,
 773	.set_piomode	= qdi65x0_set_piomode,
 774	.qc_issue	= qdi_qc_issue,
 775	.sff_data_xfer	= vlb32_data_xfer,
 776};
 777
 778static struct ata_port_operations qdi6580_port_ops = {
 779	.inherits	= &legacy_base_port_ops,
 780	.set_piomode	= qdi65x0_set_piomode,
 781	.sff_data_xfer	= vlb32_data_xfer,
 782};
 783
 784static struct ata_port_operations qdi6580dp_port_ops = {
 785	.inherits	= &legacy_base_port_ops,
 786	.set_piomode	= qdi65x0_set_piomode,
 787	.qc_issue	= qdi_qc_issue,
 788	.sff_data_xfer	= vlb32_data_xfer,
 789};
 790
 791static DEFINE_SPINLOCK(winbond_lock);
 792
 793static void winbond_writecfg(unsigned long port, u8 reg, u8 val)
 794{
 795	unsigned long flags;
 796	spin_lock_irqsave(&winbond_lock, flags);
 797	outb(reg, port + 0x01);
 798	outb(val, port + 0x02);
 799	spin_unlock_irqrestore(&winbond_lock, flags);
 800}
 801
 802static u8 winbond_readcfg(unsigned long port, u8 reg)
 803{
 804	u8 val;
 805
 806	unsigned long flags;
 807	spin_lock_irqsave(&winbond_lock, flags);
 808	outb(reg, port + 0x01);
 809	val = inb(port + 0x02);
 810	spin_unlock_irqrestore(&winbond_lock, flags);
 811
 812	return val;
 813}
 814
 815static void winbond_set_piomode(struct ata_port *ap, struct ata_device *adev)
 816{
 817	struct ata_timing t;
 818	struct legacy_data *ld_winbond = ap->host->private_data;
 819	int active, recovery;
 820	u8 reg;
 821	int timing = 0x88 + (ap->port_no * 4) + (adev->devno * 2);
 822
 823	reg = winbond_readcfg(ld_winbond->timing, 0x81);
 824
 825	/* Get the timing data in cycles */
 826	if (reg & 0x40)		/* Fast VLB bus, assume 50MHz */
 827		ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 828	else
 829		ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
 830
 831	active = (clamp_val(t.active, 3, 17) - 1) & 0x0F;
 832	recovery = (clamp_val(t.recover, 1, 15) + 1) & 0x0F;
 833	timing = (active << 4) | recovery;
 834	winbond_writecfg(ld_winbond->timing, timing, reg);
 835
 836	/* Load the setup timing */
 837
 838	reg = 0x35;
 839	if (adev->class != ATA_DEV_ATA)
 840		reg |= 0x08;	/* FIFO off */
 841	if (!ata_pio_need_iordy(adev))
 842		reg |= 0x02;	/* IORDY off */
 843	reg |= (clamp_val(t.setup, 0, 3) << 6);
 844	winbond_writecfg(ld_winbond->timing, timing + 1, reg);
 845}
 846
 847static int winbond_port(struct platform_device *dev,
 848			struct legacy_probe *lp, struct legacy_data *ld)
 849{
 850	if (devm_request_region(&dev->dev, lp->private, 4, "winbond") == NULL)
 851		return -EBUSY;
 852	ld->timing = lp->private;
 853	return 0;
 854}
 855
 856static struct ata_port_operations winbond_port_ops = {
 857	.inherits	= &legacy_base_port_ops,
 858	.set_piomode	= winbond_set_piomode,
 859	.sff_data_xfer	= vlb32_data_xfer,
 860};
 861
 862static struct legacy_controller controllers[] = {
 863	{"BIOS",	&legacy_port_ops, 	ATA_PIO4,
 864			ATA_FLAG_NO_IORDY,	0,			NULL },
 865	{"Snooping", 	&simple_port_ops, 	ATA_PIO4,
 866			0,			0,			NULL },
 867	{"PDC20230",	&pdc20230_port_ops,	ATA_PIO2,
 868			ATA_FLAG_NO_IORDY,
 869			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,	NULL },
 870	{"HT6560A",	&ht6560a_port_ops,	ATA_PIO2,
 871			ATA_FLAG_NO_IORDY,	0,			NULL },
 872	{"HT6560B",	&ht6560b_port_ops,	ATA_PIO4,
 873			ATA_FLAG_NO_IORDY,	0,			NULL },
 874	{"OPTI82C611A",	&opti82c611a_port_ops,	ATA_PIO3,
 875			0,			0,			NULL },
 876	{"OPTI82C46X",	&opti82c46x_port_ops,	ATA_PIO3,
 877			0,			0,			NULL },
 878	{"QDI6500",	&qdi6500_port_ops,	ATA_PIO2,
 879			ATA_FLAG_NO_IORDY,
 880			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,    qdi_port },
 881	{"QDI6580",	&qdi6580_port_ops,	ATA_PIO4,
 882			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
 883	{"QDI6580DP",	&qdi6580dp_port_ops,	ATA_PIO4,
 884			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
 885	{"W83759A",	&winbond_port_ops,	ATA_PIO4,
 886			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,
 887								winbond_port }
 888};
 889
 890/**
 891 *	probe_chip_type		-	Discover controller
 892 *	@probe: Probe entry to check
 893 *
 894 *	Probe an ATA port and identify the type of controller. We don't
 895 *	check if the controller appears to be driveless at this point.
 896 */
 897
 898static __init int probe_chip_type(struct legacy_probe *probe)
 899{
 900	int mask = 1 << probe->slot;
 901
 902	if (winbond && (probe->port == 0x1F0 || probe->port == 0x170)) {
 903		u8 reg = winbond_readcfg(winbond, 0x81);
 904		reg |= 0x80;	/* jumpered mode off */
 905		winbond_writecfg(winbond, 0x81, reg);
 906		reg = winbond_readcfg(winbond, 0x83);
 907		reg |= 0xF0;	/* local control */
 908		winbond_writecfg(winbond, 0x83, reg);
 909		reg = winbond_readcfg(winbond, 0x85);
 910		reg |= 0xF0;	/* programmable timing */
 911		winbond_writecfg(winbond, 0x85, reg);
 912
 913		reg = winbond_readcfg(winbond, 0x81);
 914
 915		if (reg & mask)
 916			return W83759A;
 917	}
 918	if (probe->port == 0x1F0) {
 919		unsigned long flags;
 920		local_irq_save(flags);
 921		/* Probes */
 922		outb(inb(0x1F2) | 0x80, 0x1F2);
 923		inb(0x1F5);
 924		inb(0x1F2);
 925		inb(0x3F6);
 926		inb(0x3F6);
 927		inb(0x1F2);
 928		inb(0x1F2);
 929
 930		if ((inb(0x1F2) & 0x80) == 0) {
 931			/* PDC20230c or 20630 ? */
 932			printk(KERN_INFO  "PDC20230-C/20630 VLB ATA controller"
 933							" detected.\n");
 934			udelay(100);
 935			inb(0x1F5);
 936			local_irq_restore(flags);
 937			return PDC20230;
 938		} else {
 939			outb(0x55, 0x1F2);
 940			inb(0x1F2);
 941			inb(0x1F2);
 942			if (inb(0x1F2) == 0x00)
 943				printk(KERN_INFO "PDC20230-B VLB ATA "
 944						     "controller detected.\n");
 945			local_irq_restore(flags);
 946			return BIOS;
 947		}
 948	}
 949
 950	if (ht6560a & mask)
 951		return HT6560A;
 952	if (ht6560b & mask)
 953		return HT6560B;
 954	if (opti82c611a & mask)
 955		return OPTI611A;
 956	if (opti82c46x & mask)
 957		return OPTI46X;
 958	if (autospeed & mask)
 959		return SNOOP;
 960	return BIOS;
 961}
 962
 963
 964/**
 965 *	legacy_init_one		-	attach a legacy interface
 966 *	@probe: probe record
 967 *
 968 *	Register an ISA bus IDE interface. Such interfaces are PIO and we
 969 *	assume do not support IRQ sharing.
 970 */
 971
 972static __init int legacy_init_one(struct legacy_probe *probe)
 973{
 974	struct legacy_controller *controller = &controllers[probe->type];
 975	int pio_modes = controller->pio_mask;
 976	unsigned long io = probe->port;
 977	u32 mask = (1 << probe->slot);
 978	struct ata_port_operations *ops = controller->ops;
 979	struct legacy_data *ld = &legacy_data[probe->slot];
 980	struct ata_host *host = NULL;
 981	struct ata_port *ap;
 982	struct platform_device *pdev;
 983	struct ata_device *dev;
 984	void __iomem *io_addr, *ctrl_addr;
 985	u32 iordy = (iordy_mask & mask) ? 0: ATA_FLAG_NO_IORDY;
 986	int ret;
 987
 988	iordy |= controller->flags;
 989
 990	pdev = platform_device_register_simple(DRV_NAME, probe->slot, NULL, 0);
 991	if (IS_ERR(pdev))
 992		return PTR_ERR(pdev);
 993
 994	ret = -EBUSY;
 995	if (devm_request_region(&pdev->dev, io, 8, "pata_legacy") == NULL ||
 996	    devm_request_region(&pdev->dev, io + 0x0206, 1,
 997							"pata_legacy") == NULL)
 998		goto fail;
 999
1000	ret = -ENOMEM;
1001	io_addr = devm_ioport_map(&pdev->dev, io, 8);
1002	ctrl_addr = devm_ioport_map(&pdev->dev, io + 0x0206, 1);
1003	if (!io_addr || !ctrl_addr)
1004		goto fail;
1005	ld->type = probe->type;
1006	if (controller->setup)
1007		if (controller->setup(pdev, probe, ld) < 0)
1008			goto fail;
1009	host = ata_host_alloc(&pdev->dev, 1);
1010	if (!host)
1011		goto fail;
1012	ap = host->ports[0];
1013
1014	ap->ops = ops;
1015	ap->pio_mask = pio_modes;
1016	ap->flags |= ATA_FLAG_SLAVE_POSS | iordy;
1017	ap->pflags |= controller->pflags;
1018	ap->ioaddr.cmd_addr = io_addr;
1019	ap->ioaddr.altstatus_addr = ctrl_addr;
1020	ap->ioaddr.ctl_addr = ctrl_addr;
1021	ata_sff_std_ports(&ap->ioaddr);
1022	ap->host->private_data = ld;
1023
1024	ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", io, io + 0x0206);
1025
1026	ret = ata_host_activate(host, probe->irq, ata_sff_interrupt, 0,
1027				&legacy_sht);
1028	if (ret)
1029		goto fail;
1030	async_synchronize_full();
1031	ld->platform_dev = pdev;
1032
1033	/* Nothing found means we drop the port as its probably not there */
1034
1035	ret = -ENODEV;
1036	ata_for_each_dev(dev, &ap->link, ALL) {
1037		if (!ata_dev_absent(dev)) {
1038			legacy_host[probe->slot] = host;
1039			ld->platform_dev = pdev;
1040			return 0;
1041		}
1042	}
1043	ata_host_detach(host);
1044fail:
1045	platform_device_unregister(pdev);
1046	return ret;
1047}
1048
1049/**
1050 *	legacy_check_special_cases	-	ATA special cases
1051 *	@p: PCI device to check
1052 *	@primary: set this if we find an ATA master
1053 *	@secondary: set this if we find an ATA secondary
1054 *
1055 *	A small number of vendors implemented early PCI ATA interfaces
1056 *	on bridge logic without the ATA interface being PCI visible.
1057 *	Where we have a matching PCI driver we must skip the relevant
1058 *	device here. If we don't know about it then the legacy driver
1059 *	is the right driver anyway.
1060 */
1061
1062static void __init legacy_check_special_cases(struct pci_dev *p, int *primary,
1063								int *secondary)
1064{
1065	/* Cyrix CS5510 pre SFF MWDMA ATA on the bridge */
1066	if (p->vendor == 0x1078 && p->device == 0x0000) {
1067		*primary = *secondary = 1;
1068		return;
1069	}
1070	/* Cyrix CS5520 pre SFF MWDMA ATA on the bridge */
1071	if (p->vendor == 0x1078 && p->device == 0x0002) {
1072		*primary = *secondary = 1;
1073		return;
1074	}
1075	/* Intel MPIIX - PIO ATA on non PCI side of bridge */
1076	if (p->vendor == 0x8086 && p->device == 0x1234) {
1077		u16 r;
1078		pci_read_config_word(p, 0x6C, &r);
1079		if (r & 0x8000) {
1080			/* ATA port enabled */
1081			if (r & 0x4000)
1082				*secondary = 1;
1083			else
1084				*primary = 1;
1085		}
1086		return;
1087	}
1088}
1089
1090static __init void probe_opti_vlb(void)
1091{
1092	/* If an OPTI 82C46X is present find out where the channels are */
1093	static const char *optis[4] = {
1094		"3/463MV", "5MV",
1095		"5MVA", "5MVB"
1096	};
1097	u8 chans = 1;
1098	u8 ctrl = (opti_syscfg(0x30) & 0xC0) >> 6;
1099
1100	opti82c46x = 3;	/* Assume master and slave first */
1101	printk(KERN_INFO DRV_NAME ": Opti 82C46%s chipset support.\n",
1102								optis[ctrl]);
1103	if (ctrl == 3)
1104		chans = (opti_syscfg(0x3F) & 0x20) ? 2 : 1;
1105	ctrl = opti_syscfg(0xAC);
1106	/* Check enabled and this port is the 465MV port. On the
1107	   MVB we may have two channels */
1108	if (ctrl & 8) {
1109		if (chans == 2) {
1110			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1111			legacy_probe_add(0x170, 15, OPTI46X, 0);
1112		}
1113		if (ctrl & 4)
1114			legacy_probe_add(0x170, 15, OPTI46X, 0);
1115		else
1116			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1117	} else
1118		legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1119}
1120
1121static __init void qdi65_identify_port(u8 r, u8 res, unsigned long port)
1122{
1123	static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
1124	/* Check card type */
1125	if ((r & 0xF0) == 0xC0) {
1126		/* QD6500: single channel */
1127		if (r & 8)
1128			/* Disabled ? */
1129			return;
1130		legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1131								QDI6500, port);
1132	}
1133	if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
1134		/* QD6580: dual channel */
1135		if (!request_region(port + 2 , 2, "pata_qdi")) {
1136			release_region(port, 2);
1137			return;
1138		}
1139		res = inb(port + 3);
1140		/* Single channel mode ? */
1141		if (res & 1)
1142			legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1143								QDI6580, port);
1144		else { /* Dual channel mode */
1145			legacy_probe_add(0x1F0, 14, QDI6580DP, port);
1146			/* port + 0x02, r & 0x04 */
1147			legacy_probe_add(0x170, 15, QDI6580DP, port + 2);
1148		}
1149		release_region(port + 2, 2);
1150	}
1151}
1152
1153static __init void probe_qdi_vlb(void)
1154{
1155	unsigned long flags;
1156	static const unsigned long qd_port[2] = { 0x30, 0xB0 };
1157	int i;
1158
1159	/*
1160	 *	Check each possible QD65xx base address
1161	 */
1162
1163	for (i = 0; i < 2; i++) {
1164		unsigned long port = qd_port[i];
1165		u8 r, res;
1166
1167
1168		if (request_region(port, 2, "pata_qdi")) {
1169			/* Check for a card */
1170			local_irq_save(flags);
1171			/* I have no h/w that needs this delay but it
1172			   is present in the historic code */
1173			r = inb(port);
1174			udelay(1);
1175			outb(0x19, port);
1176			udelay(1);
1177			res = inb(port);
1178			udelay(1);
1179			outb(r, port);
1180			udelay(1);
1181			local_irq_restore(flags);
1182
1183			/* Fail */
1184			if (res == 0x19) {
1185				release_region(port, 2);
1186				continue;
1187			}
1188			/* Passes the presence test */
1189			r = inb(port + 1);
1190			udelay(1);
1191			/* Check port agrees with port set */
1192			if ((r & 2) >> 1 == i)
1193				qdi65_identify_port(r, res, port);
1194			release_region(port, 2);
1195		}
1196	}
1197}
1198
1199/**
1200 *	legacy_init		-	attach legacy interfaces
1201 *
1202 *	Attach legacy IDE interfaces by scanning the usual IRQ/port suspects.
1203 *	Right now we do not scan the ide0 and ide1 address but should do so
1204 *	for non PCI systems or systems with no PCI IDE legacy mode devices.
1205 *	If you fix that note there are special cases to consider like VLB
1206 *	drivers and CS5510/20.
1207 */
1208
1209static __init int legacy_init(void)
1210{
1211	int i;
1212	int ct = 0;
1213	int primary = 0;
1214	int secondary = 0;
1215	int pci_present = 0;
1216	struct legacy_probe *pl = &probe_list[0];
1217	int slot = 0;
1218
1219	struct pci_dev *p = NULL;
1220
1221	for_each_pci_dev(p) {
1222		int r;
1223		/* Check for any overlap of the system ATA mappings. Native
1224		   mode controllers stuck on these addresses or some devices
1225		   in 'raid' mode won't be found by the storage class test */
1226		for (r = 0; r < 6; r++) {
1227			if (pci_resource_start(p, r) == 0x1f0)
1228				primary = 1;
1229			if (pci_resource_start(p, r) == 0x170)
1230				secondary = 1;
1231		}
1232		/* Check for special cases */
1233		legacy_check_special_cases(p, &primary, &secondary);
1234
1235		/* If PCI bus is present then don't probe for tertiary
1236		   legacy ports */
1237		pci_present = 1;
1238	}
1239
1240	if (winbond == 1)
1241		winbond = 0x130;	/* Default port, alt is 1B0 */
1242
1243	if (primary == 0 || all)
1244		legacy_probe_add(0x1F0, 14, UNKNOWN, 0);
1245	if (secondary == 0 || all)
1246		legacy_probe_add(0x170, 15, UNKNOWN, 0);
1247
1248	if (probe_all || !pci_present) {
1249		/* ISA/VLB extra ports */
1250		legacy_probe_add(0x1E8, 11, UNKNOWN, 0);
1251		legacy_probe_add(0x168, 10, UNKNOWN, 0);
1252		legacy_probe_add(0x1E0, 8, UNKNOWN, 0);
1253		legacy_probe_add(0x160, 12, UNKNOWN, 0);
1254	}
1255
1256	if (opti82c46x)
1257		probe_opti_vlb();
1258	if (qdi)
1259		probe_qdi_vlb();
1260
1261	for (i = 0; i < NR_HOST; i++, pl++) {
1262		if (pl->port == 0)
1263			continue;
1264		if (pl->type == UNKNOWN)
1265			pl->type = probe_chip_type(pl);
1266		pl->slot = slot++;
1267		if (legacy_init_one(pl) == 0)
1268			ct++;
1269	}
1270	if (ct != 0)
1271		return 0;
1272	return -ENODEV;
1273}
1274
1275static __exit void legacy_exit(void)
1276{
1277	int i;
1278
1279	for (i = 0; i < nr_legacy_host; i++) {
1280		struct legacy_data *ld = &legacy_data[i];
1281		ata_host_detach(legacy_host[i]);
1282		platform_device_unregister(ld->platform_dev);
1283	}
1284}
1285
1286MODULE_AUTHOR("Alan Cox");
1287MODULE_DESCRIPTION("low-level driver for legacy ATA");
1288MODULE_LICENSE("GPL");
1289MODULE_VERSION(DRV_VERSION);
1290MODULE_ALIAS("pata_qdi");
1291MODULE_ALIAS("pata_winbond");
 
 
 
 
 
 
 
 
 
 
 
1292
1293module_init(legacy_init);
1294module_exit(legacy_exit);
v4.6
 
   1/*
   2 *   pata-legacy.c - Legacy port PATA/SATA controller driver.
   3 *   Copyright 2005/2006 Red Hat, all rights reserved.
   4 *
   5 *  This program is free software; you can redistribute it and/or modify
   6 *  it under the terms of the GNU General Public License as published by
   7 *  the Free Software Foundation; either version 2, or (at your option)
   8 *  any later version.
   9 *
  10 *  This program is distributed in the hope that it will be useful,
  11 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 *  GNU General Public License for more details.
  14 *
  15 *  You should have received a copy of the GNU General Public License
  16 *  along with this program; see the file COPYING.  If not, write to
  17 *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
  18 *
  19 *   An ATA driver for the legacy ATA ports.
  20 *
  21 *   Data Sources:
  22 *	Opti 82C465/82C611 support: Data sheets at opti-inc.com
  23 *	HT6560 series:
  24 *	Promise 20230/20620:
  25 *		http://www.ryston.cz/petr/vlb/pdc20230b.html
  26 *		http://www.ryston.cz/petr/vlb/pdc20230c.html
  27 *		http://www.ryston.cz/petr/vlb/pdc20630.html
  28 *	QDI65x0:
  29 *		http://www.ryston.cz/petr/vlb/qd6500.html
  30 *		http://www.ryston.cz/petr/vlb/qd6580.html
  31 *
  32 *	QDI65x0 probe code based on drivers/ide/legacy/qd65xx.c
  33 *	Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
  34 *	Samuel Thibault <samuel.thibault@ens-lyon.org>
  35 *
  36 *  Unsupported but docs exist:
  37 *	Appian/Adaptec AIC25VL01/Cirrus Logic PD7220
  38 *
  39 *  This driver handles legacy (that is "ISA/VLB side") IDE ports found
  40 *  on PC class systems. There are three hybrid devices that are exceptions
  41 *  The Cyrix 5510/5520 where a pre SFF ATA device is on the bridge and
  42 *  the MPIIX where the tuning is PCI side but the IDE is "ISA side".
  43 *
  44 *  Specific support is included for the ht6560a/ht6560b/opti82c611a/
  45 *  opti82c465mv/promise 20230c/20630/qdi65x0/winbond83759A
  46 *
  47 *  Support for the Winbond 83759A when operating in advanced mode.
  48 *  Multichip mode is not currently supported.
  49 *
  50 *  Use the autospeed and pio_mask options with:
  51 *	Appian ADI/2 aka CLPD7220 or AIC25VL01.
  52 *  Use the jumpers, autospeed and set pio_mask to the mode on the jumpers with
  53 *	Goldstar GM82C711, PIC-1288A-125, UMC 82C871F, Winbond W83759,
  54 *	Winbond W83759A, Promise PDC20230-B
  55 *
  56 *  For now use autospeed and pio_mask as above with the W83759A. This may
  57 *  change.
  58 *
  59 */
  60
  61#include <linux/async.h>
  62#include <linux/kernel.h>
  63#include <linux/module.h>
  64#include <linux/pci.h>
  65#include <linux/init.h>
  66#include <linux/blkdev.h>
  67#include <linux/delay.h>
  68#include <scsi/scsi_host.h>
  69#include <linux/ata.h>
  70#include <linux/libata.h>
  71#include <linux/platform_device.h>
  72
  73#define DRV_NAME "pata_legacy"
  74#define DRV_VERSION "0.6.5"
  75
  76#define NR_HOST 6
  77
  78static int all;
  79module_param(all, int, 0444);
  80MODULE_PARM_DESC(all, "Grab all legacy port devices, even if PCI(0=off, 1=on)");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  81
  82enum controller {
  83	BIOS = 0,
  84	SNOOP = 1,
  85	PDC20230 = 2,
  86	HT6560A = 3,
  87	HT6560B = 4,
  88	OPTI611A = 5,
  89	OPTI46X = 6,
  90	QDI6500 = 7,
  91	QDI6580 = 8,
  92	QDI6580DP = 9,		/* Dual channel mode is different */
  93	W83759A = 10,
  94
  95	UNKNOWN = -1
  96};
  97
  98struct legacy_data {
  99	unsigned long timing;
 100	u8 clock[2];
 101	u8 last;
 102	int fast;
 103	enum controller type;
 104	struct platform_device *platform_dev;
 105};
 106
 107struct legacy_probe {
 108	unsigned char *name;
 109	unsigned long port;
 110	unsigned int irq;
 111	unsigned int slot;
 112	enum controller type;
 113	unsigned long private;
 114};
 115
 116struct legacy_controller {
 117	const char *name;
 118	struct ata_port_operations *ops;
 119	unsigned int pio_mask;
 120	unsigned int flags;
 121	unsigned int pflags;
 122	int (*setup)(struct platform_device *, struct legacy_probe *probe,
 123		struct legacy_data *data);
 124};
 125
 126static int legacy_port[NR_HOST] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
 127
 128static struct legacy_probe probe_list[NR_HOST];
 129static struct legacy_data legacy_data[NR_HOST];
 130static struct ata_host *legacy_host[NR_HOST];
 131static int nr_legacy_host;
 132
 133
 134static int probe_all;		/* Set to check all ISA port ranges */
 135static int ht6560a;		/* HT 6560A on primary 1, second 2, both 3 */
 136static int ht6560b;		/* HT 6560A on primary 1, second 2, both 3 */
 137static int opti82c611a;		/* Opti82c611A on primary 1, sec 2, both 3 */
 138static int opti82c46x;		/* Opti 82c465MV present(pri/sec autodetect) */
 139static int autospeed;		/* Chip present which snoops speed changes */
 140static int pio_mask = ATA_PIO4;	/* PIO range for autospeed devices */
 141static int iordy_mask = 0xFFFFFFFF;	/* Use iordy if available */
 142
 143/* Set to probe QDI controllers */
 144#ifdef CONFIG_PATA_QDI_MODULE
 145static int qdi = 1;
 146#else
 147static int qdi;
 148#endif
 149
 150#ifdef CONFIG_PATA_WINBOND_VLB_MODULE
 151static int winbond = 1;		/* Set to probe Winbond controllers,
 152					give I/O port if non standard */
 153#else
 154static int winbond;		/* Set to probe Winbond controllers,
 155					give I/O port if non standard */
 156#endif
 157
 158/**
 159 *	legacy_probe_add	-	Add interface to probe list
 160 *	@port: Controller port
 161 *	@irq: IRQ number
 162 *	@type: Controller type
 163 *	@private: Controller specific info
 164 *
 165 *	Add an entry into the probe list for ATA controllers. This is used
 166 *	to add the default ISA slots and then to build up the table
 167 *	further according to other ISA/VLB/Weird device scans
 168 *
 169 *	An I/O port list is used to keep ordering stable and sane, as we
 170 *	don't have any good way to talk about ordering otherwise
 171 */
 172
 173static int legacy_probe_add(unsigned long port, unsigned int irq,
 174				enum controller type, unsigned long private)
 175{
 176	struct legacy_probe *lp = &probe_list[0];
 177	int i;
 178	struct legacy_probe *free = NULL;
 179
 180	for (i = 0; i < NR_HOST; i++) {
 181		if (lp->port == 0 && free == NULL)
 182			free = lp;
 183		/* Matching port, or the correct slot for ordering */
 184		if (lp->port == port || legacy_port[i] == port) {
 
 
 185			free = lp;
 186			break;
 187		}
 188		lp++;
 189	}
 190	if (free == NULL) {
 191		printk(KERN_ERR "pata_legacy: Too many interfaces.\n");
 192		return -1;
 193	}
 194	/* Fill in the entry for later probing */
 195	free->port = port;
 196	free->irq = irq;
 197	free->type = type;
 198	free->private = private;
 199	return 0;
 200}
 201
 202
 203/**
 204 *	legacy_set_mode		-	mode setting
 205 *	@link: IDE link
 206 *	@unused: Device that failed when error is returned
 207 *
 208 *	Use a non standard set_mode function. We don't want to be tuned.
 209 *
 210 *	The BIOS configured everything. Our job is not to fiddle. Just use
 211 *	whatever PIO the hardware is using and leave it at that. When we
 212 *	get some kind of nice user driven API for control then we can
 213 *	expand on this as per hdparm in the base kernel.
 214 */
 215
 216static int legacy_set_mode(struct ata_link *link, struct ata_device **unused)
 217{
 218	struct ata_device *dev;
 219
 220	ata_for_each_dev(dev, link, ENABLED) {
 221		ata_dev_info(dev, "configured for PIO\n");
 222		dev->pio_mode = XFER_PIO_0;
 223		dev->xfer_mode = XFER_PIO_0;
 224		dev->xfer_shift = ATA_SHIFT_PIO;
 225		dev->flags |= ATA_DFLAG_PIO;
 226	}
 227	return 0;
 228}
 229
 230static struct scsi_host_template legacy_sht = {
 231	ATA_PIO_SHT(DRV_NAME),
 232};
 233
 234static const struct ata_port_operations legacy_base_port_ops = {
 235	.inherits	= &ata_sff_port_ops,
 236	.cable_detect	= ata_cable_40wire,
 237};
 238
 239/*
 240 *	These ops are used if the user indicates the hardware
 241 *	snoops the commands to decide on the mode and handles the
 242 *	mode selection "magically" itself. Several legacy controllers
 243 *	do this. The mode range can be set if it is not 0x1F by setting
 244 *	pio_mask as well.
 245 */
 246
 247static struct ata_port_operations simple_port_ops = {
 248	.inherits	= &legacy_base_port_ops,
 249	.sff_data_xfer	= ata_sff_data_xfer_noirq,
 250};
 251
 252static struct ata_port_operations legacy_port_ops = {
 253	.inherits	= &legacy_base_port_ops,
 254	.sff_data_xfer	= ata_sff_data_xfer_noirq,
 255	.set_mode	= legacy_set_mode,
 256};
 257
 258/*
 259 *	Promise 20230C and 20620 support
 260 *
 261 *	This controller supports PIO0 to PIO2. We set PIO timings
 262 *	conservatively to allow for 50MHz Vesa Local Bus. The 20620 DMA
 263 *	support is weird being DMA to controller and PIO'd to the host
 264 *	and not supported.
 265 */
 266
 267static void pdc20230_set_piomode(struct ata_port *ap, struct ata_device *adev)
 268{
 269	int tries = 5;
 270	int pio = adev->pio_mode - XFER_PIO_0;
 271	u8 rt;
 272	unsigned long flags;
 273
 274	/* Safe as UP only. Force I/Os to occur together */
 275
 276	local_irq_save(flags);
 277
 278	/* Unlock the control interface */
 279	do {
 280		inb(0x1F5);
 281		outb(inb(0x1F2) | 0x80, 0x1F2);
 282		inb(0x1F2);
 283		inb(0x3F6);
 284		inb(0x3F6);
 285		inb(0x1F2);
 286		inb(0x1F2);
 287	}
 288	while ((inb(0x1F2) & 0x80) && --tries);
 289
 290	local_irq_restore(flags);
 291
 292	outb(inb(0x1F4) & 0x07, 0x1F4);
 293
 294	rt = inb(0x1F3);
 295	rt &= 0x07 << (3 * adev->devno);
 296	if (pio)
 297		rt |= (1 + 3 * pio) << (3 * adev->devno);
 
 298
 299	udelay(100);
 300	outb(inb(0x1F2) | 0x01, 0x1F2);
 301	udelay(100);
 302	inb(0x1F5);
 303
 304}
 305
 306static unsigned int pdc_data_xfer_vlb(struct ata_device *dev,
 307			unsigned char *buf, unsigned int buflen, int rw)
 308{
 
 
 309	int slop = buflen & 3;
 310	struct ata_port *ap = dev->link->ap;
 311
 312	/* 32bit I/O capable *and* we need to write a whole number of dwords */
 313	if (ata_id_has_dword_io(dev->id) && (slop == 0 || slop == 3)
 314					&& (ap->pflags & ATA_PFLAG_PIO32)) {
 315		unsigned long flags;
 316
 317		local_irq_save(flags);
 318
 319		/* Perform the 32bit I/O synchronization sequence */
 320		ioread8(ap->ioaddr.nsect_addr);
 321		ioread8(ap->ioaddr.nsect_addr);
 322		ioread8(ap->ioaddr.nsect_addr);
 323
 324		/* Now the data */
 325		if (rw == READ)
 326			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 327		else
 328			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 329
 330		if (unlikely(slop)) {
 331			__le32 pad;
 
 332			if (rw == READ) {
 333				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
 334				memcpy(buf + buflen - slop, &pad, slop);
 335			} else {
 336				memcpy(&pad, buf + buflen - slop, slop);
 337				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
 338			}
 339			buflen += 4 - slop;
 340		}
 341		local_irq_restore(flags);
 342	} else
 343		buflen = ata_sff_data_xfer_noirq(dev, buf, buflen, rw);
 344
 345	return buflen;
 346}
 347
 348static struct ata_port_operations pdc20230_port_ops = {
 349	.inherits	= &legacy_base_port_ops,
 350	.set_piomode	= pdc20230_set_piomode,
 351	.sff_data_xfer	= pdc_data_xfer_vlb,
 352};
 353
 354/*
 355 *	Holtek 6560A support
 356 *
 357 *	This controller supports PIO0 to PIO2 (no IORDY even though higher
 358 *	timings can be loaded).
 359 */
 360
 361static void ht6560a_set_piomode(struct ata_port *ap, struct ata_device *adev)
 362{
 363	u8 active, recover;
 364	struct ata_timing t;
 365
 366	/* Get the timing data in cycles. For now play safe at 50Mhz */
 367	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 368
 369	active = clamp_val(t.active, 2, 15);
 370	recover = clamp_val(t.recover, 4, 15);
 371
 372	inb(0x3E6);
 373	inb(0x3E6);
 374	inb(0x3E6);
 375	inb(0x3E6);
 376
 377	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
 378	ioread8(ap->ioaddr.status_addr);
 379}
 380
 381static struct ata_port_operations ht6560a_port_ops = {
 382	.inherits	= &legacy_base_port_ops,
 383	.set_piomode	= ht6560a_set_piomode,
 384};
 385
 386/*
 387 *	Holtek 6560B support
 388 *
 389 *	This controller supports PIO0 to PIO4. We honour the BIOS/jumper FIFO
 390 *	setting unless we see an ATAPI device in which case we force it off.
 391 *
 392 *	FIXME: need to implement 2nd channel support.
 393 */
 394
 395static void ht6560b_set_piomode(struct ata_port *ap, struct ata_device *adev)
 396{
 397	u8 active, recover;
 398	struct ata_timing t;
 399
 400	/* Get the timing data in cycles. For now play safe at 50Mhz */
 401	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 402
 403	active = clamp_val(t.active, 2, 15);
 404	recover = clamp_val(t.recover, 2, 16) & 0x0F;
 405
 406	inb(0x3E6);
 407	inb(0x3E6);
 408	inb(0x3E6);
 409	inb(0x3E6);
 410
 411	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
 412
 413	if (adev->class != ATA_DEV_ATA) {
 414		u8 rconf = inb(0x3E6);
 415		if (rconf & 0x24) {
 416			rconf &= ~0x24;
 417			outb(rconf, 0x3E6);
 418		}
 419	}
 420	ioread8(ap->ioaddr.status_addr);
 421}
 422
 423static struct ata_port_operations ht6560b_port_ops = {
 424	.inherits	= &legacy_base_port_ops,
 425	.set_piomode	= ht6560b_set_piomode,
 426};
 427
 428/*
 429 *	Opti core chipset helpers
 430 */
 431
 432/**
 433 *	opti_syscfg	-	read OPTI chipset configuration
 434 *	@reg: Configuration register to read
 435 *
 436 *	Returns the value of an OPTI system board configuration register.
 437 */
 438
 439static u8 opti_syscfg(u8 reg)
 440{
 441	unsigned long flags;
 442	u8 r;
 443
 444	/* Uniprocessor chipset and must force cycles adjancent */
 445	local_irq_save(flags);
 446	outb(reg, 0x22);
 447	r = inb(0x24);
 448	local_irq_restore(flags);
 449	return r;
 450}
 451
 452/*
 453 *	Opti 82C611A
 454 *
 455 *	This controller supports PIO0 to PIO3.
 456 */
 457
 458static void opti82c611a_set_piomode(struct ata_port *ap,
 459						struct ata_device *adev)
 460{
 461	u8 active, recover, setup;
 462	struct ata_timing t;
 463	struct ata_device *pair = ata_dev_pair(adev);
 464	int clock;
 465	int khz[4] = { 50000, 40000, 33000, 25000 };
 466	u8 rc;
 467
 468	/* Enter configuration mode */
 469	ioread16(ap->ioaddr.error_addr);
 470	ioread16(ap->ioaddr.error_addr);
 471	iowrite8(3, ap->ioaddr.nsect_addr);
 472
 473	/* Read VLB clock strapping */
 474	clock = 1000000000 / khz[ioread8(ap->ioaddr.lbah_addr) & 0x03];
 475
 476	/* Get the timing data in cycles */
 477	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
 478
 479	/* Setup timing is shared */
 480	if (pair) {
 481		struct ata_timing tp;
 482		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
 483
 484		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
 485	}
 486
 487	active = clamp_val(t.active, 2, 17) - 2;
 488	recover = clamp_val(t.recover, 1, 16) - 1;
 489	setup = clamp_val(t.setup, 1, 4) - 1;
 490
 491	/* Select the right timing bank for write timing */
 492	rc = ioread8(ap->ioaddr.lbal_addr);
 493	rc &= 0x7F;
 494	rc |= (adev->devno << 7);
 495	iowrite8(rc, ap->ioaddr.lbal_addr);
 496
 497	/* Write the timings */
 498	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
 499
 500	/* Select the right bank for read timings, also
 501	   load the shared timings for address */
 502	rc = ioread8(ap->ioaddr.device_addr);
 503	rc &= 0xC0;
 504	rc |= adev->devno;	/* Index select */
 505	rc |= (setup << 4) | 0x04;
 506	iowrite8(rc, ap->ioaddr.device_addr);
 507
 508	/* Load the read timings */
 509	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
 510
 511	/* Ensure the timing register mode is right */
 512	rc = ioread8(ap->ioaddr.lbal_addr);
 513	rc &= 0x73;
 514	rc |= 0x84;
 515	iowrite8(rc, ap->ioaddr.lbal_addr);
 516
 517	/* Exit command mode */
 518	iowrite8(0x83,  ap->ioaddr.nsect_addr);
 519}
 520
 521
 522static struct ata_port_operations opti82c611a_port_ops = {
 523	.inherits	= &legacy_base_port_ops,
 524	.set_piomode	= opti82c611a_set_piomode,
 525};
 526
 527/*
 528 *	Opti 82C465MV
 529 *
 530 *	This controller supports PIO0 to PIO3. Unlike the 611A the MVB
 531 *	version is dual channel but doesn't have a lot of unique registers.
 532 */
 533
 534static void opti82c46x_set_piomode(struct ata_port *ap, struct ata_device *adev)
 535{
 536	u8 active, recover, setup;
 537	struct ata_timing t;
 538	struct ata_device *pair = ata_dev_pair(adev);
 539	int clock;
 540	int khz[4] = { 50000, 40000, 33000, 25000 };
 541	u8 rc;
 542	u8 sysclk;
 543
 544	/* Get the clock */
 545	sysclk = (opti_syscfg(0xAC) & 0xC0) >> 6;	/* BIOS set */
 546
 547	/* Enter configuration mode */
 548	ioread16(ap->ioaddr.error_addr);
 549	ioread16(ap->ioaddr.error_addr);
 550	iowrite8(3, ap->ioaddr.nsect_addr);
 551
 552	/* Read VLB clock strapping */
 553	clock = 1000000000 / khz[sysclk];
 554
 555	/* Get the timing data in cycles */
 556	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
 557
 558	/* Setup timing is shared */
 559	if (pair) {
 560		struct ata_timing tp;
 561		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
 562
 563		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
 564	}
 565
 566	active = clamp_val(t.active, 2, 17) - 2;
 567	recover = clamp_val(t.recover, 1, 16) - 1;
 568	setup = clamp_val(t.setup, 1, 4) - 1;
 569
 570	/* Select the right timing bank for write timing */
 571	rc = ioread8(ap->ioaddr.lbal_addr);
 572	rc &= 0x7F;
 573	rc |= (adev->devno << 7);
 574	iowrite8(rc, ap->ioaddr.lbal_addr);
 575
 576	/* Write the timings */
 577	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
 578
 579	/* Select the right bank for read timings, also
 580	   load the shared timings for address */
 581	rc = ioread8(ap->ioaddr.device_addr);
 582	rc &= 0xC0;
 583	rc |= adev->devno;	/* Index select */
 584	rc |= (setup << 4) | 0x04;
 585	iowrite8(rc, ap->ioaddr.device_addr);
 586
 587	/* Load the read timings */
 588	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
 589
 590	/* Ensure the timing register mode is right */
 591	rc = ioread8(ap->ioaddr.lbal_addr);
 592	rc &= 0x73;
 593	rc |= 0x84;
 594	iowrite8(rc, ap->ioaddr.lbal_addr);
 595
 596	/* Exit command mode */
 597	iowrite8(0x83,  ap->ioaddr.nsect_addr);
 598
 599	/* We need to know this for quad device on the MVB */
 600	ap->host->private_data = ap;
 601}
 602
 603/**
 604 *	opt82c465mv_qc_issue		-	command issue
 605 *	@qc: command pending
 606 *
 607 *	Called when the libata layer is about to issue a command. We wrap
 608 *	this interface so that we can load the correct ATA timings. The
 609 *	MVB has a single set of timing registers and these are shared
 610 *	across channels. As there are two registers we really ought to
 611 *	track the last two used values as a sort of register window. For
 612 *	now we just reload on a channel switch. On the single channel
 613 *	setup this condition never fires so we do nothing extra.
 614 *
 615 *	FIXME: dual channel needs ->serialize support
 616 */
 617
 618static unsigned int opti82c46x_qc_issue(struct ata_queued_cmd *qc)
 619{
 620	struct ata_port *ap = qc->ap;
 621	struct ata_device *adev = qc->dev;
 622
 623	/* If timings are set and for the wrong channel (2nd test is
 624	   due to a libata shortcoming and will eventually go I hope) */
 625	if (ap->host->private_data != ap->host
 626	    && ap->host->private_data != NULL)
 627		opti82c46x_set_piomode(ap, adev);
 628
 629	return ata_sff_qc_issue(qc);
 630}
 631
 632static struct ata_port_operations opti82c46x_port_ops = {
 633	.inherits	= &legacy_base_port_ops,
 634	.set_piomode	= opti82c46x_set_piomode,
 635	.qc_issue	= opti82c46x_qc_issue,
 636};
 637
 638/**
 639 *	qdi65x0_set_piomode		-	PIO setup for QDI65x0
 640 *	@ap: Port
 641 *	@adev: Device
 642 *
 643 *	In single channel mode the 6580 has one clock per device and we can
 644 *	avoid the requirement to clock switch. We also have to load the timing
 645 *	into the right clock according to whether we are master or slave.
 646 *
 647 *	In dual channel mode the 6580 has one clock per channel and we have
 648 *	to software clockswitch in qc_issue.
 649 */
 650
 651static void qdi65x0_set_piomode(struct ata_port *ap, struct ata_device *adev)
 652{
 653	struct ata_timing t;
 654	struct legacy_data *ld_qdi = ap->host->private_data;
 655	int active, recovery;
 656	u8 timing;
 657
 658	/* Get the timing data in cycles */
 659	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
 660
 661	if (ld_qdi->fast) {
 662		active = 8 - clamp_val(t.active, 1, 8);
 663		recovery = 18 - clamp_val(t.recover, 3, 18);
 664	} else {
 665		active = 9 - clamp_val(t.active, 2, 9);
 666		recovery = 15 - clamp_val(t.recover, 0, 15);
 667	}
 668	timing = (recovery << 4) | active | 0x08;
 669	ld_qdi->clock[adev->devno] = timing;
 670
 671	if (ld_qdi->type == QDI6580)
 672		outb(timing, ld_qdi->timing + 2 * adev->devno);
 673	else
 674		outb(timing, ld_qdi->timing + 2 * ap->port_no);
 675
 676	/* Clear the FIFO */
 677	if (ld_qdi->type != QDI6500 && adev->class != ATA_DEV_ATA)
 678		outb(0x5F, (ld_qdi->timing & 0xFFF0) + 3);
 679}
 680
 681/**
 682 *	qdi_qc_issue		-	command issue
 683 *	@qc: command pending
 684 *
 685 *	Called when the libata layer is about to issue a command. We wrap
 686 *	this interface so that we can load the correct ATA timings.
 687 */
 688
 689static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
 690{
 691	struct ata_port *ap = qc->ap;
 692	struct ata_device *adev = qc->dev;
 693	struct legacy_data *ld_qdi = ap->host->private_data;
 694
 695	if (ld_qdi->clock[adev->devno] != ld_qdi->last) {
 696		if (adev->pio_mode) {
 697			ld_qdi->last = ld_qdi->clock[adev->devno];
 698			outb(ld_qdi->clock[adev->devno], ld_qdi->timing +
 699							2 * ap->port_no);
 700		}
 701	}
 702	return ata_sff_qc_issue(qc);
 703}
 704
 705static unsigned int vlb32_data_xfer(struct ata_device *adev, unsigned char *buf,
 706					unsigned int buflen, int rw)
 
 707{
 
 708	struct ata_port *ap = adev->link->ap;
 709	int slop = buflen & 3;
 710
 711	if (ata_id_has_dword_io(adev->id) && (slop == 0 || slop == 3)
 712					&& (ap->pflags & ATA_PFLAG_PIO32)) {
 713		if (rw == WRITE)
 714			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 715		else
 716			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
 717
 718		if (unlikely(slop)) {
 719			__le32 pad;
 
 720			if (rw == WRITE) {
 721				memcpy(&pad, buf + buflen - slop, slop);
 722				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
 723			} else {
 724				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
 725				memcpy(buf + buflen - slop, &pad, slop);
 726			}
 727		}
 728		return (buflen + 3) & ~3;
 729	} else
 730		return ata_sff_data_xfer(adev, buf, buflen, rw);
 731}
 732
 733static int qdi_port(struct platform_device *dev,
 734			struct legacy_probe *lp, struct legacy_data *ld)
 735{
 736	if (devm_request_region(&dev->dev, lp->private, 4, "qdi") == NULL)
 737		return -EBUSY;
 738	ld->timing = lp->private;
 739	return 0;
 740}
 741
 742static struct ata_port_operations qdi6500_port_ops = {
 743	.inherits	= &legacy_base_port_ops,
 744	.set_piomode	= qdi65x0_set_piomode,
 745	.qc_issue	= qdi_qc_issue,
 746	.sff_data_xfer	= vlb32_data_xfer,
 747};
 748
 749static struct ata_port_operations qdi6580_port_ops = {
 750	.inherits	= &legacy_base_port_ops,
 751	.set_piomode	= qdi65x0_set_piomode,
 752	.sff_data_xfer	= vlb32_data_xfer,
 753};
 754
 755static struct ata_port_operations qdi6580dp_port_ops = {
 756	.inherits	= &legacy_base_port_ops,
 757	.set_piomode	= qdi65x0_set_piomode,
 758	.qc_issue	= qdi_qc_issue,
 759	.sff_data_xfer	= vlb32_data_xfer,
 760};
 761
 762static DEFINE_SPINLOCK(winbond_lock);
 763
 764static void winbond_writecfg(unsigned long port, u8 reg, u8 val)
 765{
 766	unsigned long flags;
 767	spin_lock_irqsave(&winbond_lock, flags);
 768	outb(reg, port + 0x01);
 769	outb(val, port + 0x02);
 770	spin_unlock_irqrestore(&winbond_lock, flags);
 771}
 772
 773static u8 winbond_readcfg(unsigned long port, u8 reg)
 774{
 775	u8 val;
 776
 777	unsigned long flags;
 778	spin_lock_irqsave(&winbond_lock, flags);
 779	outb(reg, port + 0x01);
 780	val = inb(port + 0x02);
 781	spin_unlock_irqrestore(&winbond_lock, flags);
 782
 783	return val;
 784}
 785
 786static void winbond_set_piomode(struct ata_port *ap, struct ata_device *adev)
 787{
 788	struct ata_timing t;
 789	struct legacy_data *ld_winbond = ap->host->private_data;
 790	int active, recovery;
 791	u8 reg;
 792	int timing = 0x88 + (ap->port_no * 4) + (adev->devno * 2);
 793
 794	reg = winbond_readcfg(ld_winbond->timing, 0x81);
 795
 796	/* Get the timing data in cycles */
 797	if (reg & 0x40)		/* Fast VLB bus, assume 50MHz */
 798		ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
 799	else
 800		ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
 801
 802	active = (clamp_val(t.active, 3, 17) - 1) & 0x0F;
 803	recovery = (clamp_val(t.recover, 1, 15) + 1) & 0x0F;
 804	timing = (active << 4) | recovery;
 805	winbond_writecfg(ld_winbond->timing, timing, reg);
 806
 807	/* Load the setup timing */
 808
 809	reg = 0x35;
 810	if (adev->class != ATA_DEV_ATA)
 811		reg |= 0x08;	/* FIFO off */
 812	if (!ata_pio_need_iordy(adev))
 813		reg |= 0x02;	/* IORDY off */
 814	reg |= (clamp_val(t.setup, 0, 3) << 6);
 815	winbond_writecfg(ld_winbond->timing, timing + 1, reg);
 816}
 817
 818static int winbond_port(struct platform_device *dev,
 819			struct legacy_probe *lp, struct legacy_data *ld)
 820{
 821	if (devm_request_region(&dev->dev, lp->private, 4, "winbond") == NULL)
 822		return -EBUSY;
 823	ld->timing = lp->private;
 824	return 0;
 825}
 826
 827static struct ata_port_operations winbond_port_ops = {
 828	.inherits	= &legacy_base_port_ops,
 829	.set_piomode	= winbond_set_piomode,
 830	.sff_data_xfer	= vlb32_data_xfer,
 831};
 832
 833static struct legacy_controller controllers[] = {
 834	{"BIOS",	&legacy_port_ops, 	ATA_PIO4,
 835			ATA_FLAG_NO_IORDY,	0,			NULL },
 836	{"Snooping", 	&simple_port_ops, 	ATA_PIO4,
 837			0,			0,			NULL },
 838	{"PDC20230",	&pdc20230_port_ops,	ATA_PIO2,
 839			ATA_FLAG_NO_IORDY,
 840			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,	NULL },
 841	{"HT6560A",	&ht6560a_port_ops,	ATA_PIO2,
 842			ATA_FLAG_NO_IORDY,	0,			NULL },
 843	{"HT6560B",	&ht6560b_port_ops,	ATA_PIO4,
 844			ATA_FLAG_NO_IORDY,	0,			NULL },
 845	{"OPTI82C611A",	&opti82c611a_port_ops,	ATA_PIO3,
 846			0,			0,			NULL },
 847	{"OPTI82C46X",	&opti82c46x_port_ops,	ATA_PIO3,
 848			0,			0,			NULL },
 849	{"QDI6500",	&qdi6500_port_ops,	ATA_PIO2,
 850			ATA_FLAG_NO_IORDY,
 851			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,    qdi_port },
 852	{"QDI6580",	&qdi6580_port_ops,	ATA_PIO4,
 853			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
 854	{"QDI6580DP",	&qdi6580dp_port_ops,	ATA_PIO4,
 855			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
 856	{"W83759A",	&winbond_port_ops,	ATA_PIO4,
 857			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,
 858								winbond_port }
 859};
 860
 861/**
 862 *	probe_chip_type		-	Discover controller
 863 *	@probe: Probe entry to check
 864 *
 865 *	Probe an ATA port and identify the type of controller. We don't
 866 *	check if the controller appears to be driveless at this point.
 867 */
 868
 869static __init int probe_chip_type(struct legacy_probe *probe)
 870{
 871	int mask = 1 << probe->slot;
 872
 873	if (winbond && (probe->port == 0x1F0 || probe->port == 0x170)) {
 874		u8 reg = winbond_readcfg(winbond, 0x81);
 875		reg |= 0x80;	/* jumpered mode off */
 876		winbond_writecfg(winbond, 0x81, reg);
 877		reg = winbond_readcfg(winbond, 0x83);
 878		reg |= 0xF0;	/* local control */
 879		winbond_writecfg(winbond, 0x83, reg);
 880		reg = winbond_readcfg(winbond, 0x85);
 881		reg |= 0xF0;	/* programmable timing */
 882		winbond_writecfg(winbond, 0x85, reg);
 883
 884		reg = winbond_readcfg(winbond, 0x81);
 885
 886		if (reg & mask)
 887			return W83759A;
 888	}
 889	if (probe->port == 0x1F0) {
 890		unsigned long flags;
 891		local_irq_save(flags);
 892		/* Probes */
 893		outb(inb(0x1F2) | 0x80, 0x1F2);
 894		inb(0x1F5);
 895		inb(0x1F2);
 896		inb(0x3F6);
 897		inb(0x3F6);
 898		inb(0x1F2);
 899		inb(0x1F2);
 900
 901		if ((inb(0x1F2) & 0x80) == 0) {
 902			/* PDC20230c or 20630 ? */
 903			printk(KERN_INFO  "PDC20230-C/20630 VLB ATA controller"
 904							" detected.\n");
 905			udelay(100);
 906			inb(0x1F5);
 907			local_irq_restore(flags);
 908			return PDC20230;
 909		} else {
 910			outb(0x55, 0x1F2);
 911			inb(0x1F2);
 912			inb(0x1F2);
 913			if (inb(0x1F2) == 0x00)
 914				printk(KERN_INFO "PDC20230-B VLB ATA "
 915						     "controller detected.\n");
 916			local_irq_restore(flags);
 917			return BIOS;
 918		}
 919	}
 920
 921	if (ht6560a & mask)
 922		return HT6560A;
 923	if (ht6560b & mask)
 924		return HT6560B;
 925	if (opti82c611a & mask)
 926		return OPTI611A;
 927	if (opti82c46x & mask)
 928		return OPTI46X;
 929	if (autospeed & mask)
 930		return SNOOP;
 931	return BIOS;
 932}
 933
 934
 935/**
 936 *	legacy_init_one		-	attach a legacy interface
 937 *	@pl: probe record
 938 *
 939 *	Register an ISA bus IDE interface. Such interfaces are PIO and we
 940 *	assume do not support IRQ sharing.
 941 */
 942
 943static __init int legacy_init_one(struct legacy_probe *probe)
 944{
 945	struct legacy_controller *controller = &controllers[probe->type];
 946	int pio_modes = controller->pio_mask;
 947	unsigned long io = probe->port;
 948	u32 mask = (1 << probe->slot);
 949	struct ata_port_operations *ops = controller->ops;
 950	struct legacy_data *ld = &legacy_data[probe->slot];
 951	struct ata_host *host = NULL;
 952	struct ata_port *ap;
 953	struct platform_device *pdev;
 954	struct ata_device *dev;
 955	void __iomem *io_addr, *ctrl_addr;
 956	u32 iordy = (iordy_mask & mask) ? 0: ATA_FLAG_NO_IORDY;
 957	int ret;
 958
 959	iordy |= controller->flags;
 960
 961	pdev = platform_device_register_simple(DRV_NAME, probe->slot, NULL, 0);
 962	if (IS_ERR(pdev))
 963		return PTR_ERR(pdev);
 964
 965	ret = -EBUSY;
 966	if (devm_request_region(&pdev->dev, io, 8, "pata_legacy") == NULL ||
 967	    devm_request_region(&pdev->dev, io + 0x0206, 1,
 968							"pata_legacy") == NULL)
 969		goto fail;
 970
 971	ret = -ENOMEM;
 972	io_addr = devm_ioport_map(&pdev->dev, io, 8);
 973	ctrl_addr = devm_ioport_map(&pdev->dev, io + 0x0206, 1);
 974	if (!io_addr || !ctrl_addr)
 975		goto fail;
 976	ld->type = probe->type;
 977	if (controller->setup)
 978		if (controller->setup(pdev, probe, ld) < 0)
 979			goto fail;
 980	host = ata_host_alloc(&pdev->dev, 1);
 981	if (!host)
 982		goto fail;
 983	ap = host->ports[0];
 984
 985	ap->ops = ops;
 986	ap->pio_mask = pio_modes;
 987	ap->flags |= ATA_FLAG_SLAVE_POSS | iordy;
 988	ap->pflags |= controller->pflags;
 989	ap->ioaddr.cmd_addr = io_addr;
 990	ap->ioaddr.altstatus_addr = ctrl_addr;
 991	ap->ioaddr.ctl_addr = ctrl_addr;
 992	ata_sff_std_ports(&ap->ioaddr);
 993	ap->host->private_data = ld;
 994
 995	ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", io, io + 0x0206);
 996
 997	ret = ata_host_activate(host, probe->irq, ata_sff_interrupt, 0,
 998				&legacy_sht);
 999	if (ret)
1000		goto fail;
1001	async_synchronize_full();
1002	ld->platform_dev = pdev;
1003
1004	/* Nothing found means we drop the port as its probably not there */
1005
1006	ret = -ENODEV;
1007	ata_for_each_dev(dev, &ap->link, ALL) {
1008		if (!ata_dev_absent(dev)) {
1009			legacy_host[probe->slot] = host;
1010			ld->platform_dev = pdev;
1011			return 0;
1012		}
1013	}
1014	ata_host_detach(host);
1015fail:
1016	platform_device_unregister(pdev);
1017	return ret;
1018}
1019
1020/**
1021 *	legacy_check_special_cases	-	ATA special cases
1022 *	@p: PCI device to check
1023 *	@master: set this if we find an ATA master
1024 *	@master: set this if we find an ATA secondary
1025 *
1026 *	A small number of vendors implemented early PCI ATA interfaces
1027 *	on bridge logic without the ATA interface being PCI visible.
1028 *	Where we have a matching PCI driver we must skip the relevant
1029 *	device here. If we don't know about it then the legacy driver
1030 *	is the right driver anyway.
1031 */
1032
1033static void __init legacy_check_special_cases(struct pci_dev *p, int *primary,
1034								int *secondary)
1035{
1036	/* Cyrix CS5510 pre SFF MWDMA ATA on the bridge */
1037	if (p->vendor == 0x1078 && p->device == 0x0000) {
1038		*primary = *secondary = 1;
1039		return;
1040	}
1041	/* Cyrix CS5520 pre SFF MWDMA ATA on the bridge */
1042	if (p->vendor == 0x1078 && p->device == 0x0002) {
1043		*primary = *secondary = 1;
1044		return;
1045	}
1046	/* Intel MPIIX - PIO ATA on non PCI side of bridge */
1047	if (p->vendor == 0x8086 && p->device == 0x1234) {
1048		u16 r;
1049		pci_read_config_word(p, 0x6C, &r);
1050		if (r & 0x8000) {
1051			/* ATA port enabled */
1052			if (r & 0x4000)
1053				*secondary = 1;
1054			else
1055				*primary = 1;
1056		}
1057		return;
1058	}
1059}
1060
1061static __init void probe_opti_vlb(void)
1062{
1063	/* If an OPTI 82C46X is present find out where the channels are */
1064	static const char *optis[4] = {
1065		"3/463MV", "5MV",
1066		"5MVA", "5MVB"
1067	};
1068	u8 chans = 1;
1069	u8 ctrl = (opti_syscfg(0x30) & 0xC0) >> 6;
1070
1071	opti82c46x = 3;	/* Assume master and slave first */
1072	printk(KERN_INFO DRV_NAME ": Opti 82C46%s chipset support.\n",
1073								optis[ctrl]);
1074	if (ctrl == 3)
1075		chans = (opti_syscfg(0x3F) & 0x20) ? 2 : 1;
1076	ctrl = opti_syscfg(0xAC);
1077	/* Check enabled and this port is the 465MV port. On the
1078	   MVB we may have two channels */
1079	if (ctrl & 8) {
1080		if (chans == 2) {
1081			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1082			legacy_probe_add(0x170, 15, OPTI46X, 0);
1083		}
1084		if (ctrl & 4)
1085			legacy_probe_add(0x170, 15, OPTI46X, 0);
1086		else
1087			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1088	} else
1089		legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1090}
1091
1092static __init void qdi65_identify_port(u8 r, u8 res, unsigned long port)
1093{
1094	static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
1095	/* Check card type */
1096	if ((r & 0xF0) == 0xC0) {
1097		/* QD6500: single channel */
1098		if (r & 8)
1099			/* Disabled ? */
1100			return;
1101		legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1102								QDI6500, port);
1103	}
1104	if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
1105		/* QD6580: dual channel */
1106		if (!request_region(port + 2 , 2, "pata_qdi")) {
1107			release_region(port, 2);
1108			return;
1109		}
1110		res = inb(port + 3);
1111		/* Single channel mode ? */
1112		if (res & 1)
1113			legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1114								QDI6580, port);
1115		else { /* Dual channel mode */
1116			legacy_probe_add(0x1F0, 14, QDI6580DP, port);
1117			/* port + 0x02, r & 0x04 */
1118			legacy_probe_add(0x170, 15, QDI6580DP, port + 2);
1119		}
1120		release_region(port + 2, 2);
1121	}
1122}
1123
1124static __init void probe_qdi_vlb(void)
1125{
1126	unsigned long flags;
1127	static const unsigned long qd_port[2] = { 0x30, 0xB0 };
1128	int i;
1129
1130	/*
1131	 *	Check each possible QD65xx base address
1132	 */
1133
1134	for (i = 0; i < 2; i++) {
1135		unsigned long port = qd_port[i];
1136		u8 r, res;
1137
1138
1139		if (request_region(port, 2, "pata_qdi")) {
1140			/* Check for a card */
1141			local_irq_save(flags);
1142			/* I have no h/w that needs this delay but it
1143			   is present in the historic code */
1144			r = inb(port);
1145			udelay(1);
1146			outb(0x19, port);
1147			udelay(1);
1148			res = inb(port);
1149			udelay(1);
1150			outb(r, port);
1151			udelay(1);
1152			local_irq_restore(flags);
1153
1154			/* Fail */
1155			if (res == 0x19) {
1156				release_region(port, 2);
1157				continue;
1158			}
1159			/* Passes the presence test */
1160			r = inb(port + 1);
1161			udelay(1);
1162			/* Check port agrees with port set */
1163			if ((r & 2) >> 1 == i)
1164				qdi65_identify_port(r, res, port);
1165			release_region(port, 2);
1166		}
1167	}
1168}
1169
1170/**
1171 *	legacy_init		-	attach legacy interfaces
1172 *
1173 *	Attach legacy IDE interfaces by scanning the usual IRQ/port suspects.
1174 *	Right now we do not scan the ide0 and ide1 address but should do so
1175 *	for non PCI systems or systems with no PCI IDE legacy mode devices.
1176 *	If you fix that note there are special cases to consider like VLB
1177 *	drivers and CS5510/20.
1178 */
1179
1180static __init int legacy_init(void)
1181{
1182	int i;
1183	int ct = 0;
1184	int primary = 0;
1185	int secondary = 0;
1186	int pci_present = 0;
1187	struct legacy_probe *pl = &probe_list[0];
1188	int slot = 0;
1189
1190	struct pci_dev *p = NULL;
1191
1192	for_each_pci_dev(p) {
1193		int r;
1194		/* Check for any overlap of the system ATA mappings. Native
1195		   mode controllers stuck on these addresses or some devices
1196		   in 'raid' mode won't be found by the storage class test */
1197		for (r = 0; r < 6; r++) {
1198			if (pci_resource_start(p, r) == 0x1f0)
1199				primary = 1;
1200			if (pci_resource_start(p, r) == 0x170)
1201				secondary = 1;
1202		}
1203		/* Check for special cases */
1204		legacy_check_special_cases(p, &primary, &secondary);
1205
1206		/* If PCI bus is present then don't probe for tertiary
1207		   legacy ports */
1208		pci_present = 1;
1209	}
1210
1211	if (winbond == 1)
1212		winbond = 0x130;	/* Default port, alt is 1B0 */
1213
1214	if (primary == 0 || all)
1215		legacy_probe_add(0x1F0, 14, UNKNOWN, 0);
1216	if (secondary == 0 || all)
1217		legacy_probe_add(0x170, 15, UNKNOWN, 0);
1218
1219	if (probe_all || !pci_present) {
1220		/* ISA/VLB extra ports */
1221		legacy_probe_add(0x1E8, 11, UNKNOWN, 0);
1222		legacy_probe_add(0x168, 10, UNKNOWN, 0);
1223		legacy_probe_add(0x1E0, 8, UNKNOWN, 0);
1224		legacy_probe_add(0x160, 12, UNKNOWN, 0);
1225	}
1226
1227	if (opti82c46x)
1228		probe_opti_vlb();
1229	if (qdi)
1230		probe_qdi_vlb();
1231
1232	for (i = 0; i < NR_HOST; i++, pl++) {
1233		if (pl->port == 0)
1234			continue;
1235		if (pl->type == UNKNOWN)
1236			pl->type = probe_chip_type(pl);
1237		pl->slot = slot++;
1238		if (legacy_init_one(pl) == 0)
1239			ct++;
1240	}
1241	if (ct != 0)
1242		return 0;
1243	return -ENODEV;
1244}
1245
1246static __exit void legacy_exit(void)
1247{
1248	int i;
1249
1250	for (i = 0; i < nr_legacy_host; i++) {
1251		struct legacy_data *ld = &legacy_data[i];
1252		ata_host_detach(legacy_host[i]);
1253		platform_device_unregister(ld->platform_dev);
1254	}
1255}
1256
1257MODULE_AUTHOR("Alan Cox");
1258MODULE_DESCRIPTION("low-level driver for legacy ATA");
1259MODULE_LICENSE("GPL");
1260MODULE_VERSION(DRV_VERSION);
1261MODULE_ALIAS("pata_qdi");
1262MODULE_ALIAS("pata_winbond");
1263
1264module_param(probe_all, int, 0);
1265module_param(autospeed, int, 0);
1266module_param(ht6560a, int, 0);
1267module_param(ht6560b, int, 0);
1268module_param(opti82c611a, int, 0);
1269module_param(opti82c46x, int, 0);
1270module_param(qdi, int, 0);
1271module_param(winbond, int, 0);
1272module_param(pio_mask, int, 0);
1273module_param(iordy_mask, int, 0);
1274
1275module_init(legacy_init);
1276module_exit(legacy_exit);