2 * Copyright (C) 2002 Toshiba Corporation
3 * Copyright (C) 2005-2006 MontaVista Software, Inc. <source@mvista.com>
5 * This file is licensed under the terms of the GNU General Public
6 * License version 2. This program is licensed "as is" without any
7 * warranty of any kind, whether express or implied.
10 #include <linux/types.h>
11 #include <linux/pci.h>
12 #include <linux/ide.h>
14 #define DRV_NAME "tc86c001"
16 static void tc86c001_set_mode(ide_hwif_t
*hwif
, ide_drive_t
*drive
)
18 unsigned long scr_port
= hwif
->config_data
+ (drive
->dn
? 0x02 : 0x00);
19 u16 mode
, scr
= inw(scr_port
);
20 const u8 speed
= drive
->dma_mode
;
23 case XFER_UDMA_4
: mode
= 0x00c0; break;
24 case XFER_UDMA_3
: mode
= 0x00b0; break;
25 case XFER_UDMA_2
: mode
= 0x00a0; break;
26 case XFER_UDMA_1
: mode
= 0x0090; break;
27 case XFER_UDMA_0
: mode
= 0x0080; break;
28 case XFER_MW_DMA_2
: mode
= 0x0070; break;
29 case XFER_MW_DMA_1
: mode
= 0x0060; break;
30 case XFER_MW_DMA_0
: mode
= 0x0050; break;
31 case XFER_PIO_4
: mode
= 0x0400; break;
32 case XFER_PIO_3
: mode
= 0x0300; break;
33 case XFER_PIO_2
: mode
= 0x0200; break;
34 case XFER_PIO_1
: mode
= 0x0100; break;
36 default: mode
= 0x0000; break;
39 scr
&= (speed
< XFER_MW_DMA_0
) ? 0xf8ff : 0xff0f;
44 static void tc86c001_set_pio_mode(ide_hwif_t
*hwif
, ide_drive_t
*drive
)
46 drive
->dma_mode
= drive
->pio_mode
;
47 tc86c001_set_mode(hwif
, drive
);
50 static int tc86c001_timer_expiry(ide_drive_t
*drive
)
52 ide_hwif_t
*hwif
= drive
->hwif
;
53 ide_expiry_t
*expiry
= ide_get_hwifdata(hwif
);
54 u8 dma_stat
= inb(hwif
->dma_base
+ ATA_DMA_STATUS
);
56 /* Restore a higher level driver's expiry handler first. */
57 hwif
->expiry
= expiry
;
59 if ((dma_stat
& 5) == 1) { /* DMA active and no interrupt */
60 unsigned long sc_base
= hwif
->config_data
;
61 unsigned long twcr_port
= sc_base
+ (drive
->dn
? 0x06 : 0x04);
62 u8 dma_cmd
= inb(hwif
->dma_base
+ ATA_DMA_CMD
);
64 printk(KERN_WARNING
"%s: DMA interrupt possibly stuck, "
65 "attempting recovery...\n", drive
->name
);
68 outb(dma_cmd
& ~0x01, hwif
->dma_base
+ ATA_DMA_CMD
);
70 /* Setup the dummy DMA transfer */
71 outw(0, sc_base
+ 0x0a); /* Sector Count */
72 outw(0, twcr_port
); /* Transfer Word Count 1 or 2 */
74 /* Start the dummy DMA transfer */
76 /* clear R_OR_WCTR for write */
77 outb(0x00, hwif
->dma_base
+ ATA_DMA_CMD
);
78 /* set START_STOPBM */
79 outb(0x01, hwif
->dma_base
+ ATA_DMA_CMD
);
82 * If an interrupt was pending, it should come thru shortly.
83 * If not, a higher level driver's expiry handler should
84 * eventually cause some kind of recovery from the DMA stall.
86 return WAIT_MIN_SLEEP
;
89 /* Chain to the restored expiry handler if DMA wasn't active. */
90 if (likely(expiry
!= NULL
))
93 /* If there was no handler, "emulate" that for ide_timer_expiry()... */
97 static void tc86c001_dma_start(ide_drive_t
*drive
)
99 ide_hwif_t
*hwif
= drive
->hwif
;
100 unsigned long sc_base
= hwif
->config_data
;
101 unsigned long twcr_port
= sc_base
+ (drive
->dn
? 0x06 : 0x04);
102 unsigned long nsectors
= blk_rq_sectors(hwif
->rq
);
105 * We have to manually load the sector count and size into
106 * the appropriate system control registers for DMA to work
107 * with LBA48 and ATAPI devices...
109 outw(nsectors
, sc_base
+ 0x0a); /* Sector Count */
110 outw(SECTOR_SIZE
/ 2, twcr_port
); /* Transfer Word Count 1/2 */
112 /* Install our timeout expiry hook, saving the current handler... */
113 ide_set_hwifdata(hwif
, hwif
->expiry
);
114 hwif
->expiry
= &tc86c001_timer_expiry
;
116 ide_dma_start(drive
);
119 static u8
tc86c001_cable_detect(ide_hwif_t
*hwif
)
121 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
122 unsigned long sc_base
= pci_resource_start(dev
, 5);
123 u16 scr1
= inw(sc_base
+ 0x00);
126 * System Control 1 Register bit 13 (PDIAGN):
127 * 0=80-pin cable, 1=40-pin cable
129 return (scr1
& 0x2000) ? ATA_CBL_PATA40
: ATA_CBL_PATA80
;
132 static void __devinit
init_hwif_tc86c001(ide_hwif_t
*hwif
)
134 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
135 unsigned long sc_base
= pci_resource_start(dev
, 5);
136 u16 scr1
= inw(sc_base
+ 0x00);
138 /* System Control 1 Register bit 15 (Soft Reset) set */
139 outw(scr1
| 0x8000, sc_base
+ 0x00);
141 /* System Control 1 Register bit 14 (FIFO Reset) set */
142 outw(scr1
| 0x4000, sc_base
+ 0x00);
144 /* System Control 1 Register: reset clear */
145 outw(scr1
& ~0xc000, sc_base
+ 0x00);
147 /* Store the system control register base for convenience... */
148 hwif
->config_data
= sc_base
;
154 * Sector Count Control Register bits 0 and 1 set:
155 * software sets Sector Count Register for master and slave device
157 outw(0x0003, sc_base
+ 0x0c);
159 /* Sector Count Register limit */
160 hwif
->rqsize
= 0xffff;
163 static const struct ide_port_ops tc86c001_port_ops
= {
164 .set_pio_mode
= tc86c001_set_pio_mode
,
165 .set_dma_mode
= tc86c001_set_mode
,
166 .cable_detect
= tc86c001_cable_detect
,
169 static const struct ide_dma_ops tc86c001_dma_ops
= {
170 .dma_host_set
= ide_dma_host_set
,
171 .dma_setup
= ide_dma_setup
,
172 .dma_start
= tc86c001_dma_start
,
173 .dma_end
= ide_dma_end
,
174 .dma_test_irq
= ide_dma_test_irq
,
175 .dma_lost_irq
= ide_dma_lost_irq
,
176 .dma_timer_expiry
= ide_dma_sff_timer_expiry
,
177 .dma_sff_read_status
= ide_dma_sff_read_status
,
180 static const struct ide_port_info tc86c001_chipset __devinitdata
= {
182 .init_hwif
= init_hwif_tc86c001
,
183 .port_ops
= &tc86c001_port_ops
,
184 .dma_ops
= &tc86c001_dma_ops
,
185 .host_flags
= IDE_HFLAG_SINGLE
| IDE_HFLAG_OFF_BOARD
,
186 .pio_mask
= ATA_PIO4
,
187 .mwdma_mask
= ATA_MWDMA2
,
188 .udma_mask
= ATA_UDMA4
,
191 static int __devinit
tc86c001_init_one(struct pci_dev
*dev
,
192 const struct pci_device_id
*id
)
196 rc
= pci_enable_device(dev
);
200 rc
= pci_request_region(dev
, 5, DRV_NAME
);
202 printk(KERN_ERR DRV_NAME
": system control regs already in use");
206 rc
= ide_pci_init_one(dev
, &tc86c001_chipset
, NULL
);
213 pci_release_region(dev
, 5);
215 pci_disable_device(dev
);
220 static void __devexit
tc86c001_remove(struct pci_dev
*dev
)
223 pci_release_region(dev
, 5);
224 pci_disable_device(dev
);
227 static const struct pci_device_id tc86c001_pci_tbl
[] = {
228 { PCI_VDEVICE(TOSHIBA_2
, PCI_DEVICE_ID_TOSHIBA_TC86C001_IDE
), 0 },
231 MODULE_DEVICE_TABLE(pci
, tc86c001_pci_tbl
);
233 static struct pci_driver tc86c001_pci_driver
= {
235 .id_table
= tc86c001_pci_tbl
,
236 .probe
= tc86c001_init_one
,
237 .remove
= __devexit_p(tc86c001_remove
),
240 static int __init
tc86c001_ide_init(void)
242 return ide_pci_register_driver(&tc86c001_pci_driver
);
245 static void __exit
tc86c001_ide_exit(void)
247 pci_unregister_driver(&tc86c001_pci_driver
);
250 module_init(tc86c001_ide_init
);
251 module_exit(tc86c001_ide_exit
);
253 MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>");
254 MODULE_DESCRIPTION("PCI driver module for TC86C001 IDE");
255 MODULE_LICENSE("GPL");