 8776168ca2
			
		
	
	
	8776168ca2
	
	
	
		
			
			Change ->set_dma_mode method parameters to match ->set_dmamode method used in struct ata_port_operations. Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
		
			
				
	
	
		
			330 lines
		
	
	
	
		
			9.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			330 lines
		
	
	
	
		
			9.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 1999-2002	Andre Hedrick <andre@linux-ide.org>
 | |
|  * Copyright (C) 2007		MontaVista Software, Inc. <source@mvista.com>
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/types.h>
 | |
| #include <linux/pci.h>
 | |
| #include <linux/ide.h>
 | |
| #include <linux/init.h>
 | |
| 
 | |
| #include <asm/io.h>
 | |
| 
 | |
| #define DRV_NAME "aec62xx"
 | |
| 
 | |
| struct chipset_bus_clock_list_entry {
 | |
| 	u8 xfer_speed;
 | |
| 	u8 chipset_settings;
 | |
| 	u8 ultra_settings;
 | |
| };
 | |
| 
 | |
| static const struct chipset_bus_clock_list_entry aec6xxx_33_base [] = {
 | |
| 	{	XFER_UDMA_6,	0x31,	0x07	},
 | |
| 	{	XFER_UDMA_5,	0x31,	0x06	},
 | |
| 	{	XFER_UDMA_4,	0x31,	0x05	},
 | |
| 	{	XFER_UDMA_3,	0x31,	0x04	},
 | |
| 	{	XFER_UDMA_2,	0x31,	0x03	},
 | |
| 	{	XFER_UDMA_1,	0x31,	0x02	},
 | |
| 	{	XFER_UDMA_0,	0x31,	0x01	},
 | |
| 
 | |
| 	{	XFER_MW_DMA_2,	0x31,	0x00	},
 | |
| 	{	XFER_MW_DMA_1,	0x31,	0x00	},
 | |
| 	{	XFER_MW_DMA_0,	0x0a,	0x00	},
 | |
| 	{	XFER_PIO_4,	0x31,	0x00	},
 | |
| 	{	XFER_PIO_3,	0x33,	0x00	},
 | |
| 	{	XFER_PIO_2,	0x08,	0x00	},
 | |
| 	{	XFER_PIO_1,	0x0a,	0x00	},
 | |
| 	{	XFER_PIO_0,	0x00,	0x00	},
 | |
| 	{	0,		0x00,	0x00	}
 | |
| };
 | |
| 
 | |
