ata_piix.c

来自「Linux Kernel 2.6.9 for OMAP1710」· C语言 代码 · 共 669 行 · 第 1/2 页

C
669
字号
/*    ata_piix.c - Intel PATA/SATA controllers    Maintained by:  Jeff Garzik <jgarzik@pobox.com>    		    Please ALWAYS copy linux-ide@vger.kernel.org		    on emails.	Copyright 2003-2004 Red Hat Inc	Copyright 2003-2004 Jeff Garzik	Copyright header from piix.c:    Copyright (C) 1998-1999 Andrzej Krzysztofowicz, Author and Maintainer    Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>    Copyright (C) 2003 Red Hat Inc <alan@redhat.com>    May be copied or modified under the terms of the GNU General Public License */#include <linux/kernel.h>#include <linux/module.h>#include <linux/pci.h>#include <linux/init.h>#include <linux/blkdev.h>#include <linux/delay.h>#include "scsi.h"#include <scsi/scsi_host.h>#include <linux/libata.h>#define DRV_NAME	"ata_piix"#define DRV_VERSION	"1.02"enum {	PIIX_IOCFG		= 0x54, /* IDE I/O configuration register */	ICH5_PMR		= 0x90, /* port mapping register */	ICH5_PCS		= 0x92,	/* port control and status */	PIIX_FLAG_AHCI		= (1 << 28), /* AHCI possible */	PIIX_FLAG_CHECKINTR	= (1 << 29), /* make sure PCI INTx enabled */	PIIX_FLAG_COMBINED	= (1 << 30), /* combined mode possible */	/* combined mode.  if set, PATA is channel 0.	 * if clear, PATA is channel 1.	 */	PIIX_COMB_PATA_P0	= (1 << 1),	PIIX_COMB		= (1 << 2), /* combined mode enabled? */	PIIX_PORT_PRESENT	= (1 << 0),	PIIX_PORT_ENABLED	= (1 << 4),	PIIX_80C_PRI		= (1 << 5) | (1 << 4),	PIIX_80C_SEC		= (1 << 7) | (1 << 6),	ich5_pata		= 0,	ich5_sata		= 1,	piix4_pata		= 2,	ich6_sata		= 3,	ich6_sata_rm		= 4,};static int piix_init_one (struct pci_dev *pdev,				    const struct pci_device_id *ent);static void piix_pata_phy_reset(struct ata_port *ap);static void piix_sata_phy_reset(struct ata_port *ap);static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev);static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev);static unsigned int in_module_init = 1;static struct pci_device_id piix_pci_tbl[] = {#ifdef ATA_ENABLE_PATA	{ 0x8086, 0x7111, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata },	{ 0x8086, 0x24db, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata },	{ 0x8086, 0x25a2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata },#endif	/* NOTE: The following PCI ids must be kept in sync with the	 * list in drivers/pci/quirks.c.	 */	{ 0x8086, 0x24d1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },	{ 0x8086, 0x24df, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },	{ 0x8086, 0x25a3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },	{ 0x8086, 0x25b0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },	{ 0x8086, 0x2651, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata },	{ 0x8086, 0x2652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_rm },	{ 0x8086, 0x2653, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_rm },	{ }	/* terminate list */};static struct pci_driver piix_pci_driver = {	.name			= DRV_NAME,	.id_table		= piix_pci_tbl,	.probe			= piix_init_one,	.remove			= ata_pci_remove_one,};static Scsi_Host_Template piix_sht = {	.module			= THIS_MODULE,	.name			= DRV_NAME,	.ioctl			= ata_scsi_ioctl,	.queuecommand		= ata_scsi_queuecmd,	.eh_strategy_handler	= ata_scsi_error,	.can_queue		= ATA_DEF_QUEUE,	.this_id		= ATA_SHT_THIS_ID,	.sg_tablesize		= LIBATA_MAX_PRD,	.max_sectors		= ATA_MAX_SECTORS,	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,	.emulated		= ATA_SHT_EMULATED,	.use_clustering		= ATA_SHT_USE_CLUSTERING,	.proc_name		= DRV_NAME,	.dma_boundary		= ATA_DMA_BOUNDARY,	.slave_configure	= ata_scsi_slave_config,	.bios_param		= ata_std_bios_param,};static struct ata_port_operations piix_pata_ops = {	.port_disable		= ata_port_disable,	.set_piomode		= piix_set_piomode,	.set_dmamode		= piix_set_dmamode,	.tf_load		= ata_tf_load,	.tf_read		= ata_tf_read,	.check_status		= ata_check_status,	.exec_command		= ata_exec_command,	.dev_select		= ata_std_dev_select,	.phy_reset		= piix_pata_phy_reset,	.bmdma_setup		= ata_bmdma_setup,	.bmdma_start		= ata_bmdma_start,	.qc_prep		= ata_qc_prep,	.qc_issue		= ata_qc_issue_prot,	.eng_timeout		= ata_eng_timeout,	.irq_handler		= ata_interrupt,	.irq_clear		= ata_bmdma_irq_clear,	.port_start		= ata_port_start,	.port_stop		= ata_port_stop,};static struct ata_port_operations piix_sata_ops = {	.port_disable		= ata_port_disable,	.tf_load		= ata_tf_load,	.tf_read		= ata_tf_read,	.check_status		= ata_check_status,	.exec_command		= ata_exec_command,	.dev_select		= ata_std_dev_select,	.phy_reset		= piix_sata_phy_reset,	.bmdma_setup		= ata_bmdma_setup,	.bmdma_start		= ata_bmdma_start,	.qc_prep		= ata_qc_prep,	.qc_issue		= ata_qc_issue_prot,	.eng_timeout		= ata_eng_timeout,	.irq_handler		= ata_interrupt,	.irq_clear		= ata_bmdma_irq_clear,	.port_start		= ata_port_start,	.port_stop		= ata_port_stop,};static struct ata_port_info piix_port_info[] = {	/* ich5_pata */	{		.sht		= &piix_sht,		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST |				  PIIX_FLAG_CHECKINTR,		.pio_mask	= 0x1f,	/* pio0-4 */#if 0		.mwdma_mask	= 0x06, /* mwdma1-2 */#else		.mwdma_mask	= 0x00, /* mwdma broken */#endif		.udma_mask	= ATA_UDMA_MASK_40C, /* FIXME: cbl det */		.port_ops	= &piix_pata_ops,	},	/* ich5_sata */	{		.sht		= &piix_sht,		.host_flags	= ATA_FLAG_SATA | ATA_FLAG_SRST |				  PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR,		.pio_mask	= 0x1f,	/* pio0-4 */		.mwdma_mask	= 0x07, /* mwdma0-2 */		.udma_mask	= 0x7f,	/* udma0-6 */		.port_ops	= &piix_sata_ops,	},	/* piix4_pata */	{		.sht		= &piix_sht,		.host_flags	= ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,		.pio_mask	= 0x1f,	/* pio0-4 */#if 0		.mwdma_mask	= 0x06, /* mwdma1-2 */#else		.mwdma_mask	= 0x00, /* mwdma broken */#endif		.udma_mask	= ATA_UDMA_MASK_40C, /* FIXME: cbl det */		.port_ops	= &piix_pata_ops,	},	/* ich6_sata */	{		.sht		= &piix_sht,		.host_flags	= ATA_FLAG_SATA | ATA_FLAG_SRST |				  PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR |				  ATA_FLAG_SLAVE_POSS,		.pio_mask	= 0x1f,	/* pio0-4 */		.mwdma_mask	= 0x07, /* mwdma0-2 */		.udma_mask	= 0x7f,	/* udma0-6 */		.port_ops	= &piix_sata_ops,	},	/* ich6_sata_rm */	{		.sht		= &piix_sht,		.host_flags	= ATA_FLAG_SATA | ATA_FLAG_SRST |				  PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR |				  ATA_FLAG_SLAVE_POSS | PIIX_FLAG_AHCI,		.pio_mask	= 0x1f,	/* pio0-4 */		.mwdma_mask	= 0x07, /* mwdma0-2 */		.udma_mask	= 0x7f,	/* udma0-6 */		.port_ops	= &piix_sata_ops,	},};static struct pci_bits piix_enable_bits[] = {	{ 0x41U, 1U, 0x80UL, 0x80UL },	/* port 0 */	{ 0x43U, 1U, 0x80UL, 0x80UL },	/* port 1 */};MODULE_AUTHOR("Andre Hedrick, Alan Cox, Andrzej Krzysztofowicz, Jeff Garzik");MODULE_DESCRIPTION("SCSI low-level driver for Intel PIIX/ICH ATA controllers");MODULE_LICENSE("GPL");MODULE_DEVICE_TABLE(pci, piix_pci_tbl);/** *	piix_pata_cbl_detect - Probe host controller cable detect info *	@ap: Port for which cable detect info is desired * *	Read 80c cable indicator from SATA PCI device's PCI config *	register.  This register is normally set by firmware (BIOS). * *	LOCKING: *	None (inherited from caller). */static void piix_pata_cbl_detect(struct ata_port *ap){	struct pci_dev *pdev = ap->host_set->pdev;	u8 tmp, mask;	/* no 80c support in host controller? */	if ((ap->udma_mask & ~ATA_UDMA_MASK_40C) == 0)		goto cbl40;	/* check BIOS cable detect results */	mask = ap->port_no == 0 ? PIIX_80C_PRI : PIIX_80C_SEC;	pci_read_config_byte(pdev, PIIX_IOCFG, &tmp);	if ((tmp & mask) == 0)		goto cbl40;	ap->cbl = ATA_CBL_PATA80;	return;cbl40:	ap->cbl = ATA_CBL_PATA40;	ap->udma_mask &= ATA_UDMA_MASK_40C;}/** *	piix_pata_phy_reset - Probe specified port on PATA host controller *	@ap: Port to probe * *	Probe PATA phy. * *	LOCKING: *	None (inherited from caller). */static void piix_pata_phy_reset(struct ata_port *ap){	if (!pci_test_config_bits(ap->host_set->pdev,				  &piix_enable_bits[ap->port_no])) {		ata_port_disable(ap);		printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id);		return;	}	piix_pata_cbl_detect(ap);	ata_port_probe(ap);	ata_bus_reset(ap);}/** *	piix_sata_probe - Probe PCI device for present SATA devices *	@ap: Port associated with the PCI device we wish to probe * *	Reads SATA PCI device's PCI config register Port Configuration *	and Status (PCS) to determine port and device availability. * *	LOCKING: *	None (inherited from caller). * *	RETURNS: *	Non-zero if device detected, zero otherwise. */static int piix_sata_probe (struct ata_port *ap){	struct pci_dev *pdev = ap->host_set->pdev;	int combined = (ap->flags & ATA_FLAG_SLAVE_POSS);	int orig_mask, mask, i;	u8 pcs;	mask = (PIIX_PORT_PRESENT << ap->port_no) |	       (PIIX_PORT_ENABLED << ap->port_no);	pci_read_config_byte(pdev, ICH5_PCS, &pcs);	orig_mask = (int) pcs & 0xff;

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?