| /* | 
 |  * linux/drivers/ide/pci/siimage.c		Version 1.12	Mar 10 2007 | 
 |  * | 
 |  * Copyright (C) 2001-2002	Andre Hedrick <andre@linux-ide.org> | 
 |  * Copyright (C) 2003		Red Hat <alan@redhat.com> | 
 |  * Copyright (C) 2007		MontaVista Software, Inc. | 
 |  * | 
 |  *  May be copied or modified under the terms of the GNU General Public License | 
 |  * | 
 |  *  Documentation for CMD680: | 
 |  *  http://gkernel.sourceforge.net/specs/sii/sii-0680a-v1.31.pdf.bz2 | 
 |  * | 
 |  *  Documentation for SiI 3112: | 
 |  *  http://gkernel.sourceforge.net/specs/sii/3112A_SiI-DS-0095-B2.pdf.bz2 | 
 |  * | 
 |  *  Errata and other documentation only available under NDA. | 
 |  * | 
 |  * | 
 |  *  FAQ Items: | 
 |  *	If you are using Marvell SATA-IDE adapters with Maxtor drives | 
 |  *	ensure the system is set up for ATA100/UDMA5 not UDMA6. | 
 |  * | 
 |  *	If you are using WD drives with SATA bridges you must set the | 
 |  *	drive to "Single". "Master" will hang | 
 |  * | 
 |  *	If you have strange problems with nVidia chipset systems please | 
 |  *	see the SI support documentation and update your system BIOS | 
 |  *	if neccessary | 
 |  * | 
 |  *  The Dell DRAC4 has some interesting features including effectively hot | 
 |  *  unplugging/replugging the virtual CD interface when the DRAC is reset. | 
 |  *  This often causes drivers/ide/siimage to panic but is ok with the rather | 
 |  *  smarter code in libata. | 
 |  */ | 
 |  | 
 | #include <linux/types.h> | 
 | #include <linux/module.h> | 
 | #include <linux/pci.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/hdreg.h> | 
 | #include <linux/ide.h> | 
 | #include <linux/init.h> | 
 |  | 
 | #include <asm/io.h> | 
 |  | 
 | /** | 
 |  *	pdev_is_sata		-	check if device is SATA | 
 |  *	@pdev:	PCI device to check | 
 |  *	 | 
 |  *	Returns true if this is a SATA controller | 
 |  */ | 
 |   | 
 | static int pdev_is_sata(struct pci_dev *pdev) | 
 | { | 
 | 	switch(pdev->device) | 
 | 	{ | 
 | 		case PCI_DEVICE_ID_SII_3112: | 
 | 		case PCI_DEVICE_ID_SII_1210SA: | 
 | 			return 1; | 
 | 		case PCI_DEVICE_ID_SII_680: | 
 | 			return 0; | 
 | 	} | 
 | 	BUG(); | 
 | 	return 0; | 
 | } | 
 |   | 
 | /** | 
 |  *	is_sata			-	check if hwif is SATA | 
 |  *	@hwif:	interface to check | 
 |  *	 | 
 |  *	Returns true if this is a SATA controller | 
 |  */ | 
 |   | 
 | static inline int is_sata(ide_hwif_t *hwif) | 
 | { | 
 | 	return pdev_is_sata(hwif->pci_dev); | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_selreg		-	return register base | 
 |  *	@hwif: interface | 
 |  *	@r: config offset | 
 |  * | 
 |  *	Turn a config register offset into the right address in either | 
 |  *	PCI space or MMIO space to access the control register in question | 
 |  *	Thankfully this is a configuration operation so isnt performance | 
 |  *	criticial.  | 
 |  */ | 
 |   | 
 | static unsigned long siimage_selreg(ide_hwif_t *hwif, int r) | 
 | { | 
 | 	unsigned long base = (unsigned long)hwif->hwif_data; | 
 | 	base += 0xA0 + r; | 
 | 	if(hwif->mmio) | 
 | 		base += (hwif->channel << 6); | 
 | 	else | 
 | 		base += (hwif->channel << 4); | 
 | 	return base; | 
 | } | 
 | 	 | 
 | /** | 
 |  *	siimage_seldev		-	return register base | 
 |  *	@hwif: interface | 
 |  *	@r: config offset | 
 |  * | 
 |  *	Turn a config register offset into the right address in either | 
 |  *	PCI space or MMIO space to access the control register in question | 
 |  *	including accounting for the unit shift. | 
 |  */ | 
 |   | 
 | static inline unsigned long siimage_seldev(ide_drive_t *drive, int r) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	unsigned long base = (unsigned long)hwif->hwif_data; | 
 | 	base += 0xA0 + r; | 
 | 	if(hwif->mmio) | 
 | 		base += (hwif->channel << 6); | 
 | 	else | 
 | 		base += (hwif->channel << 4); | 
 | 	base |= drive->select.b.unit << drive->select.b.unit; | 
 | 	return base; | 
 | } | 
 |  | 
 | /** | 
 |  *	sil_udma_filter		-	compute UDMA mask | 
 |  *	@drive: IDE device | 
 |  * | 
 |  *	Compute the available UDMA speeds for the device on the interface. | 
 |  * | 
 |  *	For the CMD680 this depends on the clocking mode (scsc), for the | 
 |  *	SI3112 SATA controller life is a bit simpler. | 
 |  */ | 
 |  | 
 | static u8 sil_udma_filter(ide_drive_t *drive) | 
 | { | 
 | 	ide_hwif_t *hwif = drive->hwif; | 
 | 	unsigned long base = (unsigned long) hwif->hwif_data; | 
 | 	u8 mask = 0, scsc = 0; | 
 |  | 
 | 	if (hwif->mmio) | 
 | 		scsc = hwif->INB(base + 0x4A); | 
 | 	else | 
 | 		pci_read_config_byte(hwif->pci_dev, 0x8A, &scsc); | 
 |  | 
 | 	if (is_sata(hwif)) { | 
 | 		mask = strstr(drive->id->model, "Maxtor") ? 0x3f : 0x7f; | 
 | 		goto out; | 
 | 	} | 
 |  | 
 | 	if ((scsc & 0x30) == 0x10)	/* 133 */ | 
 | 		mask = 0x7f; | 
 | 	else if ((scsc & 0x30) == 0x20)	/* 2xPCI */ | 
 | 		mask = 0x7f; | 
 | 	else if ((scsc & 0x30) == 0x00)	/* 100 */ | 
 | 		mask = 0x3f; | 
 | 	else 	/* Disabled ? */ | 
 | 		BUG(); | 
 | out: | 
 | 	return mask; | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_taskfile_timing	-	turn timing data to a mode | 
 |  *	@hwif: interface to query | 
 |  * | 
 |  *	Read the timing data for the interface and return the  | 
 |  *	mode that is being used. | 
 |  */ | 
 |   | 
 | static byte siimage_taskfile_timing (ide_hwif_t *hwif) | 
 | { | 
 | 	u16 timing	= 0x328a; | 
 | 	unsigned long addr = siimage_selreg(hwif, 2); | 
 |  | 
 | 	if (hwif->mmio) | 
 | 		timing = hwif->INW(addr); | 
 | 	else | 
 | 		pci_read_config_word(hwif->pci_dev, addr, &timing); | 
 |  | 
 | 	switch (timing) { | 
 | 		case 0x10c1:	return 4; | 
 | 		case 0x10c3:	return 3; | 
 | 		case 0x1104: | 
 | 		case 0x1281:	return 2; | 
 | 		case 0x2283:	return 1; | 
 | 		case 0x328a: | 
 | 		default:	return 0; | 
 | 	} | 
 | } | 
 |  | 
 | /** | 
 |  *	simmage_tuneproc	-	tune a drive | 
 |  *	@drive: drive to tune | 
 |  *	@mode_wanted: the target operating mode | 
 |  * | 
 |  *	Load the timing settings for this device mode into the | 
 |  *	controller. If we are in PIO mode 3 or 4 turn on IORDY | 
 |  *	monitoring (bit 9). The TF timing is bits 31:16 | 
 |  */ | 
 |   | 
 | static void siimage_tuneproc (ide_drive_t *drive, byte mode_wanted) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	u32 speedt		= 0; | 
 | 	u16 speedp		= 0; | 
 | 	unsigned long addr	= siimage_seldev(drive, 0x04); | 
 | 	unsigned long tfaddr	= siimage_selreg(hwif, 0x02); | 
 | 	 | 
 | 	/* cheat for now and use the docs */ | 
 | 	switch (mode_wanted) { | 
 | 	case 4: | 
 | 		speedp = 0x10c1; | 
 | 		speedt = 0x10c1; | 
 | 		break; | 
 | 	case 3: | 
 | 		speedp = 0x10c3; | 
 | 		speedt = 0x10c3; | 
 | 		break; | 
 | 	case 2: | 
 | 		speedp = 0x1104; | 
 | 		speedt = 0x1281; | 
 | 		break; | 
 | 	case 1: | 
 | 		speedp = 0x2283; | 
 | 		speedt = 0x2283; | 
 | 		break; | 
 | 	case 0: | 
 | 	default: | 
 | 		speedp = 0x328a; | 
 | 		speedt = 0x328a; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	if (hwif->mmio) { | 
 | 		hwif->OUTW(speedp, addr); | 
 | 		hwif->OUTW(speedt, tfaddr); | 
 | 		/* Now set up IORDY */ | 
 | 		if(mode_wanted == 3 || mode_wanted == 4) | 
 | 			hwif->OUTW(hwif->INW(tfaddr-2)|0x200, tfaddr-2); | 
 | 		else | 
 | 			hwif->OUTW(hwif->INW(tfaddr-2)&~0x200, tfaddr-2); | 
 | 	} else { | 
 | 		pci_write_config_word(hwif->pci_dev, addr, speedp); | 
 | 		pci_write_config_word(hwif->pci_dev, tfaddr, speedt); | 
 | 		pci_read_config_word(hwif->pci_dev, tfaddr-2, &speedp); | 
 | 		speedp &= ~0x200; | 
 | 		/* Set IORDY for mode 3 or 4 */ | 
 | 		if(mode_wanted == 3 || mode_wanted == 4) | 
 | 			speedp |= 0x200; | 
 | 		pci_write_config_word(hwif->pci_dev, tfaddr-2, speedp); | 
 | 	} | 
 | } | 
 |  | 
 | /** | 
 |  *	config_siimage_chipset_for_pio	-	set drive timings | 
 |  *	@drive: drive to tune | 
 |  *	@speed we want | 
 |  * | 
 |  *	Compute the best pio mode we can for a given device. Also honour | 
 |  *	the timings for the driver when dealing with mixed devices. Some | 
 |  *	of this is ugly but its all wrapped up here | 
 |  * | 
 |  *	The SI680 can also do VDMA - we need to start using that | 
 |  * | 
 |  *	FIXME: we use the BIOS channel timings to avoid driving the task | 
 |  *	files too fast at the disk. We need to compute the master/slave | 
 |  *	drive PIO mode properly so that we can up the speed on a hotplug | 
 |  *	system. | 
 |  */ | 
 |   | 
 | static void config_siimage_chipset_for_pio (ide_drive_t *drive, byte set_speed) | 
 | { | 
 | 	u8 channel_timings	= siimage_taskfile_timing(HWIF(drive)); | 
 | 	u8 speed = 0, set_pio	= ide_get_best_pio_mode(drive, 4, 5, NULL); | 
 |  | 
 | 	/* WARNING PIO timing mess is going to happen b/w devices, argh */ | 
 | 	if ((channel_timings != set_pio) && (set_pio > channel_timings)) | 
 | 		set_pio = channel_timings; | 
 |  | 
 | 	siimage_tuneproc(drive, set_pio); | 
 | 	speed = XFER_PIO_0 + set_pio; | 
 | 	if (set_speed) | 
 | 		(void) ide_config_drive_speed(drive, speed); | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_tune_chipset	-	set controller timings | 
 |  *	@drive: Drive to set up | 
 |  *	@xferspeed: speed we want to achieve | 
 |  * | 
 |  *	Tune the SII chipset for the desired mode. If we can't achieve | 
 |  *	the desired mode then tune for a lower one, but ultimately | 
 |  *	make the thing work. | 
 |  */ | 
 |   | 
 | static int siimage_tune_chipset (ide_drive_t *drive, byte xferspeed) | 
 | { | 
 | 	u8 ultra6[]		= { 0x0F, 0x0B, 0x07, 0x05, 0x03, 0x02, 0x01 }; | 
 | 	u8 ultra5[]		= { 0x0C, 0x07, 0x05, 0x04, 0x02, 0x01 }; | 
 | 	u16 dma[]		= { 0x2208, 0x10C2, 0x10C1 }; | 
 |  | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	u16 ultra = 0, multi	= 0; | 
 | 	u8 mode = 0, unit	= drive->select.b.unit; | 
 | 	u8 speed		= ide_rate_filter(drive, xferspeed); | 
 | 	unsigned long base	= (unsigned long)hwif->hwif_data; | 
 | 	u8 scsc = 0, addr_mask	= ((hwif->channel) ? | 
 | 				    ((hwif->mmio) ? 0xF4 : 0x84) : | 
 | 				    ((hwif->mmio) ? 0xB4 : 0x80)); | 
 | 				     | 
 | 	unsigned long ma	= siimage_seldev(drive, 0x08); | 
 | 	unsigned long ua	= siimage_seldev(drive, 0x0C); | 
 |  | 
 | 	if (hwif->mmio) { | 
 | 		scsc = hwif->INB(base + 0x4A); | 
 | 		mode = hwif->INB(base + addr_mask); | 
 | 		multi = hwif->INW(ma); | 
 | 		ultra = hwif->INW(ua); | 
 | 	} else { | 
 | 		pci_read_config_byte(hwif->pci_dev, 0x8A, &scsc); | 
 | 		pci_read_config_byte(hwif->pci_dev, addr_mask, &mode); | 
 | 		pci_read_config_word(hwif->pci_dev, ma, &multi); | 
 | 		pci_read_config_word(hwif->pci_dev, ua, &ultra); | 
 | 	} | 
 |  | 
 | 	mode &= ~((unit) ? 0x30 : 0x03); | 
 | 	ultra &= ~0x3F; | 
 | 	scsc = ((scsc & 0x30) == 0x00) ? 0 : 1; | 
 |  | 
 | 	scsc = is_sata(hwif) ? 1 : scsc; | 
 |  | 
 | 	switch(speed) { | 
 | 		case XFER_PIO_4: | 
 | 		case XFER_PIO_3: | 
 | 		case XFER_PIO_2: | 
 | 		case XFER_PIO_1: | 
 | 		case XFER_PIO_0: | 
 | 			siimage_tuneproc(drive, (speed - XFER_PIO_0)); | 
 | 			mode |= ((unit) ? 0x10 : 0x01); | 
 | 			break; | 
 | 		case XFER_MW_DMA_2: | 
 | 		case XFER_MW_DMA_1: | 
 | 		case XFER_MW_DMA_0: | 
 | 			multi = dma[speed - XFER_MW_DMA_0]; | 
 | 			mode |= ((unit) ? 0x20 : 0x02); | 
 | 			config_siimage_chipset_for_pio(drive, 0); | 
 | 			break; | 
 | 		case XFER_UDMA_6: | 
 | 		case XFER_UDMA_5: | 
 | 		case XFER_UDMA_4: | 
 | 		case XFER_UDMA_3: | 
 | 		case XFER_UDMA_2: | 
 | 		case XFER_UDMA_1: | 
 | 		case XFER_UDMA_0: | 
 | 			multi = dma[2]; | 
 | 			ultra |= ((scsc) ? (ultra6[speed - XFER_UDMA_0]) : | 
 | 					   (ultra5[speed - XFER_UDMA_0])); | 
 | 			mode |= ((unit) ? 0x30 : 0x03); | 
 | 			config_siimage_chipset_for_pio(drive, 0); | 
 | 			break; | 
 | 		default: | 
 | 			return 1; | 
 | 	} | 
 |  | 
 | 	if (hwif->mmio) { | 
 | 		hwif->OUTB(mode, base + addr_mask); | 
 | 		hwif->OUTW(multi, ma); | 
 | 		hwif->OUTW(ultra, ua); | 
 | 	} else { | 
 | 		pci_write_config_byte(hwif->pci_dev, addr_mask, mode); | 
 | 		pci_write_config_word(hwif->pci_dev, ma, multi); | 
 | 		pci_write_config_word(hwif->pci_dev, ua, ultra); | 
 | 	} | 
 | 	return (ide_config_drive_speed(drive, speed)); | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_configure_drive_for_dma	-	set up for DMA transfers | 
 |  *	@drive: drive we are going to set up | 
 |  * | 
 |  *	Set up the drive for DMA, tune the controller and drive as  | 
 |  *	required. If the drive isn't suitable for DMA or we hit | 
 |  *	other problems then we will drop down to PIO and set up | 
 |  *	PIO appropriately | 
 |  */ | 
 |   | 
 | static int siimage_config_drive_for_dma (ide_drive_t *drive) | 
 | { | 
 | 	if (ide_tune_dma(drive)) | 
 | 		return 0; | 
 |  | 
 | 	if (ide_use_fast_pio(drive)) | 
 | 		config_siimage_chipset_for_pio(drive, 1); | 
 |  | 
 | 	return -1; | 
 | } | 
 |  | 
 | /* returns 1 if dma irq issued, 0 otherwise */ | 
 | static int siimage_io_ide_dma_test_irq (ide_drive_t *drive) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	u8 dma_altstat		= 0; | 
 | 	unsigned long addr	= siimage_selreg(hwif, 1); | 
 |  | 
 | 	/* return 1 if INTR asserted */ | 
 | 	if ((hwif->INB(hwif->dma_status) & 4) == 4) | 
 | 		return 1; | 
 |  | 
 | 	/* return 1 if Device INTR asserted */ | 
 | 	pci_read_config_byte(hwif->pci_dev, addr, &dma_altstat); | 
 | 	if (dma_altstat & 8) | 
 | 		return 0;	//return 1; | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_mmio_ide_dma_test_irq	-	check we caused an IRQ | 
 |  *	@drive: drive we are testing | 
 |  * | 
 |  *	Check if we caused an IDE DMA interrupt. We may also have caused | 
 |  *	SATA status interrupts, if so we clean them up and continue. | 
 |  */ | 
 |   | 
 | static int siimage_mmio_ide_dma_test_irq (ide_drive_t *drive) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	unsigned long base	= (unsigned long)hwif->hwif_data; | 
 | 	unsigned long addr	= siimage_selreg(hwif, 0x1); | 
 |  | 
 | 	if (SATA_ERROR_REG) { | 
 | 		u32 ext_stat = readl((void __iomem *)(base + 0x10)); | 
 | 		u8 watchdog = 0; | 
 | 		if (ext_stat & ((hwif->channel) ? 0x40 : 0x10)) { | 
 | 			u32 sata_error = readl((void __iomem *)SATA_ERROR_REG); | 
 | 			writel(sata_error, (void __iomem *)SATA_ERROR_REG); | 
 | 			watchdog = (sata_error & 0x00680000) ? 1 : 0; | 
 | 			printk(KERN_WARNING "%s: sata_error = 0x%08x, " | 
 | 				"watchdog = %d, %s\n", | 
 | 				drive->name, sata_error, watchdog, | 
 | 				__FUNCTION__); | 
 |  | 
 | 		} else { | 
 | 			watchdog = (ext_stat & 0x8000) ? 1 : 0; | 
 | 		} | 
 | 		ext_stat >>= 16; | 
 |  | 
 | 		if (!(ext_stat & 0x0404) && !watchdog) | 
 | 			return 0; | 
 | 	} | 
 |  | 
 | 	/* return 1 if INTR asserted */ | 
 | 	if ((readb((void __iomem *)hwif->dma_status) & 0x04) == 0x04) | 
 | 		return 1; | 
 |  | 
 | 	/* return 1 if Device INTR asserted */ | 
 | 	if ((readb((void __iomem *)addr) & 8) == 8) | 
 | 		return 0;	//return 1; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_busproc		-	bus isolation ioctl | 
 |  *	@drive: drive to isolate/restore | 
 |  *	@state: bus state to set | 
 |  * | 
 |  *	Used by the SII3112 to handle bus isolation. As this is a  | 
 |  *	SATA controller the work required is quite limited, we  | 
 |  *	just have to clean up the statistics | 
 |  */ | 
 |   | 
 | static int siimage_busproc (ide_drive_t * drive, int state) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	u32 stat_config		= 0; | 
 | 	unsigned long addr	= siimage_selreg(hwif, 0); | 
 |  | 
 | 	if (hwif->mmio) | 
 | 		stat_config = readl((void __iomem *)addr); | 
 | 	else | 
 | 		pci_read_config_dword(hwif->pci_dev, addr, &stat_config); | 
 |  | 
 | 	switch (state) { | 
 | 		case BUSSTATE_ON: | 
 | 			hwif->drives[0].failures = 0; | 
 | 			hwif->drives[1].failures = 0; | 
 | 			break; | 
 | 		case BUSSTATE_OFF: | 
 | 			hwif->drives[0].failures = hwif->drives[0].max_failures + 1; | 
 | 			hwif->drives[1].failures = hwif->drives[1].max_failures + 1; | 
 | 			break; | 
 | 		case BUSSTATE_TRISTATE: | 
 | 			hwif->drives[0].failures = hwif->drives[0].max_failures + 1; | 
 | 			hwif->drives[1].failures = hwif->drives[1].max_failures + 1; | 
 | 			break; | 
 | 		default: | 
 | 			return -EINVAL; | 
 | 	} | 
 | 	hwif->bus_state = state; | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_reset_poll	-	wait for sata reset | 
 |  *	@drive: drive we are resetting | 
 |  * | 
 |  *	Poll the SATA phy and see whether it has come back from the dead | 
 |  *	yet. | 
 |  */ | 
 |   | 
 | static int siimage_reset_poll (ide_drive_t *drive) | 
 | { | 
 | 	if (SATA_STATUS_REG) { | 
 | 		ide_hwif_t *hwif	= HWIF(drive); | 
 |  | 
 | 		/* SATA_STATUS_REG is valid only when in MMIO mode */ | 
 | 		if ((readl((void __iomem *)SATA_STATUS_REG) & 0x03) != 0x03) { | 
 | 			printk(KERN_WARNING "%s: reset phy dead, status=0x%08x\n", | 
 | 				hwif->name, readl((void __iomem *)SATA_STATUS_REG)); | 
 | 			HWGROUP(drive)->polling = 0; | 
 | 			return ide_started; | 
 | 		} | 
 | 		return 0; | 
 | 	} else { | 
 | 		return 0; | 
 | 	} | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_pre_reset	-	reset hook | 
 |  *	@drive: IDE device being reset | 
 |  * | 
 |  *	For the SATA devices we need to handle recalibration/geometry | 
 |  *	differently | 
 |  */ | 
 |   | 
 | static void siimage_pre_reset (ide_drive_t *drive) | 
 | { | 
 | 	if (drive->media != ide_disk) | 
 | 		return; | 
 |  | 
 | 	if (is_sata(HWIF(drive))) | 
 | 	{ | 
 | 		drive->special.b.set_geometry = 0; | 
 | 		drive->special.b.recalibrate = 0; | 
 | 	} | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_reset	-	reset a device on an siimage controller | 
 |  *	@drive: drive to reset | 
 |  * | 
 |  *	Perform a controller level reset fo the device. For | 
 |  *	SATA we must also check the PHY. | 
 |  */ | 
 |   | 
 | static void siimage_reset (ide_drive_t *drive) | 
 | { | 
 | 	ide_hwif_t *hwif	= HWIF(drive); | 
 | 	u8 reset		= 0; | 
 | 	unsigned long addr	= siimage_selreg(hwif, 0); | 
 |  | 
 | 	if (hwif->mmio) { | 
 | 		reset = hwif->INB(addr); | 
 | 		hwif->OUTB((reset|0x03), addr); | 
 | 		/* FIXME:posting */ | 
 | 		udelay(25); | 
 | 		hwif->OUTB(reset, addr); | 
 | 		(void) hwif->INB(addr); | 
 | 	} else { | 
 | 		pci_read_config_byte(hwif->pci_dev, addr, &reset); | 
 | 		pci_write_config_byte(hwif->pci_dev, addr, reset|0x03); | 
 | 		udelay(25); | 
 | 		pci_write_config_byte(hwif->pci_dev, addr, reset); | 
 | 		pci_read_config_byte(hwif->pci_dev, addr, &reset); | 
 | 	} | 
 |  | 
 | 	if (SATA_STATUS_REG) { | 
 | 		/* SATA_STATUS_REG is valid only when in MMIO mode */ | 
 | 		u32 sata_stat = readl((void __iomem *)SATA_STATUS_REG); | 
 | 		printk(KERN_WARNING "%s: reset phy, status=0x%08x, %s\n", | 
 | 			hwif->name, sata_stat, __FUNCTION__); | 
 | 		if (!(sata_stat)) { | 
 | 			printk(KERN_WARNING "%s: reset phy dead, status=0x%08x\n", | 
 | 				hwif->name, sata_stat); | 
 | 			drive->failures++; | 
 | 		} | 
 | 	} | 
 |  | 
 | } | 
 |  | 
 | /** | 
 |  *	proc_reports_siimage		-	add siimage controller to proc | 
 |  *	@dev: PCI device | 
 |  *	@clocking: SCSC value | 
 |  *	@name: controller name | 
 |  * | 
 |  *	Report the clocking mode of the controller and add it to | 
 |  *	the /proc interface layer | 
 |  */ | 
 |   | 
 | static void proc_reports_siimage (struct pci_dev *dev, u8 clocking, const char *name) | 
 | { | 
 | 	if (!pdev_is_sata(dev)) { | 
 | 		printk(KERN_INFO "%s: BASE CLOCK ", name); | 
 | 		clocking &= 0x03; | 
 | 		switch (clocking) { | 
 | 			case 0x03: printk("DISABLED!\n"); break; | 
 | 			case 0x02: printk("== 2X PCI\n"); break; | 
 | 			case 0x01: printk("== 133\n"); break; | 
 | 			case 0x00: printk("== 100\n"); break; | 
 | 		} | 
 | 	} | 
 | } | 
 |  | 
 | /** | 
 |  *	setup_mmio_siimage	-	switch an SI controller into MMIO | 
 |  *	@dev: PCI device we are configuring | 
 |  *	@name: device name | 
 |  * | 
 |  *	Attempt to put the device into mmio mode. There are some slight | 
 |  *	complications here with certain systems where the mmio bar isnt | 
 |  *	mapped so we have to be sure we can fall back to I/O. | 
 |  */ | 
 |   | 
 | static unsigned int setup_mmio_siimage (struct pci_dev *dev, const char *name) | 
 | { | 
 | 	unsigned long bar5	= pci_resource_start(dev, 5); | 
 | 	unsigned long barsize	= pci_resource_len(dev, 5); | 
 | 	u8 tmpbyte	= 0; | 
 | 	void __iomem *ioaddr; | 
 | 	u32 tmp, irq_mask; | 
 |  | 
 | 	/* | 
 | 	 *	Drop back to PIO if we can't map the mmio. Some | 
 | 	 *	systems seem to get terminally confused in the PCI | 
 | 	 *	spaces. | 
 | 	 */ | 
 | 	  | 
 | 	if(!request_mem_region(bar5, barsize, name)) | 
 | 	{ | 
 | 		printk(KERN_WARNING "siimage: IDE controller MMIO ports not available.\n"); | 
 | 		return 0; | 
 | 	} | 
 | 		 | 
 | 	ioaddr = ioremap(bar5, barsize); | 
 |  | 
 | 	if (ioaddr == NULL) | 
 | 	{ | 
 | 		release_mem_region(bar5, barsize); | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	pci_set_master(dev); | 
 | 	pci_set_drvdata(dev, (void *) ioaddr); | 
 |  | 
 | 	if (pdev_is_sata(dev)) { | 
 | 		/* make sure IDE0/1 interrupts are not masked */ | 
 | 		irq_mask = (1 << 22) | (1 << 23); | 
 | 		tmp = readl(ioaddr + 0x48); | 
 | 		if (tmp & irq_mask) { | 
 | 			tmp &= ~irq_mask; | 
 | 			writel(tmp, ioaddr + 0x48); | 
 | 			readl(ioaddr + 0x48); /* flush */ | 
 | 		} | 
 | 		writel(0, ioaddr + 0x148); | 
 | 		writel(0, ioaddr + 0x1C8); | 
 | 	} | 
 |  | 
 | 	writeb(0, ioaddr + 0xB4); | 
 | 	writeb(0, ioaddr + 0xF4); | 
 | 	tmpbyte = readb(ioaddr + 0x4A); | 
 |  | 
 | 	switch(tmpbyte & 0x30) { | 
 | 		case 0x00: | 
 | 			/* In 100 MHz clocking, try and switch to 133 */ | 
 | 			writeb(tmpbyte|0x10, ioaddr + 0x4A); | 
 | 			break; | 
 | 		case 0x10: | 
 | 			/* On 133Mhz clocking */ | 
 | 			break; | 
 | 		case 0x20: | 
 | 			/* On PCIx2 clocking */ | 
 | 			break; | 
 | 		case 0x30: | 
 | 			/* Clocking is disabled */ | 
 | 			/* 133 clock attempt to force it on */ | 
 | 			writeb(tmpbyte & ~0x20, ioaddr + 0x4A); | 
 | 			break; | 
 | 	} | 
 | 	 | 
 | 	writeb(      0x72, ioaddr + 0xA1); | 
 | 	writew(    0x328A, ioaddr + 0xA2); | 
 | 	writel(0x62DD62DD, ioaddr + 0xA4); | 
 | 	writel(0x43924392, ioaddr + 0xA8); | 
 | 	writel(0x40094009, ioaddr + 0xAC); | 
 | 	writeb(      0x72, ioaddr + 0xE1); | 
 | 	writew(    0x328A, ioaddr + 0xE2); | 
 | 	writel(0x62DD62DD, ioaddr + 0xE4); | 
 | 	writel(0x43924392, ioaddr + 0xE8); | 
 | 	writel(0x40094009, ioaddr + 0xEC); | 
 |  | 
 | 	if (pdev_is_sata(dev)) { | 
 | 		writel(0xFFFF0000, ioaddr + 0x108); | 
 | 		writel(0xFFFF0000, ioaddr + 0x188); | 
 | 		writel(0x00680000, ioaddr + 0x148); | 
 | 		writel(0x00680000, ioaddr + 0x1C8); | 
 | 	} | 
 |  | 
 | 	tmpbyte = readb(ioaddr + 0x4A); | 
 |  | 
 | 	proc_reports_siimage(dev, (tmpbyte>>4), name); | 
 | 	return 1; | 
 | } | 
 |  | 
 | /** | 
 |  *	init_chipset_siimage	-	set up an SI device | 
 |  *	@dev: PCI device | 
 |  *	@name: device name | 
 |  * | 
 |  *	Perform the initial PCI set up for this device. Attempt to switch | 
 |  *	to 133MHz clocking if the system isn't already set up to do it. | 
 |  */ | 
 |  | 
 | static unsigned int __devinit init_chipset_siimage(struct pci_dev *dev, const char *name) | 
 | { | 
 | 	u32 class_rev	= 0; | 
 | 	u8 tmpbyte	= 0; | 
 | 	u8 BA5_EN	= 0; | 
 |  | 
 |         pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev); | 
 |         class_rev &= 0xff; | 
 | 	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, (class_rev) ? 1 : 255);	 | 
 |  | 
 | 	pci_read_config_byte(dev, 0x8A, &BA5_EN); | 
 | 	if ((BA5_EN & 0x01) || (pci_resource_start(dev, 5))) { | 
 | 		if (setup_mmio_siimage(dev, name)) { | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	pci_write_config_byte(dev, 0x80, 0x00); | 
 | 	pci_write_config_byte(dev, 0x84, 0x00); | 
 | 	pci_read_config_byte(dev, 0x8A, &tmpbyte); | 
 | 	switch(tmpbyte & 0x30) { | 
 | 		case 0x00: | 
 | 			/* 133 clock attempt to force it on */ | 
 | 			pci_write_config_byte(dev, 0x8A, tmpbyte|0x10); | 
 | 		case 0x30: | 
 | 			/* if clocking is disabled */ | 
 | 			/* 133 clock attempt to force it on */ | 
 | 			pci_write_config_byte(dev, 0x8A, tmpbyte & ~0x20); | 
 | 		case 0x10: | 
 | 			/* 133 already */ | 
 | 			break; | 
 | 		case 0x20: | 
 | 			/* BIOS set PCI x2 clocking */ | 
 | 			break; | 
 | 	} | 
 |  | 
 | 	pci_read_config_byte(dev,   0x8A, &tmpbyte); | 
 |  | 
 | 	pci_write_config_byte(dev,  0xA1, 0x72); | 
 | 	pci_write_config_word(dev,  0xA2, 0x328A); | 
 | 	pci_write_config_dword(dev, 0xA4, 0x62DD62DD); | 
 | 	pci_write_config_dword(dev, 0xA8, 0x43924392); | 
 | 	pci_write_config_dword(dev, 0xAC, 0x40094009); | 
 | 	pci_write_config_byte(dev,  0xB1, 0x72); | 
 | 	pci_write_config_word(dev,  0xB2, 0x328A); | 
 | 	pci_write_config_dword(dev, 0xB4, 0x62DD62DD); | 
 | 	pci_write_config_dword(dev, 0xB8, 0x43924392); | 
 | 	pci_write_config_dword(dev, 0xBC, 0x40094009); | 
 |  | 
 | 	proc_reports_siimage(dev, (tmpbyte>>4), name); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	init_mmio_iops_siimage	-	set up the iops for MMIO | 
 |  *	@hwif: interface to set up | 
 |  * | 
 |  *	The basic setup here is fairly simple, we can use standard MMIO | 
 |  *	operations. However we do have to set the taskfile register offsets | 
 |  *	by hand as there isnt a standard defined layout for them this | 
 |  *	time. | 
 |  * | 
 |  *	The hardware supports buffered taskfiles and also some rather nice | 
 |  *	extended PRD tables. For better SI3112 support use the libata driver | 
 |  */ | 
 |  | 
 | static void __devinit init_mmio_iops_siimage(ide_hwif_t *hwif) | 
 | { | 
 | 	struct pci_dev *dev	= hwif->pci_dev; | 
 | 	void *addr		= pci_get_drvdata(dev); | 
 | 	u8 ch			= hwif->channel; | 
 | 	hw_regs_t		hw; | 
 | 	unsigned long		base; | 
 |  | 
 | 	/* | 
 | 	 *	Fill in the basic HWIF bits | 
 | 	 */ | 
 |  | 
 | 	default_hwif_mmiops(hwif); | 
 | 	hwif->hwif_data			= addr; | 
 |  | 
 | 	/* | 
 | 	 *	Now set up the hw. We have to do this ourselves as | 
 | 	 *	the MMIO layout isnt the same as the standard port | 
 | 	 *	based I/O | 
 | 	 */ | 
 |  | 
 | 	memset(&hw, 0, sizeof(hw_regs_t)); | 
 |  | 
 | 	base = (unsigned long)addr; | 
 | 	if (ch) | 
 | 		base += 0xC0; | 
 | 	else | 
 | 		base += 0x80; | 
 |  | 
 | 	/* | 
 | 	 *	The buffered task file doesn't have status/control | 
 | 	 *	so we can't currently use it sanely since we want to | 
 | 	 *	use LBA48 mode. | 
 | 	 */	 | 
 | 	hw.io_ports[IDE_DATA_OFFSET]	= base; | 
 | 	hw.io_ports[IDE_ERROR_OFFSET]	= base + 1; | 
 | 	hw.io_ports[IDE_NSECTOR_OFFSET]	= base + 2; | 
 | 	hw.io_ports[IDE_SECTOR_OFFSET]	= base + 3; | 
 | 	hw.io_ports[IDE_LCYL_OFFSET]	= base + 4; | 
 | 	hw.io_ports[IDE_HCYL_OFFSET]	= base + 5; | 
 | 	hw.io_ports[IDE_SELECT_OFFSET]	= base + 6; | 
 | 	hw.io_ports[IDE_STATUS_OFFSET]	= base + 7; | 
 | 	hw.io_ports[IDE_CONTROL_OFFSET]	= base + 10; | 
 |  | 
 | 	hw.io_ports[IDE_IRQ_OFFSET]	= 0; | 
 |  | 
 | 	if (pdev_is_sata(dev)) { | 
 | 		base = (unsigned long)addr; | 
 | 		if (ch) | 
 | 			base += 0x80; | 
 | 		hwif->sata_scr[SATA_STATUS_OFFSET]	= base + 0x104; | 
 | 		hwif->sata_scr[SATA_ERROR_OFFSET]	= base + 0x108; | 
 | 		hwif->sata_scr[SATA_CONTROL_OFFSET]	= base + 0x100; | 
 | 		hwif->sata_misc[SATA_MISC_OFFSET]	= base + 0x140; | 
 | 		hwif->sata_misc[SATA_PHY_OFFSET]	= base + 0x144; | 
 | 		hwif->sata_misc[SATA_IEN_OFFSET]	= base + 0x148; | 
 | 	} | 
 |  | 
 | 	hw.irq				= hwif->pci_dev->irq; | 
 |  | 
 | 	memcpy(&hwif->hw, &hw, sizeof(hw)); | 
 | 	memcpy(hwif->io_ports, hwif->hw.io_ports, sizeof(hwif->hw.io_ports)); | 
 |  | 
 | 	hwif->irq			= hw.irq; | 
 |  | 
 |        	base = (unsigned long) addr; | 
 |  | 
 | 	hwif->dma_base			= base + (ch ? 0x08 : 0x00); | 
 |  | 
 | 	hwif->mmio = 1; | 
 | } | 
 |  | 
 | static int is_dev_seagate_sata(ide_drive_t *drive) | 
 | { | 
 | 	const char *s = &drive->id->model[0]; | 
 | 	unsigned len; | 
 |  | 
 | 	if (!drive->present) | 
 | 		return 0; | 
 |  | 
 | 	len = strnlen(s, sizeof(drive->id->model)); | 
 |  | 
 | 	if ((len > 4) && (!memcmp(s, "ST", 2))) { | 
 | 		if ((!memcmp(s + len - 2, "AS", 2)) || | 
 | 		    (!memcmp(s + len - 3, "ASL", 3))) { | 
 | 			printk(KERN_INFO "%s: applying pessimistic Seagate " | 
 | 					 "errata fix\n", drive->name); | 
 | 			return 1; | 
 | 		} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	siimage_fixup		-	post probe fixups | 
 |  *	@hwif: interface to fix up | 
 |  * | 
 |  *	Called after drive probe we use this to decide whether the | 
 |  *	Seagate fixup must be applied. This used to be in init_iops but | 
 |  *	that can occur before we know what drives are present. | 
 |  */ | 
 |  | 
 | static void __devinit siimage_fixup(ide_hwif_t *hwif) | 
 | { | 
 | 	/* Try and raise the rqsize */ | 
 | 	if (!is_sata(hwif) || !is_dev_seagate_sata(&hwif->drives[0])) | 
 | 		hwif->rqsize = 128; | 
 | } | 
 |  | 
 | /** | 
 |  *	init_iops_siimage	-	set up iops | 
 |  *	@hwif: interface to set up | 
 |  * | 
 |  *	Do the basic setup for the SIIMAGE hardware interface | 
 |  *	and then do the MMIO setup if we can. This is the first | 
 |  *	look in we get for setting up the hwif so that we | 
 |  *	can get the iops right before using them. | 
 |  */ | 
 |  | 
 | static void __devinit init_iops_siimage(ide_hwif_t *hwif) | 
 | { | 
 | 	struct pci_dev *dev	= hwif->pci_dev; | 
 | 	u32 class_rev		= 0; | 
 |  | 
 | 	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev); | 
 | 	class_rev &= 0xff; | 
 | 	 | 
 | 	hwif->hwif_data = NULL; | 
 |  | 
 | 	/* Pessimal until we finish probing */ | 
 | 	hwif->rqsize = 15; | 
 |  | 
 | 	if (pci_get_drvdata(dev) == NULL) | 
 | 		return; | 
 | 	init_mmio_iops_siimage(hwif); | 
 | } | 
 |  | 
 | /** | 
 |  *	ata66_siimage	-	check for 80 pin cable | 
 |  *	@hwif: interface to check | 
 |  * | 
 |  *	Check for the presence of an ATA66 capable cable on the | 
 |  *	interface. | 
 |  */ | 
 |  | 
 | static unsigned int __devinit ata66_siimage(ide_hwif_t *hwif) | 
 | { | 
 | 	unsigned long addr = siimage_selreg(hwif, 0); | 
 | 	if (pci_get_drvdata(hwif->pci_dev) == NULL) { | 
 | 		u8 ata66 = 0; | 
 | 		pci_read_config_byte(hwif->pci_dev, addr, &ata66); | 
 | 		return (ata66 & 0x01) ? 1 : 0; | 
 | 	} | 
 |  | 
 | 	return (hwif->INB(addr) & 0x01) ? 1 : 0; | 
 | } | 
 |  | 
 | /** | 
 |  *	init_hwif_siimage	-	set up hwif structs | 
 |  *	@hwif: interface to set up | 
 |  * | 
 |  *	We do the basic set up of the interface structure. The SIIMAGE | 
 |  *	requires several custom handlers so we override the default | 
 |  *	ide DMA handlers appropriately | 
 |  */ | 
 |  | 
 | static void __devinit init_hwif_siimage(ide_hwif_t *hwif) | 
 | { | 
 | 	hwif->autodma = 0; | 
 | 	 | 
 | 	hwif->resetproc = &siimage_reset; | 
 | 	hwif->speedproc = &siimage_tune_chipset; | 
 | 	hwif->tuneproc	= &siimage_tuneproc; | 
 | 	hwif->reset_poll = &siimage_reset_poll; | 
 | 	hwif->pre_reset = &siimage_pre_reset; | 
 | 	hwif->udma_filter = &sil_udma_filter; | 
 |  | 
 | 	if(is_sata(hwif)) { | 
 | 		static int first = 1; | 
 |  | 
 | 		hwif->busproc   = &siimage_busproc; | 
 |  | 
 | 		if (first) { | 
 | 			printk(KERN_INFO "siimage: For full SATA support you should use the libata sata_sil module.\n"); | 
 | 			first = 0; | 
 | 		} | 
 | 	} | 
 | 	if (!hwif->dma_base) { | 
 | 		hwif->drives[0].autotune = 1; | 
 | 		hwif->drives[1].autotune = 1; | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	hwif->ultra_mask = 0x7f; | 
 | 	hwif->mwdma_mask = 0x07; | 
 |  | 
 | 	if (!is_sata(hwif)) | 
 | 		hwif->atapi_dma = 1; | 
 |  | 
 | 	hwif->ide_dma_check = &siimage_config_drive_for_dma; | 
 | 	if (!(hwif->udma_four)) | 
 | 		hwif->udma_four = ata66_siimage(hwif); | 
 |  | 
 | 	if (hwif->mmio) { | 
 | 		hwif->ide_dma_test_irq = &siimage_mmio_ide_dma_test_irq; | 
 | 	} else { | 
 | 		hwif->ide_dma_test_irq = & siimage_io_ide_dma_test_irq; | 
 | 	} | 
 | 	 | 
 | 	/* | 
 | 	 *	The BIOS often doesn't set up DMA on this controller | 
 | 	 *	so we always do it. | 
 | 	 */ | 
 |  | 
 | 	hwif->autodma = 1; | 
 | 	hwif->drives[0].autodma = hwif->autodma; | 
 | 	hwif->drives[1].autodma = hwif->autodma; | 
 | } | 
 |  | 
 | #define DECLARE_SII_DEV(name_str)			\ | 
 | 	{						\ | 
 | 		.name		= name_str,		\ | 
 | 		.init_chipset	= init_chipset_siimage,	\ | 
 | 		.init_iops	= init_iops_siimage,	\ | 
 | 		.init_hwif	= init_hwif_siimage,	\ | 
 | 		.fixup		= siimage_fixup,	\ | 
 | 		.channels	= 2,			\ | 
 | 		.autodma	= AUTODMA,		\ | 
 | 		.bootable	= ON_BOARD,		\ | 
 | 	} | 
 |  | 
 | static ide_pci_device_t siimage_chipsets[] __devinitdata = { | 
 | 	/* 0 */ DECLARE_SII_DEV("SiI680"), | 
 | 	/* 1 */ DECLARE_SII_DEV("SiI3112 Serial ATA"), | 
 | 	/* 2 */ DECLARE_SII_DEV("Adaptec AAR-1210SA") | 
 | }; | 
 |  | 
 | /** | 
 |  *	siimage_init_one	-	pci layer discovery entry | 
 |  *	@dev: PCI device | 
 |  *	@id: ident table entry | 
 |  * | 
 |  *	Called by the PCI code when it finds an SI680 or SI3112 controller. | 
 |  *	We then use the IDE PCI generic helper to do most of the work. | 
 |  */ | 
 |   | 
 | static int __devinit siimage_init_one(struct pci_dev *dev, const struct pci_device_id *id) | 
 | { | 
 | 	return ide_setup_pci_device(dev, &siimage_chipsets[id->driver_data]); | 
 | } | 
 |  | 
 | static struct pci_device_id siimage_pci_tbl[] = { | 
 | 	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_SII_680,  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, | 
 | #ifdef CONFIG_BLK_DEV_IDE_SATA | 
 | 	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_SII_3112, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1}, | 
 | 	{ PCI_VENDOR_ID_CMD, PCI_DEVICE_ID_SII_1210SA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2}, | 
 | #endif | 
 | 	{ 0, }, | 
 | }; | 
 | MODULE_DEVICE_TABLE(pci, siimage_pci_tbl); | 
 |  | 
 | static struct pci_driver driver = { | 
 | 	.name		= "SiI_IDE", | 
 | 	.id_table	= siimage_pci_tbl, | 
 | 	.probe		= siimage_init_one, | 
 | }; | 
 |  | 
 | static int __init siimage_ide_init(void) | 
 | { | 
 | 	return ide_pci_register_driver(&driver); | 
 | } | 
 |  | 
 | module_init(siimage_ide_init); | 
 |  | 
 | MODULE_AUTHOR("Andre Hedrick, Alan Cox"); | 
 | MODULE_DESCRIPTION("PCI driver module for SiI IDE"); | 
 | MODULE_LICENSE("GPL"); |