Merge branch 'upstream-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/jgarzi...
[pandora-kernel.git] / drivers / ata / pata_hpt3x3.c
1 /*
2  *      pata_hpt3x3             -       HPT3x3 driver
3  *      (c) Copyright 2005-2006 Red Hat
4  *
5  *      Was pata_hpt34x but the naming was confusing as it supported the
6  *      343 and 363 so it has been renamed.
7  *
8  *      Based on:
9  *      linux/drivers/ide/pci/hpt34x.c          Version 0.40    Sept 10, 2002
10  *      Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
11  *
12  *      May be copied or modified under the terms of the GNU General Public
13  *      License
14  */
15
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/pci.h>
19 #include <linux/init.h>
20 #include <linux/blkdev.h>
21 #include <linux/delay.h>
22 #include <scsi/scsi_host.h>
23 #include <linux/libata.h>
24
25 #define DRV_NAME        "pata_hpt3x3"
26 #define DRV_VERSION     "0.6.1"
27
28 /**
29  *      hpt3x3_set_piomode              -       PIO setup
30  *      @ap: ATA interface
31  *      @adev: device on the interface
32  *
33  *      Set our PIO requirements. This is fairly simple on the HPT3x3 as
34  *      all we have to do is clear the MWDMA and UDMA bits then load the
35  *      mode number.
36  */
37
38 static void hpt3x3_set_piomode(struct ata_port *ap, struct ata_device *adev)
39 {
40         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
41         u32 r1, r2;
42         int dn = 2 * ap->port_no + adev->devno;
43
44         pci_read_config_dword(pdev, 0x44, &r1);
45         pci_read_config_dword(pdev, 0x48, &r2);
46         /* Load the PIO timing number */
47         r1 &= ~(7 << (3 * dn));
48         r1 |= (adev->pio_mode - XFER_PIO_0) << (3 * dn);
49         r2 &= ~(0x11 << dn);    /* Clear MWDMA and UDMA bits */
50
51         pci_write_config_dword(pdev, 0x44, r1);
52         pci_write_config_dword(pdev, 0x48, r2);
53 }
54
55 #if defined(CONFIG_PATA_HPT3X3_DMA)
56 /**
57  *      hpt3x3_set_dmamode              -       DMA timing setup
58  *      @ap: ATA interface
59  *      @adev: Device being configured
60  *
61  *      Set up the channel for MWDMA or UDMA modes. Much the same as with
62  *      PIO, load the mode number and then set MWDMA or UDMA flag.
63  *
64  *      0x44 : bit 0-2 master mode, 3-5 slave mode, etc
65  *      0x48 : bit 4/0 DMA/UDMA bit 5/1 for slave etc
66  */
67
68 static void hpt3x3_set_dmamode(struct ata_port *ap, struct ata_device *adev)
69 {
70         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
71         u32 r1, r2;
72         int dn = 2 * ap->port_no + adev->devno;
73         int mode_num = adev->dma_mode & 0x0F;
74
75         pci_read_config_dword(pdev, 0x44, &r1);
76         pci_read_config_dword(pdev, 0x48, &r2);
77         /* Load the timing number */
78         r1 &= ~(7 << (3 * dn));
79         r1 |= (mode_num << (3 * dn));
80         r2 &= ~(0x11 << dn);    /* Clear MWDMA and UDMA bits */
81
82         if (adev->dma_mode >= XFER_UDMA_0)
83                 r2 |= (0x01 << dn);     /* Ultra mode */
84         else
85                 r2 |= (0x10 << dn);     /* MWDMA */
86
87         pci_write_config_dword(pdev, 0x44, r1);
88         pci_write_config_dword(pdev, 0x48, r2);
89 }
90
91 /**
92  *      hpt3x3_freeze           -       DMA workaround
93  *      @ap: port to freeze
94  *
95  *      When freezing an HPT3x3 we must stop any pending DMA before
96  *      writing to the control register or the chip will hang
97  */
98
99 static void hpt3x3_freeze(struct ata_port *ap)
100 {
101         void __iomem *mmio = ap->ioaddr.bmdma_addr;
102
103         iowrite8(ioread8(mmio + ATA_DMA_CMD) & ~ ATA_DMA_START,
104                         mmio + ATA_DMA_CMD);
105         ata_sff_dma_pause(ap);
106         ata_sff_freeze(ap);
107 }
108
109 /**
110  *      hpt3x3_bmdma_setup      -       DMA workaround
111  *      @qc: Queued command
112  *
113  *      When issuing BMDMA we must clean up the error/active bits in
114  *      software on this device
115  */
116
117 static void hpt3x3_bmdma_setup(struct ata_queued_cmd *qc)
118 {
119         struct ata_port *ap = qc->ap;
120         u8 r = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
121         r |= ATA_DMA_INTR | ATA_DMA_ERR;
122         iowrite8(r, ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
123         return ata_bmdma_setup(qc);
124 }
125
126 /**
127  *      hpt3x3_atapi_dma        -       ATAPI DMA check
128  *      @qc: Queued command
129  *
130  *      Just say no - we don't do ATAPI DMA
131  */
132
133 static int hpt3x3_atapi_dma(struct ata_queued_cmd *qc)
134 {
135         return 1;
136 }
137
138 #endif /* CONFIG_PATA_HPT3X3_DMA */
139
140 static struct scsi_host_template hpt3x3_sht = {
141         ATA_BMDMA_SHT(DRV_NAME),
142 };
143
144 static struct ata_port_operations hpt3x3_port_ops = {
145         .inherits       = &ata_bmdma_port_ops,
146         .cable_detect   = ata_cable_40wire,
147         .set_piomode    = hpt3x3_set_piomode,
148 #if defined(CONFIG_PATA_HPT3X3_DMA)
149         .set_dmamode    = hpt3x3_set_dmamode,
150         .bmdma_setup    = hpt3x3_bmdma_setup,
151         .check_atapi_dma= hpt3x3_atapi_dma,
152         .freeze         = hpt3x3_freeze,
153 #endif
154
155 };
156
157 /**
158  *      hpt3x3_init_chipset     -       chip setup
159  *      @dev: PCI device
160  *
161  *      Perform the setup required at boot and on resume.
162  */
163
164 static void hpt3x3_init_chipset(struct pci_dev *dev)
165 {
166         u16 cmd;
167         /* Initialize the board */
168         pci_write_config_word(dev, 0x80, 0x00);
169         /* Check if it is a 343 or a 363. 363 has COMMAND_MEMORY set */
170         pci_read_config_word(dev, PCI_COMMAND, &cmd);
171         if (cmd & PCI_COMMAND_MEMORY)
172                 pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0xF0);
173         else
174                 pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x20);
175 }
176
177 /**
178  *      hpt3x3_init_one         -       Initialise an HPT343/363
179  *      @pdev: PCI device
180  *      @id: Entry in match table
181  *
182  *      Perform basic initialisation. We set the device up so we access all
183  *      ports via BAR4. This is necessary to work around errata.
184  */
185
186 static int hpt3x3_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
187 {
188         static const struct ata_port_info info = {
189                 .flags = ATA_FLAG_SLAVE_POSS,
190                 .pio_mask = ATA_PIO4,
191 #if defined(CONFIG_PATA_HPT3X3_DMA)
192                 /* Further debug needed */
193                 .mwdma_mask = ATA_MWDMA2,
194                 .udma_mask = ATA_UDMA2,
195 #endif
196                 .port_ops = &hpt3x3_port_ops
197         };
198         /* Register offsets of taskfiles in BAR4 area */
199         static const u8 offset_cmd[2] = { 0x20, 0x28 };
200         static const u8 offset_ctl[2] = { 0x36, 0x3E };
201         const struct ata_port_info *ppi[] = { &info, NULL };
202         struct ata_host *host;
203         int i, rc;
204         void __iomem *base;
205
206         hpt3x3_init_chipset(pdev);
207
208         ata_print_version_once(&pdev->dev, DRV_VERSION);
209
210         host = ata_host_alloc_pinfo(&pdev->dev, ppi, 2);
211         if (!host)
212                 return -ENOMEM;
213         /* acquire resources and fill host */
214         rc = pcim_enable_device(pdev);
215         if (rc)
216                 return rc;
217
218         /* Everything is relative to BAR4 if we set up this way */
219         rc = pcim_iomap_regions(pdev, 1 << 4, DRV_NAME);
220         if (rc == -EBUSY)
221                 pcim_pin_device(pdev);
222         if (rc)
223                 return rc;
224         host->iomap = pcim_iomap_table(pdev);
225         rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
226         if (rc)
227                 return rc;
228         rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
229         if (rc)
230                 return rc;
231
232         base = host->iomap[4];  /* Bus mastering base */
233
234         for (i = 0; i < host->n_ports; i++) {
235                 struct ata_port *ap = host->ports[i];
236                 struct ata_ioports *ioaddr = &ap->ioaddr;
237
238                 ioaddr->cmd_addr = base + offset_cmd[i];
239                 ioaddr->altstatus_addr =
240                 ioaddr->ctl_addr = base + offset_ctl[i];
241                 ioaddr->scr_addr = NULL;
242                 ata_sff_std_ports(ioaddr);
243                 ioaddr->bmdma_addr = base + 8 * i;
244
245                 ata_port_pbar_desc(ap, 4, -1, "ioport");
246                 ata_port_pbar_desc(ap, 4, offset_cmd[i], "cmd");
247         }
248         pci_set_master(pdev);
249         return ata_host_activate(host, pdev->irq, ata_bmdma_interrupt,
250                                  IRQF_SHARED, &hpt3x3_sht);
251 }
252
253 #ifdef CONFIG_PM
254 static int hpt3x3_reinit_one(struct pci_dev *dev)
255 {
256         struct ata_host *host = dev_get_drvdata(&dev->dev);
257         int rc;
258
259         rc = ata_pci_device_do_resume(dev);
260         if (rc)
261                 return rc;
262
263         hpt3x3_init_chipset(dev);
264
265         ata_host_resume(host);
266         return 0;
267 }
268 #endif
269
270 static const struct pci_device_id hpt3x3[] = {
271         { PCI_VDEVICE(TTI, PCI_DEVICE_ID_TTI_HPT343), },
272
273         { },
274 };
275
276 static struct pci_driver hpt3x3_pci_driver = {
277         .name           = DRV_NAME,
278         .id_table       = hpt3x3,
279         .probe          = hpt3x3_init_one,
280         .remove         = ata_pci_remove_one,
281 #ifdef CONFIG_PM
282         .suspend        = ata_pci_device_suspend,
283         .resume         = hpt3x3_reinit_one,
284 #endif
285 };
286
287 static int __init hpt3x3_init(void)
288 {
289         return pci_register_driver(&hpt3x3_pci_driver);
290 }
291
292
293 static void __exit hpt3x3_exit(void)
294 {
295         pci_unregister_driver(&hpt3x3_pci_driver);
296 }
297
298
299 MODULE_AUTHOR("Alan Cox");
300 MODULE_DESCRIPTION("low-level driver for the Highpoint HPT343/363");
301 MODULE_LICENSE("GPL");
302 MODULE_DEVICE_TABLE(pci, hpt3x3);
303 MODULE_VERSION(DRV_VERSION);
304
305 module_init(hpt3x3_init);
306 module_exit(hpt3x3_exit);