| static const struct chipset_bus_clock_list_entry aec6xxx_34_base [] = {
 | |
| 	{	XFER_UDMA_6,	0x41,	0x06	},
 | |
| 	{	XFER_UDMA_5,	0x41,	0x05	},
 | |
| 	{	XFER_UDMA_4,	0x41,	0x04	},
 | |
| 	{	XFER_UDMA_3,	0x41,	0x03	},
 | |
| 	{	XFER_UDMA_2,	0x41,	0x02	},
 | |
| 	{	XFER_UDMA_1,	0x41,	0x01	},
 | |
| 	{	XFER_UDMA_0,	0x41,	0x01	},
 | |
| 
 | |
| 	{	XFER_MW_DMA_2,	0x41,	0x00	},
 | |
| 	{	XFER_MW_DMA_1,	0x42,	0x00	},
 | |
| 	{	XFER_MW_DMA_0,	0x7a,	0x00	},
 | |
| 	{	XFER_PIO_4,	0x41,	0x00	},
 | |
| 	{	XFER_PIO_3,	0x43,	0x00	},
 | |
| 	{	XFER_PIO_2,	0x78,	0x00	},
 | |
| 	{	XFER_PIO_1,	0x7a,	0x00	},
 | |
| 	{	XFER_PIO_0,	0x70,	0x00	},
 | |
| 	{	0,		0x00,	0x00	}
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * TO DO: active tuning and correction of cards without a bios.
 | |
|  */
 | |
| static u8 pci_bus_clock_list (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)
 | |
| {
 | |
| 	for ( ; chipset_table->xfer_speed ; chipset_table++)
 | |
| 		if (chipset_table->xfer_speed == speed) {
 | |
| 			return chipset_table->chipset_settings;
 | |
| 		}
 | |
| 	return chipset_table->chipset_settings;
 | |
| }
 | |
| 
 | |
| static u8 pci_bus_clock_list_ultra (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)
 | |
| {
 | |
| 	for ( ; chipset_table->xfer_speed ; chipset_table++)
 | |
| 		if (chipset_table->xfer_speed == speed) {
 | |
| 			return chipset_table->ultra_settings;
 | |
| 		}
 | |
| 	return chipset_table->ultra_settings;
 | |
| }
 | |
| 
 | |
| static void aec6210_set_mode(ide_hwif_t *hwif, ide_drive_t *drive)
 | |
| {
 | |
| 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
 | |
| 	struct ide_host *host	= pci_get_drvdata(dev);
 | |
| 	struct chipset_bus_clock_list_entry *bus_clock = host->host_priv;
 | |
| 	u16 d_conf		= 0;
 | |
| 	u8 ultra = 0, ultra_conf = 0;
 | |
| 	u8 tmp0 = 0, tmp1 = 0, tmp2 = 0;
 | |
| 	const u8 speed = drive->dma_mode;
 | |
| 	unsigned long flags;
 | |
| 
 | |
| 	local_irq_save(flags);
 | |
| 	/* 0x40|(2*drive->dn): Active, 0x41|(2*drive->dn): Recovery */
 | |
| 	pci_read_config_word(dev, 0x40|(2*drive->dn), &d_conf);
 | |
| 	tmp0 = pci_bus_clock_list(speed, bus_clock);
 | |
| 	d_conf = ((tmp0 & 0xf0) << 4) | (tmp0 & 0xf);
 | |
| 	pci_write_config_word(dev, 0x40|(2*drive->dn), d_conf);
 | |
| 
 | |
| 	tmp1 = 0x00;
 | |
| 	tmp2 = 0x00;
 | |
| 	pci_read_config_byte(dev, 0x54, &ultra);
 | |
| 	tmp1 = ((0x00 << (2*drive->dn)) | (ultra & ~(3 << (2*drive->dn))));
 | |
| 	ultra_conf = pci_bus_clock_list_ultra(speed, bus_clock);
 | |
| 	tmp2 = ((ultra_conf << (2*drive->dn)) | (tmp1 & ~(3 << (2*drive->dn))));
 | |
| 	pci_write_config_byte(dev, 0x54, tmp2);
 | |
| 	local_irq_restore(flags);
 | |
| }
 | |
| 
 | |
| static void aec6260_set_mode(ide_hwif_t *hwif, ide_drive_t *drive)
 | |
| {
 | |
| 	struct pci_dev *dev	= to_pci_dev(hwif->dev);
 | |
| 	struct ide_host *host	= pci_get_drvdata(dev);
 | |
| 	struct chipset_bus_clock_list_entry *bus_clock = host->host_priv;
 | |
| 	u8 unit			= drive->dn & 1;
 | |
| 	u8 tmp1 = 0, tmp2 = 0;
 | |
| 	u8 ultra = 0, drive_conf = 0, ultra_conf = 0;
 | |
| 	const u8 speed = drive->dma_mode;
 | |
| 	unsigned long flags;
 | |
| 
 | |
| 	local_irq_save(flags);
 | |
| 	/* high 4-bits: Active, low 4-bits: Recovery */
 | |
| 	pci_read_config_byte(dev, 0x40|drive->dn, &drive_conf);
 | |
| 	drive_conf = pci_bus_clock_list(speed, bus_clock);
 | |
| 	pci_write_config_byte(dev, 0x40|drive->dn, drive_conf);
 | |
| 
 | |
| 	pci_read_config_byte(dev, (0x44|hwif->channel), &ultra);
 | |
| 	tmp1 = ((0x00 << (4*unit)) | (ultra & ~(7 << (4*unit))));
 | |
| 	ultra_conf = pci_bus_clock_list_ultra(speed, bus_clock);
 | |
| 	tmp2 = ((ultra_conf << (4*unit)) | (tmp1 & ~(7 << (4*unit))));
 | |
| 	pci_write_config_byte(dev, (0x44|hwif->channel), tmp2);
 | |
| 	local_irq_restore(flags);
 | |
| }
 | |
| 
 | |
| static void aec_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
 | |
| {
 | |
| 	drive->dma_mode = drive->pio_mode;
 | |
| 	hwif->port_ops->set_dma_mode(hwif, drive);
 | |
| }
 | |
| 
 | |
| static int init_chipset_aec62xx(struct pci_dev *dev)
 | |
| {
 | |
| 	/* These are necessary to get AEC6280 Macintosh cards to work */
 | |
| 	if ((dev->device == PCI_DEVICE_ID_ARTOP_ATP865) ||
 | |
| 	    (dev->device == PCI_DEVICE_ID_ARTOP_ATP865R)) {
 | |
| 		u8 reg49h = 0, reg4ah = 0;
 | |
| 		/* Clear reset and test bits.  */
 | |
| 		pci_read_config_byte(dev, 0x49, ®49h);
 | |
| 		pci_write_config_byte(dev, 0x49, reg49h & ~0x30);
 | |
| 		/* Enable chip interrupt output.  */
 | |
| 		pci_read_config_byte(dev, 0x4a, ®4ah);
 | |
| 		pci_write_config_byte(dev, 0x4a, reg4ah & ~0x01);
 | |
| 		/* Enable burst mode. */
 | |
| 		pci_read_config_byte(dev, 0x4a, ®4ah);
 | |
| 		pci_write_config_byte(dev, 0x4a, reg4ah | 0x80);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static u8 atp86x_cable_detect(ide_hwif_t *hwif)
 | |
| {
 | |
| 	struct pci_dev *dev = to_pci_dev(hwif->dev);
 | |
| 	u8 ata66 = 0, mask = hwif->channel ? 0x02 : 0x01;
 | |
| 
 | |
| 	pci_read_config_byte(dev, 0x49, &ata66);
 | |
| 
 | |
| 	return (ata66 & mask) ? ATA_CBL_PATA40 : ATA_CBL_PATA80;
 | |
| }
 | |
| 
 | |
| static const struct ide_port_ops atp850_port_ops = {
 | |
| 	.set_pio_mode		= aec_set_pio_mode,
 | |
| 	.set_dma_mode		= aec6210_set_mode,
 | |
| };
 | |
| 
 | |
| static const struct ide_port_ops atp86x_port_ops = {
 | |
| 	.set_pio_mode		= aec_set_pio_mode,
 | |
| 	.set_dma_mode		= aec6260_set_mode,
 | |
| 	.cable_detect		= atp86x_cable_detect,
 | |
| };
 | |
| 
 | |
| static const struct ide_port_info aec62xx_chipsets[] __devinitdata = {
 | |
| 	{	/* 0: AEC6210 */
 | |
| 		.name		= DRV_NAME,
 | |
| 		.init_chipset	= init_chipset_aec62xx,
 | |
| 		.enablebits	= {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
 | |
| 		.port_ops	= &atp850_port_ops,
 | |
| 		.host_flags	= IDE_HFLAG_SERIALIZE |
 | |
| 				  IDE_HFLAG_NO_ATAPI_DMA |
 | |
| 				  IDE_HFLAG_NO_DSC |
 | |
| 				  IDE_HFLAG_OFF_BOARD,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA2,
 | |
| 	},
 | |
| 	{	/* 1: AEC6260 */
 | |
| 		.name		= DRV_NAME,
 | |
| 		.init_chipset	= init_chipset_aec62xx,
 | |
| 		.port_ops	= &atp86x_port_ops,
 | |
| 		.host_flags	= IDE_HFLAG_NO_ATAPI_DMA | IDE_HFLAG_NO_AUTODMA |
 | |
| 				  IDE_HFLAG_OFF_BOARD,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA4,
 | |
| 	},
 | |
| 	{	/* 2: AEC6260R */
 | |
| 		.name		= DRV_NAME,
 | |
| 		.init_chipset	= init_chipset_aec62xx,
 | |
| 		.enablebits	= {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
 | |
| 		.port_ops	= &atp86x_port_ops,
 | |
| 		.host_flags	= IDE_HFLAG_NO_ATAPI_DMA |
 | |
| 				  IDE_HFLAG_NON_BOOTABLE,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA4,
 | |
| 	},
 | |
| 	{	/* 3: AEC6280 */
 | |
| 		.name		= DRV_NAME,
 | |
| 		.init_chipset	= init_chipset_aec62xx,
 | |
| 		.port_ops	= &atp86x_port_ops,
 | |
| 		.host_flags	= IDE_HFLAG_NO_ATAPI_DMA |
 | |
| 				  IDE_HFLAG_OFF_BOARD,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA5,
 | |
| 	},
 | |
| 	{	/* 4: AEC6280R */
 | |
| 		.name		= DRV_NAME,
 | |
| 		.init_chipset	= init_chipset_aec62xx,
 | |
| 		.enablebits	= {{0x4a,0x02,0x02}, {0x4a,0x04,0x04}},
 | |
| 		.port_ops	= &atp86x_port_ops,
 | |
| 		.host_flags	= IDE_HFLAG_NO_ATAPI_DMA |
 | |
| 				  IDE_HFLAG_OFF_BOARD,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA5,
 | |
| 	}
 | |
| };
 | |
| 
 | |
| /**
 | |
|  *	aec62xx_init_one	-	called when a AEC is found
 | |
|  *	@dev: the aec62xx device
 | |
|  *	@id: the matching pci id
 | |
|  *
 | |
|  *	Called when the PCI registration layer (or the IDE initialization)
 | |
|  *	finds a device matching our IDE device tables.
 | |
|  *
 | |
|  *	NOTE: since we're going to modify the 'name' field for AEC-6[26]80[R]
 | |
|  *	chips, pass a local copy of 'struct ide_port_info' down the call chain.
 | |
|  */
 | |
| 
 | |
| static int __devinit aec62xx_init_one(struct pci_dev *dev, const struct pci_device_id *id)
 | |
| {
 | |
| 	const struct chipset_bus_clock_list_entry *bus_clock;
 | |
| 	struct ide_port_info d;
 | |
| 	u8 idx = id->driver_data;
 | |
| 	int bus_speed = ide_pci_clk ? ide_pci_clk : 33;
 | |
| 	int err;
 | |
| 
 | |
| 	if (bus_speed <= 33)
 | |
| 		bus_clock = aec6xxx_33_base;
 | |
| 	else
 | |
| 		bus_clock = aec6xxx_34_base;
 | |
| 
 | |
| 	err = pci_enable_device(dev);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	d = aec62xx_chipsets[idx];
 | |
| 
 | |
| 	if (idx == 3 || idx == 4) {
 | |
| 		unsigned long dma_base = pci_resource_start(dev, 4);
 | |
| 
 | |
| 		if (inb(dma_base + 2) & 0x10) {
 | |
| 			printk(KERN_INFO DRV_NAME " %s: AEC6880%s card detected"
 | |
| 				"\n", pci_name(dev), (idx == 4) ? "R" : "");
 | |
| 			d.udma_mask = ATA_UDMA6;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	err = ide_pci_init_one(dev, &d, (void *)bus_clock);
 | |
| 	if (err)
 | |
| 		pci_disable_device(dev);
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void __devexit aec62xx_remove(struct pci_dev *dev)
 | |
| {
 | |
| 	ide_pci_remove(dev);
 | |
| 	pci_disable_device(dev);
 | |
| }
 | |
| 
 | |
| static const struct pci_device_id aec62xx_pci_tbl[] = {
 | |
| 	{ PCI_VDEVICE(ARTOP, PCI_DEVICE_ID_ARTOP_ATP850UF), 0 },
 | |
| 	{ PCI_VDEVICE(ARTOP, PCI_DEVICE_ID_ARTOP_ATP860),   1 },
 | |
| 	{ PCI_VDEVICE(ARTOP, PCI_DEVICE_ID_ARTOP_ATP860R),  2 },
 | |
| 	{ PCI_VDEVICE(ARTOP, PCI_DEVICE_ID_ARTOP_ATP865),   3 },
 | |
| 	{ PCI_VDEVICE(ARTOP, PCI_DEVICE_ID_ARTOP_ATP865R),  4 },
 | |
| 	{ 0, },
 | |
| };
 | |
| MODULE_DEVICE_TABLE(pci, aec62xx_pci_tbl);
 | |
| 
 | |
| static struct pci_driver aec62xx_pci_driver = {
 | |
| 	.name		= "AEC62xx_IDE",
 | |
| 	.id_table	= aec62xx_pci_tbl,
 | |
| 	.probe		= aec62xx_init_one,
 | |
| 	.remove		= __devexit_p(aec62xx_remove),
 | |
| 	.suspend	= ide_pci_suspend,
 | |
| 	.resume		= ide_pci_resume,
 | |
| };
 | |
| 
 | |
| static int __init aec62xx_ide_init(void)
 | |
| {
 | |
| 	return ide_pci_register_driver(&aec62xx_pci_driver);
 | |
| }
 | |
| 
 | |
| static void __exit aec62xx_ide_exit(void)
 | |
| {
 | |
| 	pci_unregister_driver(&aec62xx_pci_driver);
 | |
| }
 | |
| 
 | |
| module_init(aec62xx_ide_init);
 | |
| module_exit(aec62xx_ide_exit);
 | |
| 
 | |
| MODULE_AUTHOR("Andre Hedrick");
 | |
| MODULE_DESCRIPTION("PCI driver module for ARTOP AEC62xx IDE");
 | |
| MODULE_LICENSE("GPL");
 |