blob: cc6ee0890f56c1ddcb24581bbad7bbc27ae2640e [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Jeff Garzikaf36d7f2005-08-28 20:18:39 -04002 * sata_via.c - VIA Serial ATA controllers
3 *
4 * Maintained by: Jeff Garzik <jgarzik@pobox.com>
5 * Please ALWAYS copy linux-ide@vger.kernel.org
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 on emails.
Jeff Garzikaf36d7f2005-08-28 20:18:39 -04007 *
8 * Copyright 2003-2004 Red Hat, Inc. All rights reserved.
9 * Copyright 2003-2004 Jeff Garzik
10 *
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2, or (at your option)
15 * any later version.
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; see the file COPYING. If not, write to
24 * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
25 *
26 *
27 * libata documentation is available via 'make {ps|pdf}docs',
28 * as Documentation/DocBook/libata.*
29 *
30 * Hardware documentation available under NDA.
31 *
32 *
33 * To-do list:
34 * - VT6421 PATA support
35 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070036 */
37
38#include <linux/kernel.h>
39#include <linux/module.h>
40#include <linux/pci.h>
41#include <linux/init.h>
42#include <linux/blkdev.h>
43#include <linux/delay.h>
Jeff Garzika9524a72005-10-30 14:39:11 -050044#include <linux/device.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045#include <scsi/scsi_host.h>
46#include <linux/libata.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
48#define DRV_NAME "sata_via"
Jeff Garzik2a3103c2007-08-31 04:54:06 -040049#define DRV_VERSION "2.3"
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
51enum board_ids_enum {
52 vt6420,
53 vt6421,
54};
55
56enum {
57 SATA_CHAN_ENAB = 0x40, /* SATA channel enable */
58 SATA_INT_GATE = 0x41, /* SATA interrupt gating */
59 SATA_NATIVE_MODE = 0x42, /* Native mode enable */
Aland73f30e2007-01-08 17:11:13 +000060 PATA_UDMA_TIMING = 0xB3, /* PATA timing for DMA/ cable detect */
61 PATA_PIO_TIMING = 0xAB, /* PATA timing register */
Jeff Garzika84471f2007-02-26 05:51:33 -050062
Linus Torvalds1da177e2005-04-16 15:20:36 -070063 PORT0 = (1 << 1),
64 PORT1 = (1 << 0),
65 ALL_PORTS = PORT0 | PORT1,
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
67 NATIVE_MODE_ALL = (1 << 7) | (1 << 6) | (1 << 5) | (1 << 4),
68
69 SATA_EXT_PHY = (1 << 6), /* 0==use PATA, 1==ext phy */
Linus Torvalds1da177e2005-04-16 15:20:36 -070070};
71
72static int svia_init_one (struct pci_dev *pdev, const struct pci_device_id *ent);
Tejun Heoda3dbb12007-07-16 14:29:40 +090073static int svia_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val);
74static int svia_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val);
Tejun Heo17234242007-01-25 20:46:59 +090075static void svia_noop_freeze(struct ata_port *ap);
Tejun Heoac2164d2006-08-23 01:00:27 +090076static void vt6420_error_handler(struct ata_port *ap);
Jeff Garzika0fcdc02007-03-09 07:24:15 -050077static int vt6421_pata_cable_detect(struct ata_port *ap);
Aland73f30e2007-01-08 17:11:13 +000078static void vt6421_set_pio_mode(struct ata_port *ap, struct ata_device *adev);
79static void vt6421_set_dma_mode(struct ata_port *ap, struct ata_device *adev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070080
Jeff Garzik3b7d6972005-11-10 11:04:11 -050081static const struct pci_device_id svia_pci_tbl[] = {
Luca Pedrielli96bc1032007-01-16 12:55:04 +090082 { PCI_VDEVICE(VIA, 0x5337), vt6420 },
Jeff Garzik2d2744f2006-09-28 20:21:59 -040083 { PCI_VDEVICE(VIA, 0x0591), vt6420 },
84 { PCI_VDEVICE(VIA, 0x3149), vt6420 },
85 { PCI_VDEVICE(VIA, 0x3249), vt6421 },
Jeff Garzik52df0ee2007-05-25 05:02:06 -040086 { PCI_VDEVICE(VIA, 0x5287), vt6420 },
87 { PCI_VDEVICE(VIA, 0x5372), vt6420 },
88 { PCI_VDEVICE(VIA, 0x7372), vt6420 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070089
90 { } /* terminate list */
91};
92
93static struct pci_driver svia_pci_driver = {
94 .name = DRV_NAME,
95 .id_table = svia_pci_tbl,
96 .probe = svia_init_one,
Tejun Heoe1e143c2007-05-04 15:30:34 +020097#ifdef CONFIG_PM
98 .suspend = ata_pci_device_suspend,
99 .resume = ata_pci_device_resume,
100#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101 .remove = ata_pci_remove_one,
102};
103
Jeff Garzik193515d2005-11-07 00:59:37 -0500104static struct scsi_host_template svia_sht = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 .module = THIS_MODULE,
106 .name = DRV_NAME,
107 .ioctl = ata_scsi_ioctl,
108 .queuecommand = ata_scsi_queuecmd,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 .can_queue = ATA_DEF_QUEUE,
110 .this_id = ATA_SHT_THIS_ID,
111 .sg_tablesize = LIBATA_MAX_PRD,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 .cmd_per_lun = ATA_SHT_CMD_PER_LUN,
113 .emulated = ATA_SHT_EMULATED,
114 .use_clustering = ATA_SHT_USE_CLUSTERING,
115 .proc_name = DRV_NAME,
116 .dma_boundary = ATA_DMA_BOUNDARY,
117 .slave_configure = ata_scsi_slave_config,
Tejun Heoccf68c32006-05-31 18:28:09 +0900118 .slave_destroy = ata_scsi_slave_destroy,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119 .bios_param = ata_std_bios_param,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120};
121
Tejun Heoac2164d2006-08-23 01:00:27 +0900122static const struct ata_port_operations vt6420_sata_ops = {
Tejun Heoac2164d2006-08-23 01:00:27 +0900123 .tf_load = ata_tf_load,
124 .tf_read = ata_tf_read,
125 .check_status = ata_check_status,
126 .exec_command = ata_exec_command,
127 .dev_select = ata_std_dev_select,
128
129 .bmdma_setup = ata_bmdma_setup,
130 .bmdma_start = ata_bmdma_start,
131 .bmdma_stop = ata_bmdma_stop,
132 .bmdma_status = ata_bmdma_status,
133
134 .qc_prep = ata_qc_prep,
135 .qc_issue = ata_qc_issue_prot,
Tejun Heo0d5ff562007-02-01 15:06:36 +0900136 .data_xfer = ata_data_xfer,
Tejun Heoac2164d2006-08-23 01:00:27 +0900137
Tejun Heo17234242007-01-25 20:46:59 +0900138 .freeze = svia_noop_freeze,
Tejun Heoac2164d2006-08-23 01:00:27 +0900139 .thaw = ata_bmdma_thaw,
140 .error_handler = vt6420_error_handler,
141 .post_internal_cmd = ata_bmdma_post_internal_cmd,
142
Tejun Heoac2164d2006-08-23 01:00:27 +0900143 .irq_clear = ata_bmdma_irq_clear,
Akira Iguchi246ce3b2007-01-26 16:27:58 +0900144 .irq_on = ata_irq_on,
Tejun Heoac2164d2006-08-23 01:00:27 +0900145
146 .port_start = ata_port_start,
Tejun Heoac2164d2006-08-23 01:00:27 +0900147};
148
Aland73f30e2007-01-08 17:11:13 +0000149static const struct ata_port_operations vt6421_pata_ops = {
Aland73f30e2007-01-08 17:11:13 +0000150 .set_piomode = vt6421_set_pio_mode,
151 .set_dmamode = vt6421_set_dma_mode,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152
153 .tf_load = ata_tf_load,
154 .tf_read = ata_tf_read,
155 .check_status = ata_check_status,
156 .exec_command = ata_exec_command,
157 .dev_select = ata_std_dev_select,
158
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 .bmdma_setup = ata_bmdma_setup,
160 .bmdma_start = ata_bmdma_start,
161 .bmdma_stop = ata_bmdma_stop,
162 .bmdma_status = ata_bmdma_status,
163
164 .qc_prep = ata_qc_prep,
165 .qc_issue = ata_qc_issue_prot,
Tejun Heo0d5ff562007-02-01 15:06:36 +0900166 .data_xfer = ata_data_xfer,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167
Tejun Heo40ef1d82006-06-16 15:13:53 +0900168 .freeze = ata_bmdma_freeze,
169 .thaw = ata_bmdma_thaw,
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500170 .error_handler = ata_bmdma_error_handler,
Aland73f30e2007-01-08 17:11:13 +0000171 .post_internal_cmd = ata_bmdma_post_internal_cmd,
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500172 .cable_detect = vt6421_pata_cable_detect,
Aland73f30e2007-01-08 17:11:13 +0000173
Aland73f30e2007-01-08 17:11:13 +0000174 .irq_clear = ata_bmdma_irq_clear,
Akira Iguchi246ce3b2007-01-26 16:27:58 +0900175 .irq_on = ata_irq_on,
Aland73f30e2007-01-08 17:11:13 +0000176
Tejun Heoeca25dc2007-04-17 23:44:07 +0900177 .port_start = ata_port_start,
Aland73f30e2007-01-08 17:11:13 +0000178};
179
180static const struct ata_port_operations vt6421_sata_ops = {
Aland73f30e2007-01-08 17:11:13 +0000181 .tf_load = ata_tf_load,
182 .tf_read = ata_tf_read,
183 .check_status = ata_check_status,
184 .exec_command = ata_exec_command,
185 .dev_select = ata_std_dev_select,
186
187 .bmdma_setup = ata_bmdma_setup,
188 .bmdma_start = ata_bmdma_start,
189 .bmdma_stop = ata_bmdma_stop,
190 .bmdma_status = ata_bmdma_status,
191
192 .qc_prep = ata_qc_prep,
193 .qc_issue = ata_qc_issue_prot,
Tejun Heo0d5ff562007-02-01 15:06:36 +0900194 .data_xfer = ata_data_xfer,
Aland73f30e2007-01-08 17:11:13 +0000195
196 .freeze = ata_bmdma_freeze,
197 .thaw = ata_bmdma_thaw,
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500198 .error_handler = ata_bmdma_error_handler,
Tejun Heo40ef1d82006-06-16 15:13:53 +0900199 .post_internal_cmd = ata_bmdma_post_internal_cmd,
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500200 .cable_detect = ata_cable_sata,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202 .irq_clear = ata_bmdma_irq_clear,
Akira Iguchi246ce3b2007-01-26 16:27:58 +0900203 .irq_on = ata_irq_on,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204
205 .scr_read = svia_scr_read,
206 .scr_write = svia_scr_write,
207
Tejun Heoeca25dc2007-04-17 23:44:07 +0900208 .port_start = ata_port_start,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209};
210
Tejun Heoeca25dc2007-04-17 23:44:07 +0900211static const struct ata_port_info vt6420_port_info = {
Jeff Garzikcca39742006-08-24 03:19:22 -0400212 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 .pio_mask = 0x1f,
214 .mwdma_mask = 0x07,
Jeff Garzikbf6263a2007-07-09 12:16:50 -0400215 .udma_mask = ATA_UDMA6,
Tejun Heoac2164d2006-08-23 01:00:27 +0900216 .port_ops = &vt6420_sata_ops,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217};
218
Tejun Heoeca25dc2007-04-17 23:44:07 +0900219static struct ata_port_info vt6421_sport_info = {
220 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY,
221 .pio_mask = 0x1f,
222 .mwdma_mask = 0x07,
Jeff Garzikbf6263a2007-07-09 12:16:50 -0400223 .udma_mask = ATA_UDMA6,
Tejun Heoeca25dc2007-04-17 23:44:07 +0900224 .port_ops = &vt6421_sata_ops,
225};
226
227static struct ata_port_info vt6421_pport_info = {
228 .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_NO_LEGACY,
229 .pio_mask = 0x1f,
230 .mwdma_mask = 0,
Jeff Garzikbf6263a2007-07-09 12:16:50 -0400231 .udma_mask = ATA_UDMA6,
Tejun Heoeca25dc2007-04-17 23:44:07 +0900232 .port_ops = &vt6421_pata_ops,
233};
234
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235MODULE_AUTHOR("Jeff Garzik");
236MODULE_DESCRIPTION("SCSI low-level driver for VIA SATA controllers");
237MODULE_LICENSE("GPL");
238MODULE_DEVICE_TABLE(pci, svia_pci_tbl);
239MODULE_VERSION(DRV_VERSION);
240
Tejun Heoda3dbb12007-07-16 14:29:40 +0900241static int svia_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242{
243 if (sc_reg > SCR_CONTROL)
Tejun Heoda3dbb12007-07-16 14:29:40 +0900244 return -EINVAL;
245 *val = ioread32(ap->ioaddr.scr_addr + (4 * sc_reg));
246 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247}
248
Tejun Heoda3dbb12007-07-16 14:29:40 +0900249static int svia_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250{
251 if (sc_reg > SCR_CONTROL)
Tejun Heoda3dbb12007-07-16 14:29:40 +0900252 return -EINVAL;
Tejun Heo0d5ff562007-02-01 15:06:36 +0900253 iowrite32(val, ap->ioaddr.scr_addr + (4 * sc_reg));
Tejun Heoda3dbb12007-07-16 14:29:40 +0900254 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255}
256
Tejun Heo17234242007-01-25 20:46:59 +0900257static void svia_noop_freeze(struct ata_port *ap)
258{
259 /* Some VIA controllers choke if ATA_NIEN is manipulated in
260 * certain way. Leave it alone and just clear pending IRQ.
261 */
262 ata_chk_status(ap);
Tejun Heod02598722007-01-26 14:57:31 +0900263 ata_bmdma_irq_clear(ap);
Tejun Heo17234242007-01-25 20:46:59 +0900264}
265
Tejun Heoac2164d2006-08-23 01:00:27 +0900266/**
267 * vt6420_prereset - prereset for vt6420
Tejun Heocc0680a2007-08-06 18:36:23 +0900268 * @link: target ATA link
Tejun Heod4b2bab2007-02-02 16:50:52 +0900269 * @deadline: deadline jiffies for the operation
Tejun Heoac2164d2006-08-23 01:00:27 +0900270 *
271 * SCR registers on vt6420 are pieces of shit and may hang the
272 * whole machine completely if accessed with the wrong timing.
273 * To avoid such catastrophe, vt6420 doesn't provide generic SCR
274 * access operations, but uses SStatus and SControl only during
275 * boot probing in controlled way.
276 *
277 * As the old (pre EH update) probing code is proven to work, we
278 * strictly follow the access pattern.
279 *
280 * LOCKING:
281 * Kernel thread context (may sleep)
282 *
283 * RETURNS:
284 * 0 on success, -errno otherwise.
285 */
Tejun Heocc0680a2007-08-06 18:36:23 +0900286static int vt6420_prereset(struct ata_link *link, unsigned long deadline)
Tejun Heoac2164d2006-08-23 01:00:27 +0900287{
Tejun Heocc0680a2007-08-06 18:36:23 +0900288 struct ata_port *ap = link->ap;
Tejun Heo9af5c9c2007-08-06 18:36:22 +0900289 struct ata_eh_context *ehc = &ap->link.eh_context;
Tejun Heoac2164d2006-08-23 01:00:27 +0900290 unsigned long timeout = jiffies + (HZ * 5);
291 u32 sstatus, scontrol;
292 int online;
293
294 /* don't do any SCR stuff if we're not loading */
Jeff Garzik68ff6e82006-11-08 07:46:02 -0500295 if (!(ap->pflags & ATA_PFLAG_LOADING))
Tejun Heoac2164d2006-08-23 01:00:27 +0900296 goto skip_scr;
297
Jeff Garzika09060f2007-05-28 08:17:06 -0400298 /* Resume phy. This is the old SATA resume sequence */
Tejun Heoac2164d2006-08-23 01:00:27 +0900299 svia_scr_write(ap, SCR_CONTROL, 0x300);
Tejun Heoda3dbb12007-07-16 14:29:40 +0900300 svia_scr_read(ap, SCR_CONTROL, &scontrol); /* flush */
Tejun Heoac2164d2006-08-23 01:00:27 +0900301
302 /* wait for phy to become ready, if necessary */
303 do {
304 msleep(200);
Tejun Heoda3dbb12007-07-16 14:29:40 +0900305 svia_scr_read(ap, SCR_STATUS, &sstatus);
306 if ((sstatus & 0xf) != 1)
Tejun Heoac2164d2006-08-23 01:00:27 +0900307 break;
308 } while (time_before(jiffies, timeout));
309
310 /* open code sata_print_link_status() */
Tejun Heoda3dbb12007-07-16 14:29:40 +0900311 svia_scr_read(ap, SCR_STATUS, &sstatus);
312 svia_scr_read(ap, SCR_CONTROL, &scontrol);
Tejun Heoac2164d2006-08-23 01:00:27 +0900313
314 online = (sstatus & 0xf) == 0x3;
315
316 ata_port_printk(ap, KERN_INFO,
317 "SATA link %s 1.5 Gbps (SStatus %X SControl %X)\n",
318 online ? "up" : "down", sstatus, scontrol);
319
320 /* SStatus is read one more time */
Tejun Heoda3dbb12007-07-16 14:29:40 +0900321 svia_scr_read(ap, SCR_STATUS, &sstatus);
Tejun Heoac2164d2006-08-23 01:00:27 +0900322
323 if (!online) {
324 /* tell EH to bail */
325 ehc->i.action &= ~ATA_EH_RESET_MASK;
326 return 0;
327 }
328
329 skip_scr:
330 /* wait for !BSY */
Tejun Heod4b2bab2007-02-02 16:50:52 +0900331 ata_wait_ready(ap, deadline);
Tejun Heoac2164d2006-08-23 01:00:27 +0900332
333 return 0;
334}
335
336static void vt6420_error_handler(struct ata_port *ap)
337{
338 return ata_bmdma_drive_eh(ap, vt6420_prereset, ata_std_softreset,
339 NULL, ata_std_postreset);
340}
341
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500342static int vt6421_pata_cable_detect(struct ata_port *ap)
Aland73f30e2007-01-08 17:11:13 +0000343{
344 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
345 u8 tmp;
346
347 pci_read_config_byte(pdev, PATA_UDMA_TIMING, &tmp);
348 if (tmp & 0x10)
Jeff Garzika0fcdc02007-03-09 07:24:15 -0500349 return ATA_CBL_PATA40;
350 return ATA_CBL_PATA80;
Aland73f30e2007-01-08 17:11:13 +0000351}
352
353static void vt6421_set_pio_mode(struct ata_port *ap, struct ata_device *adev)
354{
355 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
356 static const u8 pio_bits[] = { 0xA8, 0x65, 0x65, 0x31, 0x20 };
357 pci_write_config_byte(pdev, PATA_PIO_TIMING, pio_bits[adev->pio_mode - XFER_PIO_0]);
358}
359
360static void vt6421_set_dma_mode(struct ata_port *ap, struct ata_device *adev)
361{
362 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
363 static const u8 udma_bits[] = { 0xEE, 0xE8, 0xE6, 0xE4, 0xE2, 0xE1, 0xE0, 0xE0 };
Ondrej Zaryb4154d42007-09-01 00:55:21 +0200364 pci_write_config_byte(pdev, PATA_UDMA_TIMING, udma_bits[adev->dma_mode - XFER_UDMA_0]);
Aland73f30e2007-01-08 17:11:13 +0000365}
366
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367static const unsigned int svia_bar_sizes[] = {
368 8, 4, 8, 4, 16, 256
369};
370
371static const unsigned int vt6421_bar_sizes[] = {
372 16, 16, 16, 16, 32, 128
373};
374
Tejun Heo0d5ff562007-02-01 15:06:36 +0900375static void __iomem * svia_scr_addr(void __iomem *addr, unsigned int port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376{
377 return addr + (port * 128);
378}
379
Tejun Heo0d5ff562007-02-01 15:06:36 +0900380static void __iomem * vt6421_scr_addr(void __iomem *addr, unsigned int port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381{
382 return addr + (port * 64);
383}
384
Tejun Heoeca25dc2007-04-17 23:44:07 +0900385static void vt6421_init_addrs(struct ata_port *ap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386{
Tejun Heoeca25dc2007-04-17 23:44:07 +0900387 void __iomem * const * iomap = ap->host->iomap;
388 void __iomem *reg_addr = iomap[ap->port_no];
389 void __iomem *bmdma_addr = iomap[4] + (ap->port_no * 8);
390 struct ata_ioports *ioaddr = &ap->ioaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391
Tejun Heoeca25dc2007-04-17 23:44:07 +0900392 ioaddr->cmd_addr = reg_addr;
393 ioaddr->altstatus_addr =
394 ioaddr->ctl_addr = (void __iomem *)
Tejun Heo0d5ff562007-02-01 15:06:36 +0900395 ((unsigned long)(reg_addr + 8) | ATA_PCI_CTL_OFS);
Tejun Heoeca25dc2007-04-17 23:44:07 +0900396 ioaddr->bmdma_addr = bmdma_addr;
397 ioaddr->scr_addr = vt6421_scr_addr(iomap[5], ap->port_no);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398
Tejun Heoeca25dc2007-04-17 23:44:07 +0900399 ata_std_ports(ioaddr);
Tejun Heocbcdd872007-08-18 13:14:55 +0900400
401 ata_port_pbar_desc(ap, ap->port_no, -1, "port");
402 ata_port_pbar_desc(ap, 4, ap->port_no * 8, "bmdma");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403}
404
Tejun Heoeca25dc2007-04-17 23:44:07 +0900405static int vt6420_prepare_host(struct pci_dev *pdev, struct ata_host **r_host)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406{
Tejun Heoeca25dc2007-04-17 23:44:07 +0900407 const struct ata_port_info *ppi[] = { &vt6420_port_info, NULL };
408 struct ata_host *host;
409 int rc;
Jeff Garzikf20b16f2006-12-11 11:14:06 -0500410
Tejun Heod583bc12007-07-04 18:02:07 +0900411 rc = ata_pci_prepare_sff_host(pdev, ppi, &host);
Tejun Heoeca25dc2007-04-17 23:44:07 +0900412 if (rc)
413 return rc;
414 *r_host = host;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415
Tejun Heoeca25dc2007-04-17 23:44:07 +0900416 rc = pcim_iomap_regions(pdev, 1 << 5, DRV_NAME);
417 if (rc) {
Tejun Heoe1be5d72007-02-20 20:01:53 +0900418 dev_printk(KERN_ERR, &pdev->dev, "failed to iomap PCI BAR 5\n");
Tejun Heoeca25dc2007-04-17 23:44:07 +0900419 return rc;
Tejun Heoe1be5d72007-02-20 20:01:53 +0900420 }
421
Tejun Heoeca25dc2007-04-17 23:44:07 +0900422 host->ports[0]->ioaddr.scr_addr = svia_scr_addr(host->iomap[5], 0);
423 host->ports[1]->ioaddr.scr_addr = svia_scr_addr(host->iomap[5], 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424
Tejun Heoeca25dc2007-04-17 23:44:07 +0900425 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426}
427
Tejun Heoeca25dc2007-04-17 23:44:07 +0900428static int vt6421_prepare_host(struct pci_dev *pdev, struct ata_host **r_host)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429{
Tejun Heoeca25dc2007-04-17 23:44:07 +0900430 const struct ata_port_info *ppi[] =
431 { &vt6421_sport_info, &vt6421_sport_info, &vt6421_pport_info };
432 struct ata_host *host;
433 int i, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434
Tejun Heoeca25dc2007-04-17 23:44:07 +0900435 *r_host = host = ata_host_alloc_pinfo(&pdev->dev, ppi, ARRAY_SIZE(ppi));
436 if (!host) {
437 dev_printk(KERN_ERR, &pdev->dev, "failed to allocate host\n");
438 return -ENOMEM;
439 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440
Tejun Heo8fd7d1b2007-05-17 13:37:12 +0200441 rc = pcim_iomap_regions(pdev, 0x3f, DRV_NAME);
Tejun Heoeca25dc2007-04-17 23:44:07 +0900442 if (rc) {
443 dev_printk(KERN_ERR, &pdev->dev, "failed to request/iomap "
444 "PCI BARs (errno=%d)\n", rc);
445 return rc;
446 }
447 host->iomap = pcim_iomap_table(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448
Tejun Heoeca25dc2007-04-17 23:44:07 +0900449 for (i = 0; i < host->n_ports; i++)
450 vt6421_init_addrs(host->ports[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451
Tejun Heoeca25dc2007-04-17 23:44:07 +0900452 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
453 if (rc)
454 return rc;
455 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
456 if (rc)
457 return rc;
Tejun Heoe1be5d72007-02-20 20:01:53 +0900458
Tejun Heoeca25dc2007-04-17 23:44:07 +0900459 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460}
461
462static void svia_configure(struct pci_dev *pdev)
463{
464 u8 tmp8;
465
466 pci_read_config_byte(pdev, PCI_INTERRUPT_LINE, &tmp8);
Jeff Garzika9524a72005-10-30 14:39:11 -0500467 dev_printk(KERN_INFO, &pdev->dev, "routed to hard irq line %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 (int) (tmp8 & 0xf0) == 0xf0 ? 0 : tmp8 & 0x0f);
469
470 /* make sure SATA channels are enabled */
471 pci_read_config_byte(pdev, SATA_CHAN_ENAB, &tmp8);
472 if ((tmp8 & ALL_PORTS) != ALL_PORTS) {
Jeff Garzika9524a72005-10-30 14:39:11 -0500473 dev_printk(KERN_DEBUG, &pdev->dev,
474 "enabling SATA channels (0x%x)\n",
475 (int) tmp8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476 tmp8 |= ALL_PORTS;
477 pci_write_config_byte(pdev, SATA_CHAN_ENAB, tmp8);
478 }
479
480 /* make sure interrupts for each channel sent to us */
481 pci_read_config_byte(pdev, SATA_INT_GATE, &tmp8);
482 if ((tmp8 & ALL_PORTS) != ALL_PORTS) {
Jeff Garzika9524a72005-10-30 14:39:11 -0500483 dev_printk(KERN_DEBUG, &pdev->dev,
484 "enabling SATA channel interrupts (0x%x)\n",
485 (int) tmp8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486 tmp8 |= ALL_PORTS;
487 pci_write_config_byte(pdev, SATA_INT_GATE, tmp8);
488 }
489
490 /* make sure native mode is enabled */
491 pci_read_config_byte(pdev, SATA_NATIVE_MODE, &tmp8);
492 if ((tmp8 & NATIVE_MODE_ALL) != NATIVE_MODE_ALL) {
Jeff Garzika9524a72005-10-30 14:39:11 -0500493 dev_printk(KERN_DEBUG, &pdev->dev,
494 "enabling SATA channel native mode (0x%x)\n",
495 (int) tmp8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 tmp8 |= NATIVE_MODE_ALL;
497 pci_write_config_byte(pdev, SATA_NATIVE_MODE, tmp8);
498 }
499}
500
501static int svia_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
502{
503 static int printed_version;
504 unsigned int i;
505 int rc;
Tejun Heoeca25dc2007-04-17 23:44:07 +0900506 struct ata_host *host;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 int board_id = (int) ent->driver_data;
Al Virob4482a42007-10-14 19:35:40 +0100508 const unsigned *bar_sizes;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509
510 if (!printed_version++)
Jeff Garzika9524a72005-10-30 14:39:11 -0500511 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512
Tejun Heo24dc5f32007-01-20 16:00:28 +0900513 rc = pcim_enable_device(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 if (rc)
515 return rc;
516
Tejun Heob6d6c742007-09-21 17:55:44 +0900517 if (board_id == vt6420)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 bar_sizes = &svia_bar_sizes[0];
Tejun Heob6d6c742007-09-21 17:55:44 +0900519 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 bar_sizes = &vt6421_bar_sizes[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521
522 for (i = 0; i < ARRAY_SIZE(svia_bar_sizes); i++)
523 if ((pci_resource_start(pdev, i) == 0) ||
524 (pci_resource_len(pdev, i) < bar_sizes[i])) {
Jeff Garzika9524a72005-10-30 14:39:11 -0500525 dev_printk(KERN_ERR, &pdev->dev,
Greg Kroah-Hartmane29419f2006-06-12 15:20:16 -0700526 "invalid PCI BAR %u (sz 0x%llx, val 0x%llx)\n",
527 i,
528 (unsigned long long)pci_resource_start(pdev, i),
529 (unsigned long long)pci_resource_len(pdev, i));
Tejun Heo24dc5f32007-01-20 16:00:28 +0900530 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531 }
532
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533 if (board_id == vt6420)
Tejun Heoeca25dc2007-04-17 23:44:07 +0900534 rc = vt6420_prepare_host(pdev, &host);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 else
Tejun Heoeca25dc2007-04-17 23:44:07 +0900536 rc = vt6421_prepare_host(pdev, &host);
537 if (rc)
538 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539
540 svia_configure(pdev);
541
542 pci_set_master(pdev);
Tejun Heoeca25dc2007-04-17 23:44:07 +0900543 return ata_host_activate(host, pdev->irq, ata_interrupt, IRQF_SHARED,
544 &svia_sht);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545}
546
547static int __init svia_init(void)
548{
Pavel Roskinb7887192006-08-10 18:13:18 +0900549 return pci_register_driver(&svia_pci_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550}
551
552static void __exit svia_exit(void)
553{
554 pci_unregister_driver(&svia_pci_driver);
555}
556
557module_init(svia_init);
558module_exit(svia_exit);