• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright (C) 2001-2002	Andre Hedrick <andre@linux-ide.org>
3  * Copyright (C) 2003		Red Hat
4  * Copyright (C) 2007-2008	MontaVista Software, Inc.
5  * Copyright (C) 2007-2008	Bartlomiej Zolnierkiewicz
6  *
7  *  May be copied or modified under the terms of the GNU General Public License
8  *
9  *  Documentation for CMD680:
10  *  http://gkernel.sourceforge.net/specs/sii/sii-0680a-v1.31.pdf.bz2
11  *
12  *  Documentation for SiI 3112:
13  *  http://gkernel.sourceforge.net/specs/sii/3112A_SiI-DS-0095-B2.pdf.bz2
14  *
15  *  Errata and other documentation only available under NDA.
16  *
17  *
18  *  FAQ Items:
19  *	If you are using Marvell SATA-IDE adapters with Maxtor drives
20  *	ensure the system is set up for ATA100/UDMA5, not UDMA6.
21  *
22  *	If you are using WD drives with SATA bridges you must set the
23  *	drive to "Single". "Master" will hang.
24  *
25  *	If you have strange problems with nVidia chipset systems please
26  *	see the SI support documentation and update your system BIOS
27  *	if necessary
28  *
29  *  The Dell DRAC4 has some interesting features including effectively hot
30  *  unplugging/replugging the virtual CD interface when the DRAC is reset.
31  *  This often causes drivers/ide/siimage to panic but is ok with the rather
32  *  smarter code in libata.
33  *
34  * TODO:
35  * - VDMA support
36  */
37 
38 #include <linux/types.h>
39 #include <linux/module.h>
40 #include <linux/pci.h>
41 #include <linux/ide.h>
42 #include <linux/init.h>
43 #include <linux/io.h>
44 
45 #define DRV_NAME "siimage"
46 
47 /**
48  *	pdev_is_sata		-	check if device is SATA
49  *	@pdev:	PCI device to check
50  *
51  *	Returns true if this is a SATA controller
52  */
53 
pdev_is_sata(struct pci_dev * pdev)54 static int pdev_is_sata(struct pci_dev *pdev)
55 {
56 #ifdef CONFIG_BLK_DEV_IDE_SATA
57 	switch (pdev->device) {
58 	case PCI_DEVICE_ID_SII_3112:
59 	case PCI_DEVICE_ID_SII_1210SA:
60 		return 1;
61 	case PCI_DEVICE_ID_SII_680:
62 		return 0;
63 	}
64 	BUG();
65 #endif
66 	return 0;
67 }
68 
69 /**
70  *	is_sata			-	check if hwif is SATA
71  *	@hwif:	interface to check
72  *
73  *	Returns true if this is a SATA controller
74  */
75 
is_sata(ide_hwif_t * hwif)76 static inline int is_sata(ide_hwif_t *hwif)
77 {
78 	return pdev_is_sata(to_pci_dev(hwif->dev));
79 }
80 
81 /**
82  *	siimage_selreg		-	return register base
83  *	@hwif: interface
84  *	@r: config offset
85  *
86  *	Turn a config register offset into the right address in either
87  *	PCI space or MMIO space to access the control register in question
88  *	Thankfully this is a configuration operation, so isn't performance
89  *	critical.
90  */
91 
siimage_selreg(ide_hwif_t * hwif,int r)92 static unsigned long siimage_selreg(ide_hwif_t *hwif, int r)
93 {
94 	unsigned long base = (unsigned long)hwif->hwif_data;
95 
96 	base += 0xA0 + r;
97 	if (hwif->host_flags & IDE_HFLAG_MMIO)
98 		base += hwif->channel << 6;
99 	else
100 		base += hwif->channel << 4;
101 	return base;
102 }
103 
104 /**
105  *	siimage_seldev		-	return register base
106  *	@hwif: interface
107  *	@r: config offset
108  *
109  *	Turn a config register offset into the right address in either
110  *	PCI space or MMIO space to access the control register in question
111  *	including accounting for the unit shift.
112  */
113 
siimage_seldev(ide_drive_t * drive,int r)114 static inline unsigned long siimage_seldev(ide_drive_t *drive, int r)
115 {
116 	ide_hwif_t *hwif	= drive->hwif;
117 	unsigned long base	= (unsigned long)hwif->hwif_data;
118 	u8 unit			= drive->dn & 1;
119 
120 	base += 0xA0 + r;
121 	if (hwif->host_flags & IDE_HFLAG_MMIO)
122 		base += hwif->channel << 6;
123 	else
124 		base += hwif->channel << 4;
125 	base |= unit << unit;
126 	return base;
127 }
128 
sil_ioread8(struct pci_dev * dev,unsigned long addr)129 static u8 sil_ioread8(struct pci_dev *dev, unsigned long addr)
130 {
131 	struct ide_host *host = pci_get_drvdata(dev);
132 	u8 tmp = 0;
133 
134 	if (host->host_priv)
135 		tmp = readb((void __iomem *)addr);
136 	else
137 		pci_read_config_byte(dev, addr, &tmp);
138 
139 	return tmp;
140 }
141 
sil_ioread16(struct pci_dev * dev,unsigned long addr)142 static u16 sil_ioread16(struct pci_dev *dev, unsigned long addr)
143 {
144 	struct ide_host *host = pci_get_drvdata(dev);
145 	u16 tmp = 0;
146 
147 	if (host->host_priv)
148 		tmp = readw((void __iomem *)addr);
149 	else
150 		pci_read_config_word(dev, addr, &tmp);
151 
152 	return tmp;
153 }
154 
sil_iowrite8(struct pci_dev * dev,u8 val,unsigned long addr)155 static void sil_iowrite8(struct pci_dev *dev, u8 val, unsigned long addr)
156 {
157 	struct ide_host *host = pci_get_drvdata(dev);
158 
159 	if (host->host_priv)
160 		writeb(val, (void __iomem *)addr);
161 	else
162 		pci_write_config_byte(dev, addr, val);
163 }
164 
sil_iowrite16(struct pci_dev * dev,u16 val,unsigned long addr)165 static void sil_iowrite16(struct pci_dev *dev, u16 val, unsigned long addr)
166 {
167 	struct ide_host *host = pci_get_drvdata(dev);
168 
169 	if (host->host_priv)
170 		writew(val, (void __iomem *)addr);
171 	else
172 		pci_write_config_word(dev, addr, val);
173 }
174 
sil_iowrite32(struct pci_dev * dev,u32 val,unsigned long addr)175 static void sil_iowrite32(struct pci_dev *dev, u32 val, unsigned long addr)
176 {
177 	struct ide_host *host = pci_get_drvdata(dev);
178 
179 	if (host->host_priv)
180 		writel(val, (void __iomem *)addr);
181 	else
182 		pci_write_config_dword(dev, addr, val);
183 }
184 
185 /**
186  *	sil_udma_filter		-	compute UDMA mask
187  *	@drive: IDE device
188  *
189  *	Compute the available UDMA speeds for the device on the interface.
190  *
191  *	For the CMD680 this depends on the clocking mode (scsc), for the
192  *	SI3112 SATA controller life is a bit simpler.
193  */
194 
sil_pata_udma_filter(ide_drive_t * drive)195 static u8 sil_pata_udma_filter(ide_drive_t *drive)
196 {
197 	ide_hwif_t *hwif	= drive->hwif;
198 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
199 	unsigned long base	= (unsigned long)hwif->hwif_data;
200 	u8 scsc, mask		= 0;
201 
202 	base += (hwif->host_flags & IDE_HFLAG_MMIO) ? 0x4A : 0x8A;
203 
204 	scsc = sil_ioread8(dev, base);
205 
206 	switch (scsc & 0x30) {
207 	case 0x10:	/* 133 */
208 		mask = ATA_UDMA6;
209 		break;
210 	case 0x20:	/* 2xPCI */
211 		mask = ATA_UDMA6;
212 		break;
213 	case 0x00:	/* 100 */
214 		mask = ATA_UDMA5;
215 		break;
216 	default: 	/* Disabled ? */
217 		BUG();
218 	}
219 
220 	return mask;
221 }
222 
sil_sata_udma_filter(ide_drive_t * drive)223 static u8 sil_sata_udma_filter(ide_drive_t *drive)
224 {
225 	char *m = (char *)&drive->id[ATA_ID_PROD];
226 
227 	return strstr(m, "Maxtor") ? ATA_UDMA5 : ATA_UDMA6;
228 }
229 
230 /**
231  *	sil_set_pio_mode	-	set host controller for PIO mode
232  *	@hwif: port
233  *	@drive: drive
234  *
235  *	Load the timing settings for this device mode into the
236  *	controller.
237  */
238 
sil_set_pio_mode(ide_hwif_t * hwif,ide_drive_t * drive)239 static void sil_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
240 {
241 	static const u16 tf_speed[]   = { 0x328a, 0x2283, 0x1281, 0x10c3, 0x10c1 };
242 	static const u16 data_speed[] = { 0x328a, 0x2283, 0x1104, 0x10c3, 0x10c1 };
243 
244 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
245 	ide_drive_t *pair	= ide_get_pair_dev(drive);
246 	u32 speedt		= 0;
247 	u16 speedp		= 0;
248 	unsigned long addr	= siimage_seldev(drive, 0x04);
249 	unsigned long tfaddr	= siimage_selreg(hwif,	0x02);
250 	unsigned long base	= (unsigned long)hwif->hwif_data;
251 	const u8 pio		= drive->pio_mode - XFER_PIO_0;
252 	u8 tf_pio		= pio;
253 	u8 mmio			= (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
254 	u8 addr_mask		= hwif->channel ? (mmio ? 0xF4 : 0x84)
255 						: (mmio ? 0xB4 : 0x80);
256 	u8 mode			= 0;
257 	u8 unit			= drive->dn & 1;
258 
259 	/* trim *taskfile* PIO to the slowest of the master/slave */
260 	if (pair) {
261 		u8 pair_pio = pair->pio_mode - XFER_PIO_0;
262 
263 		if (pair_pio < tf_pio)
264 			tf_pio = pair_pio;
265 	}
266 
267 	/* cheat for now and use the docs */
268 	speedp = data_speed[pio];
269 	speedt = tf_speed[tf_pio];
270 
271 	sil_iowrite16(dev, speedp, addr);
272 	sil_iowrite16(dev, speedt, tfaddr);
273 
274 	/* now set up IORDY */
275 	speedp = sil_ioread16(dev, tfaddr - 2);
276 	speedp &= ~0x200;
277 
278 	mode = sil_ioread8(dev, base + addr_mask);
279 	mode &= ~(unit ? 0x30 : 0x03);
280 
281 	if (ide_pio_need_iordy(drive, pio)) {
282 		speedp |= 0x200;
283 		mode |= unit ? 0x10 : 0x01;
284 	}
285 
286 	sil_iowrite16(dev, speedp, tfaddr - 2);
287 	sil_iowrite8(dev, mode, base + addr_mask);
288 }
289 
290 /**
291  *	sil_set_dma_mode	-	set host controller for DMA mode
292  *	@hwif: port
293  *	@drive: drive
294  *
295  *	Tune the SiI chipset for the desired DMA mode.
296  */
297 
sil_set_dma_mode(ide_hwif_t * hwif,ide_drive_t * drive)298 static void sil_set_dma_mode(ide_hwif_t *hwif, ide_drive_t *drive)
299 {
300 	static const u8 ultra6[] = { 0x0F, 0x0B, 0x07, 0x05, 0x03, 0x02, 0x01 };
301 	static const u8 ultra5[] = { 0x0C, 0x07, 0x05, 0x04, 0x02, 0x01 };
302 	static const u16 dma[]	 = { 0x2208, 0x10C2, 0x10C1 };
303 
304 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
305 	unsigned long base	= (unsigned long)hwif->hwif_data;
306 	u16 ultra = 0, multi	= 0;
307 	u8 mode = 0, unit	= drive->dn & 1;
308 	u8 mmio			= (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
309 	u8 scsc = 0, addr_mask	= hwif->channel ? (mmio ? 0xF4 : 0x84)
310 						: (mmio ? 0xB4 : 0x80);
311 	unsigned long ma	= siimage_seldev(drive, 0x08);
312 	unsigned long ua	= siimage_seldev(drive, 0x0C);
313 	const u8 speed		= drive->dma_mode;
314 
315 	scsc  = sil_ioread8 (dev, base + (mmio ? 0x4A : 0x8A));
316 	mode  = sil_ioread8 (dev, base + addr_mask);
317 	multi = sil_ioread16(dev, ma);
318 	ultra = sil_ioread16(dev, ua);
319 
320 	mode  &= ~(unit ? 0x30 : 0x03);
321 	ultra &= ~0x3F;
322 	scsc = ((scsc & 0x30) == 0x00) ? 0 : 1;
323 
324 	scsc = is_sata(hwif) ? 1 : scsc;
325 
326 	if (speed >= XFER_UDMA_0) {
327 		multi  = dma[2];
328 		ultra |= scsc ? ultra6[speed - XFER_UDMA_0] :
329 				ultra5[speed - XFER_UDMA_0];
330 		mode  |= unit ? 0x30 : 0x03;
331 	} else {
332 		multi = dma[speed - XFER_MW_DMA_0];
333 		mode |= unit ? 0x20 : 0x02;
334 	}
335 
336 	sil_iowrite8 (dev, mode, base + addr_mask);
337 	sil_iowrite16(dev, multi, ma);
338 	sil_iowrite16(dev, ultra, ua);
339 }
340 
sil_test_irq(ide_hwif_t * hwif)341 static int sil_test_irq(ide_hwif_t *hwif)
342 {
343 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
344 	unsigned long addr	= siimage_selreg(hwif, 1);
345 	u8 val			= sil_ioread8(dev, addr);
346 
347 	/* Return 1 if INTRQ asserted */
348 	return (val & 8) ? 1 : 0;
349 }
350 
351 /**
352  *	siimage_mmio_dma_test_irq	-	check we caused an IRQ
353  *	@drive: drive we are testing
354  *
355  *	Check if we caused an IDE DMA interrupt. We may also have caused
356  *	SATA status interrupts, if so we clean them up and continue.
357  */
358 
siimage_mmio_dma_test_irq(ide_drive_t * drive)359 static int siimage_mmio_dma_test_irq(ide_drive_t *drive)
360 {
361 	ide_hwif_t *hwif	= drive->hwif;
362 	void __iomem *sata_error_addr
363 		= (void __iomem *)hwif->sata_scr[SATA_ERROR_OFFSET];
364 
365 	if (sata_error_addr) {
366 		unsigned long base	= (unsigned long)hwif->hwif_data;
367 		u32 ext_stat		= readl((void __iomem *)(base + 0x10));
368 		u8 watchdog		= 0;
369 
370 		if (ext_stat & ((hwif->channel) ? 0x40 : 0x10)) {
371 			u32 sata_error = readl(sata_error_addr);
372 
373 			writel(sata_error, sata_error_addr);
374 			watchdog = (sata_error & 0x00680000) ? 1 : 0;
375 			printk(KERN_WARNING "%s: sata_error = 0x%08x, "
376 				"watchdog = %d, %s\n",
377 				drive->name, sata_error, watchdog, __func__);
378 		} else
379 			watchdog = (ext_stat & 0x8000) ? 1 : 0;
380 
381 		ext_stat >>= 16;
382 		if (!(ext_stat & 0x0404) && !watchdog)
383 			return 0;
384 	}
385 
386 	/* return 1 if INTR asserted */
387 	if (readb((void __iomem *)(hwif->dma_base + ATA_DMA_STATUS)) & 4)
388 		return 1;
389 
390 	return 0;
391 }
392 
siimage_dma_test_irq(ide_drive_t * drive)393 static int siimage_dma_test_irq(ide_drive_t *drive)
394 {
395 	if (drive->hwif->host_flags & IDE_HFLAG_MMIO)
396 		return siimage_mmio_dma_test_irq(drive);
397 	else
398 		return ide_dma_test_irq(drive);
399 }
400 
401 /**
402  *	sil_sata_reset_poll	-	wait for SATA reset
403  *	@drive: drive we are resetting
404  *
405  *	Poll the SATA phy and see whether it has come back from the dead
406  *	yet.
407  */
408 
sil_sata_reset_poll(ide_drive_t * drive)409 static blk_status_t sil_sata_reset_poll(ide_drive_t *drive)
410 {
411 	ide_hwif_t *hwif = drive->hwif;
412 	void __iomem *sata_status_addr
413 		= (void __iomem *)hwif->sata_scr[SATA_STATUS_OFFSET];
414 
415 	if (sata_status_addr) {
416 		/* SATA Status is available only when in MMIO mode */
417 		u32 sata_stat = readl(sata_status_addr);
418 
419 		if ((sata_stat & 0x03) != 0x03) {
420 			printk(KERN_WARNING "%s: reset phy dead, status=0x%08x\n",
421 					    hwif->name, sata_stat);
422 			return BLK_STS_IOERR;
423 		}
424 	}
425 
426 	return BLK_STS_OK;
427 }
428 
429 /**
430  *	sil_sata_pre_reset	-	reset hook
431  *	@drive: IDE device being reset
432  *
433  *	For the SATA devices we need to handle recalibration/geometry
434  *	differently
435  */
436 
sil_sata_pre_reset(ide_drive_t * drive)437 static void sil_sata_pre_reset(ide_drive_t *drive)
438 {
439 	if (drive->media == ide_disk) {
440 		drive->special_flags &=
441 			~(IDE_SFLAG_SET_GEOMETRY | IDE_SFLAG_RECALIBRATE);
442 	}
443 }
444 
445 /**
446  *	init_chipset_siimage	-	set up an SI device
447  *	@dev: PCI device
448  *
449  *	Perform the initial PCI set up for this device. Attempt to switch
450  *	to 133 MHz clocking if the system isn't already set up to do it.
451  */
452 
init_chipset_siimage(struct pci_dev * dev)453 static int init_chipset_siimage(struct pci_dev *dev)
454 {
455 	struct ide_host *host = pci_get_drvdata(dev);
456 	void __iomem *ioaddr = host->host_priv;
457 	unsigned long base, scsc_addr;
458 	u8 rev = dev->revision, tmp;
459 
460 	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, rev ? 1 : 255);
461 
462 	if (ioaddr)
463 		pci_set_master(dev);
464 
465 	base = (unsigned long)ioaddr;
466 
467 	if (ioaddr && pdev_is_sata(dev)) {
468 		u32 tmp32, irq_mask;
469 
470 		/* make sure IDE0/1 interrupts are not masked */
471 		irq_mask = (1 << 22) | (1 << 23);
472 		tmp32 = readl(ioaddr + 0x48);
473 		if (tmp32 & irq_mask) {
474 			tmp32 &= ~irq_mask;
475 			writel(tmp32, ioaddr + 0x48);
476 			readl(ioaddr + 0x48); /* flush */
477 		}
478 		writel(0, ioaddr + 0x148);
479 		writel(0, ioaddr + 0x1C8);
480 	}
481 
482 	sil_iowrite8(dev, 0, base ? (base + 0xB4) : 0x80);
483 	sil_iowrite8(dev, 0, base ? (base + 0xF4) : 0x84);
484 
485 	scsc_addr = base ? (base + 0x4A) : 0x8A;
486 	tmp = sil_ioread8(dev, scsc_addr);
487 
488 	switch (tmp & 0x30) {
489 	case 0x00:
490 		/* On 100 MHz clocking, try and switch to 133 MHz */
491 		sil_iowrite8(dev, tmp | 0x10, scsc_addr);
492 		break;
493 	case 0x30:
494 		/* Clocking is disabled, attempt to force 133MHz clocking. */
495 		sil_iowrite8(dev, tmp & ~0x20, scsc_addr);
496 	case 0x10:
497 		/* On 133Mhz clocking. */
498 		break;
499 	case 0x20:
500 		/* On PCIx2 clocking. */
501 		break;
502 	}
503 
504 	tmp = sil_ioread8(dev, scsc_addr);
505 
506 	sil_iowrite8 (dev,       0x72, base + 0xA1);
507 	sil_iowrite16(dev,     0x328A, base + 0xA2);
508 	sil_iowrite32(dev, 0x62DD62DD, base + 0xA4);
509 	sil_iowrite32(dev, 0x43924392, base + 0xA8);
510 	sil_iowrite32(dev, 0x40094009, base + 0xAC);
511 	sil_iowrite8 (dev,       0x72, base ? (base + 0xE1) : 0xB1);
512 	sil_iowrite16(dev,     0x328A, base ? (base + 0xE2) : 0xB2);
513 	sil_iowrite32(dev, 0x62DD62DD, base ? (base + 0xE4) : 0xB4);
514 	sil_iowrite32(dev, 0x43924392, base ? (base + 0xE8) : 0xB8);
515 	sil_iowrite32(dev, 0x40094009, base ? (base + 0xEC) : 0xBC);
516 
517 	if (base && pdev_is_sata(dev)) {
518 		writel(0xFFFF0000, ioaddr + 0x108);
519 		writel(0xFFFF0000, ioaddr + 0x188);
520 		writel(0x00680000, ioaddr + 0x148);
521 		writel(0x00680000, ioaddr + 0x1C8);
522 	}
523 
524 	/* report the clocking mode of the controller */
525 	if (!pdev_is_sata(dev)) {
526 		static const char *clk_str[] =
527 			{ "== 100", "== 133", "== 2X PCI", "DISABLED!" };
528 
529 		tmp >>= 4;
530 		printk(KERN_INFO DRV_NAME " %s: BASE CLOCK %s\n",
531 			pci_name(dev), clk_str[tmp & 3]);
532 	}
533 
534 	return 0;
535 }
536 
537 /**
538  *	init_mmio_iops_siimage	-	set up the iops for MMIO
539  *	@hwif: interface to set up
540  *
541  *	The basic setup here is fairly simple, we can use standard MMIO
542  *	operations. However we do have to set the taskfile register offsets
543  *	by hand as there isn't a standard defined layout for them this time.
544  *
545  *	The hardware supports buffered taskfiles and also some rather nice
546  *	extended PRD tables. For better SI3112 support use the libata driver
547  */
548 
init_mmio_iops_siimage(ide_hwif_t * hwif)549 static void init_mmio_iops_siimage(ide_hwif_t *hwif)
550 {
551 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
552 	struct ide_host *host	= pci_get_drvdata(dev);
553 	void *addr		= host->host_priv;
554 	u8 ch			= hwif->channel;
555 	struct ide_io_ports *io_ports = &hwif->io_ports;
556 	unsigned long base;
557 
558 	/*
559 	 *	Fill in the basic hwif bits
560 	 */
561 	hwif->host_flags |= IDE_HFLAG_MMIO;
562 
563 	hwif->hwif_data	= addr;
564 
565 	/*
566 	 *	Now set up the hw. We have to do this ourselves as the
567 	 *	MMIO layout isn't the same as the standard port based I/O.
568 	 */
569 	memset(io_ports, 0, sizeof(*io_ports));
570 
571 	base = (unsigned long)addr;
572 	if (ch)
573 		base += 0xC0;
574 	else
575 		base += 0x80;
576 
577 	/*
578 	 *	The buffered task file doesn't have status/control, so we
579 	 *	can't currently use it sanely since we want to use LBA48 mode.
580 	 */
581 	io_ports->data_addr	= base;
582 	io_ports->error_addr	= base + 1;
583 	io_ports->nsect_addr	= base + 2;
584 	io_ports->lbal_addr	= base + 3;
585 	io_ports->lbam_addr	= base + 4;
586 	io_ports->lbah_addr	= base + 5;
587 	io_ports->device_addr	= base + 6;
588 	io_ports->status_addr	= base + 7;
589 	io_ports->ctl_addr	= base + 10;
590 
591 	if (pdev_is_sata(dev)) {
592 		base = (unsigned long)addr;
593 		if (ch)
594 			base += 0x80;
595 		hwif->sata_scr[SATA_STATUS_OFFSET]	= base + 0x104;
596 		hwif->sata_scr[SATA_ERROR_OFFSET]	= base + 0x108;
597 		hwif->sata_scr[SATA_CONTROL_OFFSET]	= base + 0x100;
598 	}
599 
600 	hwif->irq = dev->irq;
601 
602 	hwif->dma_base = (unsigned long)addr + (ch ? 0x08 : 0x00);
603 }
604 
is_dev_seagate_sata(ide_drive_t * drive)605 static int is_dev_seagate_sata(ide_drive_t *drive)
606 {
607 	const char *s	= (const char *)&drive->id[ATA_ID_PROD];
608 	unsigned len	= strnlen(s, ATA_ID_PROD_LEN);
609 
610 	if ((len > 4) && (!memcmp(s, "ST", 2)))
611 		if ((!memcmp(s + len - 2, "AS", 2)) ||
612 		    (!memcmp(s + len - 3, "ASL", 3))) {
613 			printk(KERN_INFO "%s: applying pessimistic Seagate "
614 					 "errata fix\n", drive->name);
615 			return 1;
616 		}
617 
618 	return 0;
619 }
620 
621 /**
622  *	sil_quirkproc		-	post probe fixups
623  *	@drive: drive
624  *
625  *	Called after drive probe we use this to decide whether the
626  *	Seagate fixup must be applied. This used to be in init_iops but
627  *	that can occur before we know what drives are present.
628  */
629 
sil_quirkproc(ide_drive_t * drive)630 static void sil_quirkproc(ide_drive_t *drive)
631 {
632 	ide_hwif_t *hwif = drive->hwif;
633 
634 	/* Try and rise the rqsize */
635 	if (!is_sata(hwif) || !is_dev_seagate_sata(drive))
636 		hwif->rqsize = 128;
637 }
638 
639 /**
640  *	init_iops_siimage	-	set up iops
641  *	@hwif: interface to set up
642  *
643  *	Do the basic setup for the SIIMAGE hardware interface
644  *	and then do the MMIO setup if we can. This is the first
645  *	look in we get for setting up the hwif so that we
646  *	can get the iops right before using them.
647  */
648 
init_iops_siimage(ide_hwif_t * hwif)649 static void init_iops_siimage(ide_hwif_t *hwif)
650 {
651 	struct ide_host *host = dev_get_drvdata(hwif->dev);
652 
653 	hwif->hwif_data = NULL;
654 
655 	/* Pessimal until we finish probing */
656 	hwif->rqsize = 15;
657 
658 	if (host->host_priv)
659 		init_mmio_iops_siimage(hwif);
660 }
661 
662 /**
663  *	sil_cable_detect	-	cable detection
664  *	@hwif: interface to check
665  *
666  *	Check for the presence of an ATA66 capable cable on the interface.
667  */
668 
sil_cable_detect(ide_hwif_t * hwif)669 static u8 sil_cable_detect(ide_hwif_t *hwif)
670 {
671 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
672 	unsigned long addr	= siimage_selreg(hwif, 0);
673 	u8 ata66		= sil_ioread8(dev, addr);
674 
675 	return (ata66 & 0x01) ? ATA_CBL_PATA80 : ATA_CBL_PATA40;
676 }
677 
678 static const struct ide_port_ops sil_pata_port_ops = {
679 	.set_pio_mode		= sil_set_pio_mode,
680 	.set_dma_mode		= sil_set_dma_mode,
681 	.quirkproc		= sil_quirkproc,
682 	.test_irq		= sil_test_irq,
683 	.udma_filter		= sil_pata_udma_filter,
684 	.cable_detect		= sil_cable_detect,
685 };
686 
687 static const struct ide_port_ops sil_sata_port_ops = {
688 	.set_pio_mode		= sil_set_pio_mode,
689 	.set_dma_mode		= sil_set_dma_mode,
690 	.reset_poll		= sil_sata_reset_poll,
691 	.pre_reset		= sil_sata_pre_reset,
692 	.quirkproc		= sil_quirkproc,
693 	.test_irq		= sil_test_irq,
694 	.udma_filter		= sil_sata_udma_filter,
695 	.cable_detect		= sil_cable_detect,
696 };
697 
698 static const struct ide_dma_ops sil_dma_ops = {
699 	.dma_host_set		= ide_dma_host_set,
700 	.dma_setup		= ide_dma_setup,
701 	.dma_start		= ide_dma_start,
702 	.dma_end		= ide_dma_end,
703 	.dma_test_irq		= siimage_dma_test_irq,
704 	.dma_timer_expiry	= ide_dma_sff_timer_expiry,
705 	.dma_lost_irq		= ide_dma_lost_irq,
706 	.dma_sff_read_status	= ide_dma_sff_read_status,
707 };
708 
709 #define DECLARE_SII_DEV(p_ops)				\
710 	{						\
711 		.name		= DRV_NAME,		\
712 		.init_chipset	= init_chipset_siimage,	\
713 		.init_iops	= init_iops_siimage,	\
714 		.port_ops	= p_ops,		\
715 		.dma_ops	= &sil_dma_ops,		\
716 		.pio_mask	= ATA_PIO4,		\
717 		.mwdma_mask	= ATA_MWDMA2,		\
718 		.udma_mask	= ATA_UDMA6,		\
719 	}
720 
721 static const struct ide_port_info siimage_chipsets[] = {
722 	/* 0: SiI680 */  DECLARE_SII_DEV(&sil_pata_port_ops),
723 	/* 1: SiI3112 */ DECLARE_SII_DEV(&sil_sata_port_ops)
724 };
725 
726 /**
727  *	siimage_init_one	-	PCI layer discovery entry
728  *	@dev: PCI device
729  *	@id: ident table entry
730  *
731  *	Called by the PCI code when it finds an SiI680 or SiI3112 controller.
732  *	We then use the IDE PCI generic helper to do most of the work.
733  */
734 
siimage_init_one(struct pci_dev * dev,const struct pci_device_id * id)735 static int siimage_init_one(struct pci_dev *dev, const struct pci_device_id *id)
736 {
737 	void __iomem *ioaddr = NULL;
738 	resource_size_t bar5 = pci_resource_start(dev, 5);
739 	unsigned long barsize = pci_resource_len(dev, 5);
740 	int rc;
741 	struct ide_port_info d;
742 	u8 idx = id->driver_data;
743 	u8 BA5_EN;
744 
745 	d = siimage_chipsets[idx];
746 
747 	if (idx) {
748 		static int first = 1;
749 
750 		if (first) {
751 			printk(KERN_INFO DRV_NAME ": For full SATA support you "
752 				"should use the libata sata_sil module.\n");
753 			first = 0;
754 		}
755 
756 		d.host_flags |= IDE_HFLAG_NO_ATAPI_DMA;
757 	}
758 
759 	rc = pci_enable_device(dev);
760 	if (rc)
761 		return rc;
762 
763 	pci_read_config_byte(dev, 0x8A, &BA5_EN);
764 	if ((BA5_EN & 0x01) || bar5) {
765 		/*
766 		* Drop back to PIO if we can't map the MMIO. Some systems
767 		* seem to get terminally confused in the PCI spaces.
768 		*/
769 		if (!request_mem_region(bar5, barsize, d.name)) {
770 			printk(KERN_WARNING DRV_NAME " %s: MMIO ports not "
771 				"available\n", pci_name(dev));
772 		} else {
773 			ioaddr = pci_ioremap_bar(dev, 5);
774 			if (ioaddr == NULL)
775 				release_mem_region(bar5, barsize);
776 		}
777 	}
778 
779 	rc = ide_pci_init_one(dev, &d, ioaddr);
780 	if (rc) {
781 		if (ioaddr) {
782 			iounmap(ioaddr);
783 			release_mem_region(bar5, barsize);
784 		}
785 		pci_disable_device(dev);
786 	}
787 
788 	return rc;
789 }
790 
siimage_remove(struct pci_dev * dev)791 static void siimage_remove(struct pci_dev *dev)
792 {
793 	struct ide_host *host = pci_get_drvdata(dev);
794 	void __iomem *ioaddr = host->host_priv;
795 
796 	ide_pci_remove(dev);
797 
798 	if (ioaddr) {
799 		resource_size_t bar5 = pci_resource_start(dev, 5);
800 		unsigned long barsize = pci_resource_len(dev, 5);
801 
802 		iounmap(ioaddr);
803 		release_mem_region(bar5, barsize);
804 	}
805 
806 	pci_disable_device(dev);
807 }
808 
809 static const struct pci_device_id siimage_pci_tbl[] = {
810 	{ PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_680),    0 },
811 #ifdef CONFIG_BLK_DEV_IDE_SATA
812 	{ PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_3112),   1 },
813 	{ PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_1210SA), 1 },
814 #endif
815 	{ 0, },
816 };
817 MODULE_DEVICE_TABLE(pci, siimage_pci_tbl);
818 
819 static struct pci_driver siimage_pci_driver = {
820 	.name		= "SiI_IDE",
821 	.id_table	= siimage_pci_tbl,
822 	.probe		= siimage_init_one,
823 	.remove		= siimage_remove,
824 	.suspend	= ide_pci_suspend,
825 	.resume		= ide_pci_resume,
826 };
827 
siimage_ide_init(void)828 static int __init siimage_ide_init(void)
829 {
830 	return ide_pci_register_driver(&siimage_pci_driver);
831 }
832 
siimage_ide_exit(void)833 static void __exit siimage_ide_exit(void)
834 {
835 	pci_unregister_driver(&siimage_pci_driver);
836 }
837 
838 module_init(siimage_ide_init);
839 module_exit(siimage_ide_exit);
840 
841 MODULE_AUTHOR("Andre Hedrick, Alan Cox");
842 MODULE_DESCRIPTION("PCI driver module for SiI IDE");
843 MODULE_LICENSE("GPL");
844