?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[AVR32] Clean up asm/sysreg.h
[linux-2.6/verdex.git] / drivers / ata / sata_nv.c
blob9d9670a9b117e67d3689b8f5b2a1aa4b586f9ac6
1 /*
2 * sata_nv.c - NVIDIA nForce SATA
3 *
4 * Copyright 2004 NVIDIA Corp. All rights reserved.
5 * Copyright 2004 Andrew Chew
6 *
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2, or (at your option)
11 * any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; see the file COPYING. If not, write to
20 * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
21 *
22 *
23 * libata documentation is available via 'make {ps|pdf}docs',
24 * as Documentation/DocBook/libata.*
25 *
26 * No hardware documentation available outside of NVIDIA.
27 * This driver programs the NVIDIA SATA controller in a similar
28 * fashion as with other PCI IDE BMDMA controllers, with a few
29 * NV-specific details such as register offsets, SATA phy location,
30 * hotplug info, etc.
31 *
32 * CK804/MCP04 controllers support an alternate programming interface
33 * similar to the ADMA specification (with some modifications).
34 * This allows the use of NCQ. Non-DMA-mapped ATA commands are still
35 * sent through the legacy interface.
36 *
37 */
38
39 #include <linux/kernel.h>
40 #include <linux/module.h>
41 #include <linux/pci.h>
42 #include <linux/init.h>
43 #include <linux/blkdev.h>
44 #include <linux/delay.h>
45 #include <linux/interrupt.h>
46 #include <linux/device.h>
47 #include <scsi/scsi_host.h>
48 #include <scsi/scsi_device.h>
49 #include <linux/libata.h>
50
51 #define DRV_NAME "sata_nv"
52 #define DRV_VERSION "3.3"
53
54 #define NV_ADMA_DMA_BOUNDARY 0xffffffffUL
55
56 enum {
57 NV_MMIO_BAR = 5,
58
59 NV_PORTS = 2,
60 NV_PIO_MASK = 0x1f,
61 NV_MWDMA_MASK = 0x07,
62 NV_UDMA_MASK = 0x7f,
63 NV_PORT0_SCR_REG_OFFSET = 0x00,
64 NV_PORT1_SCR_REG_OFFSET = 0x40,
65
66 /* INT_STATUS/ENABLE */
67 NV_INT_STATUS = 0x10,
68 NV_INT_ENABLE = 0x11,
69 NV_INT_STATUS_CK804 = 0x440,
70 NV_INT_ENABLE_CK804 = 0x441,
71
72 /* INT_STATUS/ENABLE bits */
73 NV_INT_DEV = 0x01,
74 NV_INT_PM = 0x02,
75 NV_INT_ADDED = 0x04,
76 NV_INT_REMOVED = 0x08,
77
78 NV_INT_PORT_SHIFT = 4, /* each port occupies 4 bits */
79
80 NV_INT_ALL = 0x0f,
81 NV_INT_MASK = NV_INT_DEV |
82 NV_INT_ADDED | NV_INT_REMOVED,
83
84 /* INT_CONFIG */
85 NV_INT_CONFIG = 0x12,
86 NV_INT_CONFIG_METHD = 0x01, // 0 = INT, 1 = SMI
87
88 // For PCI config register 20
89 NV_MCP_SATA_CFG_20 = 0x50,
90 NV_MCP_SATA_CFG_20_SATA_SPACE_EN = 0x04,
91 NV_MCP_SATA_CFG_20_PORT0_EN = (1 << 17),
92 NV_MCP_SATA_CFG_20_PORT1_EN = (1 << 16),
93 NV_MCP_SATA_CFG_20_PORT0_PWB_EN = (1 << 14),
94 NV_MCP_SATA_CFG_20_PORT1_PWB_EN = (1 << 12),
95
96 NV_ADMA_MAX_CPBS = 32,
97 NV_ADMA_CPB_SZ = 128,
98 NV_ADMA_APRD_SZ = 16,
99 NV_ADMA_SGTBL_LEN = (1024 - NV_ADMA_CPB_SZ) /
100 NV_ADMA_APRD_SZ,
101 NV_ADMA_SGTBL_TOTAL_LEN = NV_ADMA_SGTBL_LEN + 5,
102 NV_ADMA_SGTBL_SZ = NV_ADMA_SGTBL_LEN * NV_ADMA_APRD_SZ,
103 NV_ADMA_PORT_PRIV_DMA_SZ = NV_ADMA_MAX_CPBS *
104 (NV_ADMA_CPB_SZ + NV_ADMA_SGTBL_SZ),
105
106 /* BAR5 offset to ADMA general registers */
107 NV_ADMA_GEN = 0x400,
108 NV_ADMA_GEN_CTL = 0x00,
109 NV_ADMA_NOTIFIER_CLEAR = 0x30,
110
111 /* BAR5 offset to ADMA ports */
112 NV_ADMA_PORT = 0x480,
113
114 /* size of ADMA port register space */
115 NV_ADMA_PORT_SIZE = 0x100,
116
117 /* ADMA port registers */
118 NV_ADMA_CTL = 0x40,
119 NV_ADMA_CPB_COUNT = 0x42,
120 NV_ADMA_NEXT_CPB_IDX = 0x43,
121 NV_ADMA_STAT = 0x44,
122 NV_ADMA_CPB_BASE_LOW = 0x48,
123 NV_ADMA_CPB_BASE_HIGH = 0x4C,
124 NV_ADMA_APPEND = 0x50,
125 NV_ADMA_NOTIFIER = 0x68,
126 NV_ADMA_NOTIFIER_ERROR = 0x6C,
127
128 /* NV_ADMA_CTL register bits */
129 NV_ADMA_CTL_HOTPLUG_IEN = (1 << 0),
130 NV_ADMA_CTL_CHANNEL_RESET = (1 << 5),
131 NV_ADMA_CTL_GO = (1 << 7),
132 NV_ADMA_CTL_AIEN = (1 << 8),
133 NV_ADMA_CTL_READ_NON_COHERENT = (1 << 11),
134 NV_ADMA_CTL_WRITE_NON_COHERENT = (1 << 12),
135
136 /* CPB response flag bits */
137 NV_CPB_RESP_DONE = (1 << 0),
138 NV_CPB_RESP_ATA_ERR = (1 << 3),
139 NV_CPB_RESP_CMD_ERR = (1 << 4),
140 NV_CPB_RESP_CPB_ERR = (1 << 7),
141
142 /* CPB control flag bits */
143 NV_CPB_CTL_CPB_VALID = (1 << 0),
144 NV_CPB_CTL_QUEUE = (1 << 1),
145 NV_CPB_CTL_APRD_VALID = (1 << 2),
146 NV_CPB_CTL_IEN = (1 << 3),
147 NV_CPB_CTL_FPDMA = (1 << 4),
148
149 /* APRD flags */
150 NV_APRD_WRITE = (1 << 1),
151 NV_APRD_END = (1 << 2),
152 NV_APRD_CONT = (1 << 3),
153
154 /* NV_ADMA_STAT flags */
155 NV_ADMA_STAT_TIMEOUT = (1 << 0),
156 NV_ADMA_STAT_HOTUNPLUG = (1 << 1),
157 NV_ADMA_STAT_HOTPLUG = (1 << 2),
158 NV_ADMA_STAT_CPBERR = (1 << 4),
159 NV_ADMA_STAT_SERROR = (1 << 5),
160 NV_ADMA_STAT_CMD_COMPLETE = (1 << 6),
161 NV_ADMA_STAT_IDLE = (1 << 8),
162 NV_ADMA_STAT_LEGACY = (1 << 9),
163 NV_ADMA_STAT_STOPPED = (1 << 10),
164 NV_ADMA_STAT_DONE = (1 << 12),
165 NV_ADMA_STAT_ERR = NV_ADMA_STAT_CPBERR |
166 NV_ADMA_STAT_TIMEOUT,
167
168 /* port flags */
169 NV_ADMA_PORT_REGISTER_MODE = (1 << 0),
170 NV_ADMA_ATAPI_SETUP_COMPLETE = (1 << 1),
171
172 };
173
174 /* ADMA Physical Region Descriptor - one SG segment */
175 struct nv_adma_prd {
176 __le64 addr;
177 __le32 len;
178 u8 flags;
179 u8 packet_len;
180 __le16 reserved;
181 };
182
183 enum nv_adma_regbits {
184 CMDEND = (1 << 15), /* end of command list */
185 WNB = (1 << 14), /* wait-not-BSY */
186 IGN = (1 << 13), /* ignore this entry */
187 CS1n = (1 << (4 + 8)), /* std. PATA signals follow... */
188 DA2 = (1 << (2 + 8)),
189 DA1 = (1 << (1 + 8)),
190 DA0 = (1 << (0 + 8)),
191 };
192
193 /* ADMA Command Parameter Block
194 The first 5 SG segments are stored inside the Command Parameter Block itself.
195 If there are more than 5 segments the remainder are stored in a separate
196 memory area indicated by next_aprd. */
197 struct nv_adma_cpb {
198 u8 resp_flags; /* 0 */
199 u8 reserved1; /* 1 */
200 u8 ctl_flags; /* 2 */
201 /* len is length of taskfile in 64 bit words */
202 u8 len; /* 3 */
203 u8 tag; /* 4 */
204 u8 next_cpb_idx; /* 5 */
205 __le16 reserved2; /* 6-7 */
206 __le16 tf[12]; /* 8-31 */
207 struct nv_adma_prd aprd[5]; /* 32-111 */
208 __le64 next_aprd; /* 112-119 */
209 __le64 reserved3; /* 120-127 */
210 };
211
212
213 struct nv_adma_port_priv {
214 struct nv_adma_cpb *cpb;
215 dma_addr_t cpb_dma;
216 struct nv_adma_prd *aprd;
217 dma_addr_t aprd_dma;
218 void __iomem * ctl_block;
219 void __iomem * gen_block;
220 void __iomem * notifier_clear_block;
221 u8 flags;
222 int last_issue_ncq;
223 };
224
225 struct nv_host_priv {
226 unsigned long type;
227 };
228
229 #define NV_ADMA_CHECK_INTR(GCTL, PORT) ((GCTL) & ( 1 << (19 + (12 * (PORT)))))
230
231 static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent);
232 static void nv_remove_one (struct pci_dev *pdev);
233 #ifdef CONFIG_PM
234 static int nv_pci_device_resume(struct pci_dev *pdev);
235 #endif
236 static void nv_ck804_host_stop(struct ata_host *host);
237 static irqreturn_t nv_generic_interrupt(int irq, void *dev_instance);
238 static irqreturn_t nv_nf2_interrupt(int irq, void *dev_instance);
239 static irqreturn_t nv_ck804_interrupt(int irq, void *dev_instance);
240 static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg);
241 static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val);
242
243 static void nv_nf2_freeze(struct ata_port *ap);
244 static void nv_nf2_thaw(struct ata_port *ap);
245 static void nv_ck804_freeze(struct ata_port *ap);
246 static void nv_ck804_thaw(struct ata_port *ap);
247 static void nv_error_handler(struct ata_port *ap);
248 static int nv_adma_slave_config(struct scsi_device *sdev);
249 static int nv_adma_check_atapi_dma(struct ata_queued_cmd *qc);
250 static void nv_adma_qc_prep(struct ata_queued_cmd *qc);
251 static unsigned int nv_adma_qc_issue(struct ata_queued_cmd *qc);
252 static irqreturn_t nv_adma_interrupt(int irq, void *dev_instance);
253 static void nv_adma_irq_clear(struct ata_port *ap);
254 static int nv_adma_port_start(struct ata_port *ap);
255 static void nv_adma_port_stop(struct ata_port *ap);
256 #ifdef CONFIG_PM
257 static int nv_adma_port_suspend(struct ata_port *ap, pm_message_t mesg);
258 static int nv_adma_port_resume(struct ata_port *ap);
259 #endif
260 static void nv_adma_error_handler(struct ata_port *ap);
261 static void nv_adma_host_stop(struct ata_host *host);
262 static void nv_adma_post_internal_cmd(struct ata_queued_cmd *qc);
263
264 enum nv_host_type
265 {
266 GENERIC,
267 NFORCE2,
268 NFORCE3 = NFORCE2, /* NF2 == NF3 as far as sata_nv is concerned */
269 CK804,
270 ADMA
271 };
272
273 static const struct pci_device_id nv_pci_tbl[] = {
274 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2S_SATA), NFORCE2 },
275 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA), NFORCE3 },
276 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA2), NFORCE3 },
277 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA), CK804 },
278 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA2), CK804 },
279 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA), CK804 },
280 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA2), CK804 },
281 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA), GENERIC },
282 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA2), GENERIC },
283 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA), GENERIC },
284 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA2), GENERIC },
285 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA), GENERIC },
286 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA2), GENERIC },
287 { PCI_VDEVICE(NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA3), GENERIC },
288 { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
289 PCI_ANY_ID, PCI_ANY_ID,
290 PCI_CLASS_STORAGE_IDE<<8, 0xffff00, GENERIC },
291 { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
292 PCI_ANY_ID, PCI_ANY_ID,
293 PCI_CLASS_STORAGE_RAID<<8, 0xffff00, GENERIC },
294
295 { } /* terminate list */
296 };
297
298 static struct pci_driver nv_pci_driver = {
299 .name = DRV_NAME,
300 .id_table = nv_pci_tbl,
301 .probe = nv_init_one,
302 #ifdef CONFIG_PM
303 .suspend = ata_pci_device_suspend,
304 .resume = nv_pci_device_resume,
305 #endif
306 .remove = nv_remove_one,
307 };
308
309 static struct scsi_host_template nv_sht = {
310 .module = THIS_MODULE,
311 .name = DRV_NAME,
312 .ioctl = ata_scsi_ioctl,
313 .queuecommand = ata_scsi_queuecmd,
314 .can_queue = ATA_DEF_QUEUE,
315 .this_id = ATA_SHT_THIS_ID,
316 .sg_tablesize = LIBATA_MAX_PRD,
317 .cmd_per_lun = ATA_SHT_CMD_PER_LUN,
318 .emulated = ATA_SHT_EMULATED,
319 .use_clustering = ATA_SHT_USE_CLUSTERING,
320 .proc_name = DRV_NAME,
321 .dma_boundary = ATA_DMA_BOUNDARY,
322 .slave_configure = ata_scsi_slave_config,
323 .slave_destroy = ata_scsi_slave_destroy,
324 .bios_param = ata_std_bios_param,
325 #ifdef CONFIG_PM
326 .suspend = ata_scsi_device_suspend,
327 .resume = ata_scsi_device_resume,
328 #endif
329 };
330
331 static struct scsi_host_template nv_adma_sht = {
332 .module = THIS_MODULE,
333 .name = DRV_NAME,
334 .ioctl = ata_scsi_ioctl,
335 .queuecommand = ata_scsi_queuecmd,
336 .can_queue = NV_ADMA_MAX_CPBS,
337 .this_id = ATA_SHT_THIS_ID,
338 .sg_tablesize = NV_ADMA_SGTBL_TOTAL_LEN,
339 .cmd_per_lun = ATA_SHT_CMD_PER_LUN,
340 .emulated = ATA_SHT_EMULATED,
341 .use_clustering = ATA_SHT_USE_CLUSTERING,
342 .proc_name = DRV_NAME,
343 .dma_boundary = NV_ADMA_DMA_BOUNDARY,
344 .slave_configure = nv_adma_slave_config,
345 .slave_destroy = ata_scsi_slave_destroy,
346 .bios_param = ata_std_bios_param,
347 #ifdef CONFIG_PM
348 .suspend = ata_scsi_device_suspend,
349 .resume = ata_scsi_device_resume,
350 #endif
351 };
352
353 static const struct ata_port_operations nv_generic_ops = {
354 .port_disable = ata_port_disable,
355 .tf_load = ata_tf_load,
356 .tf_read = ata_tf_read,
357 .exec_command = ata_exec_command,
358 .check_status = ata_check_status,
359 .dev_select = ata_std_dev_select,
360 .bmdma_setup = ata_bmdma_setup,
361 .bmdma_start = ata_bmdma_start,
362 .bmdma_stop = ata_bmdma_stop,
363 .bmdma_status = ata_bmdma_status,
364 .qc_prep = ata_qc_prep,
365 .qc_issue = ata_qc_issue_prot,
366 .freeze = ata_bmdma_freeze,
367 .thaw = ata_bmdma_thaw,
368 .error_handler = nv_error_handler,
369 .post_internal_cmd = ata_bmdma_post_internal_cmd,
370 .data_xfer = ata_data_xfer,
371 .irq_handler = nv_generic_interrupt,
372 .irq_clear = ata_bmdma_irq_clear,
373 .irq_on = ata_irq_on,
374 .irq_ack = ata_irq_ack,
375 .scr_read = nv_scr_read,
376 .scr_write = nv_scr_write,
377 .port_start = ata_port_start,
378 };
379
380 static const struct ata_port_operations nv_nf2_ops = {
381 .port_disable = ata_port_disable,
382 .tf_load = ata_tf_load,
383 .tf_read = ata_tf_read,
384 .exec_command = ata_exec_command,
385 .check_status = ata_check_status,
386 .dev_select = ata_std_dev_select,
387 .bmdma_setup = ata_bmdma_setup,
388 .bmdma_start = ata_bmdma_start,
389 .bmdma_stop = ata_bmdma_stop,
390 .bmdma_status = ata_bmdma_status,
391 .qc_prep = ata_qc_prep,
392 .qc_issue = ata_qc_issue_prot,
393 .freeze = nv_nf2_freeze,
394 .thaw = nv_nf2_thaw,
395 .error_handler = nv_error_handler,
396 .post_internal_cmd = ata_bmdma_post_internal_cmd,
397 .data_xfer = ata_data_xfer,
398 .irq_handler = nv_nf2_interrupt,
399 .irq_clear = ata_bmdma_irq_clear,
400 .irq_on = ata_irq_on,
401 .irq_ack = ata_irq_ack,
402 .scr_read = nv_scr_read,
403 .scr_write = nv_scr_write,
404 .port_start = ata_port_start,
405 };
406
407 static const struct ata_port_operations nv_ck804_ops = {
408 .port_disable = ata_port_disable,
409 .tf_load = ata_tf_load,
410 .tf_read = ata_tf_read,
411 .exec_command = ata_exec_command,
412 .check_status = ata_check_status,
413 .dev_select = ata_std_dev_select,
414 .bmdma_setup = ata_bmdma_setup,
415 .bmdma_start = ata_bmdma_start,
416 .bmdma_stop = ata_bmdma_stop,
417 .bmdma_status = ata_bmdma_status,
418 .qc_prep = ata_qc_prep,
419 .qc_issue = ata_qc_issue_prot,
420 .freeze = nv_ck804_freeze,
421 .thaw = nv_ck804_thaw,
422 .error_handler = nv_error_handler,
423 .post_internal_cmd = ata_bmdma_post_internal_cmd,
424 .data_xfer = ata_data_xfer,
425 .irq_handler = nv_ck804_interrupt,
426 .irq_clear = ata_bmdma_irq_clear,
427 .irq_on = ata_irq_on,
428 .irq_ack = ata_irq_ack,
429 .scr_read = nv_scr_read,
430 .scr_write = nv_scr_write,
431 .port_start = ata_port_start,
432 .host_stop = nv_ck804_host_stop,
433 };
434
435 static const struct ata_port_operations nv_adma_ops = {
436 .port_disable = ata_port_disable,
437 .tf_load = ata_tf_load,
438 .tf_read = ata_tf_read,
439 .check_atapi_dma = nv_adma_check_atapi_dma,
440 .exec_command = ata_exec_command,
441 .check_status = ata_check_status,
442 .dev_select = ata_std_dev_select,
443 .bmdma_setup = ata_bmdma_setup,
444 .bmdma_start = ata_bmdma_start,
445 .bmdma_stop = ata_bmdma_stop,
446 .bmdma_status = ata_bmdma_status,
447 .qc_prep = nv_adma_qc_prep,
448 .qc_issue = nv_adma_qc_issue,
449 .freeze = nv_ck804_freeze,
450 .thaw = nv_ck804_thaw,
451 .error_handler = nv_adma_error_handler,
452 .post_internal_cmd = nv_adma_post_internal_cmd,
453 .data_xfer = ata_data_xfer,
454 .irq_handler = nv_adma_interrupt,
455 .irq_clear = nv_adma_irq_clear,
456 .irq_on = ata_irq_on,
457 .irq_ack = ata_irq_ack,
458 .scr_read = nv_scr_read,
459 .scr_write = nv_scr_write,
460 .port_start = nv_adma_port_start,
461 .port_stop = nv_adma_port_stop,
462 #ifdef CONFIG_PM
463 .port_suspend = nv_adma_port_suspend,
464 .port_resume = nv_adma_port_resume,
465 #endif
466 .host_stop = nv_adma_host_stop,
467 };
468
469 static struct ata_port_info nv_port_info[] = {
470 /* generic */
471 {
472 .sht = &nv_sht,
473 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
474 ATA_FLAG_HRST_TO_RESUME,
475 .pio_mask = NV_PIO_MASK,
476 .mwdma_mask = NV_MWDMA_MASK,
477 .udma_mask = NV_UDMA_MASK,
478 .port_ops = &nv_generic_ops,
479 },
480 /* nforce2/3 */
481 {
482 .sht = &nv_sht,
483 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
484 ATA_FLAG_HRST_TO_RESUME,
485 .pio_mask = NV_PIO_MASK,
486 .mwdma_mask = NV_MWDMA_MASK,
487 .udma_mask = NV_UDMA_MASK,
488 .port_ops = &nv_nf2_ops,
489 },
490 /* ck804 */
491 {
492 .sht = &nv_sht,
493 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
494 ATA_FLAG_HRST_TO_RESUME,
495 .pio_mask = NV_PIO_MASK,
496 .mwdma_mask = NV_MWDMA_MASK,
497 .udma_mask = NV_UDMA_MASK,
498 .port_ops = &nv_ck804_ops,
499 },
500 /* ADMA */
501 {
502 .sht = &nv_adma_sht,
503 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
504 ATA_FLAG_HRST_TO_RESUME |
505 ATA_FLAG_MMIO | ATA_FLAG_NCQ,
506 .pio_mask = NV_PIO_MASK,
507 .mwdma_mask = NV_MWDMA_MASK,
508 .udma_mask = NV_UDMA_MASK,
509 .port_ops = &nv_adma_ops,
510 },
511 };
512
513 MODULE_AUTHOR("NVIDIA");
514 MODULE_DESCRIPTION("low-level driver for NVIDIA nForce SATA controller");
515 MODULE_LICENSE("GPL");
516 MODULE_DEVICE_TABLE(pci, nv_pci_tbl);
517 MODULE_VERSION(DRV_VERSION);
518
519 static int adma_enabled = 1;
520
521 static void nv_adma_register_mode(struct ata_port *ap)
522 {
523 struct nv_adma_port_priv *pp = ap->private_data;
524 void __iomem *mmio = pp->ctl_block;
525 u16 tmp, status;
526 int count = 0;
527
528 if (pp->flags & NV_ADMA_PORT_REGISTER_MODE)
529 return;
530
531 status = readw(mmio + NV_ADMA_STAT);
532 while(!(status & NV_ADMA_STAT_IDLE) && count < 20) {
533 ndelay(50);
534 status = readw(mmio + NV_ADMA_STAT);
535 count++;
536 }
537 if(count == 20)
538 ata_port_printk(ap, KERN_WARNING,
539 "timeout waiting for ADMA IDLE, stat=0x%hx\n",
540 status);
541
542 tmp = readw(mmio + NV_ADMA_CTL);
543 writew(tmp & ~NV_ADMA_CTL_GO, mmio + NV_ADMA_CTL);
544
545 count = 0;
546 status = readw(mmio + NV_ADMA_STAT);
547 while(!(status & NV_ADMA_STAT_LEGACY) && count < 20) {
548 ndelay(50);
549 status = readw(mmio + NV_ADMA_STAT);
550 count++;
551 }
552 if(count == 20)
553 ata_port_printk(ap, KERN_WARNING,
554 "timeout waiting for ADMA LEGACY, stat=0x%hx\n",
555 status);
556
557 pp->flags |= NV_ADMA_PORT_REGISTER_MODE;
558 }
559
560 static void nv_adma_mode(struct ata_port *ap)
561 {
562 struct nv_adma_port_priv *pp = ap->private_data;
563 void __iomem *mmio = pp->ctl_block;
564 u16 tmp, status;
565 int count = 0;
566
567 if (!(pp->flags & NV_ADMA_PORT_REGISTER_MODE))
568 return;
569
570 WARN_ON(pp->flags & NV_ADMA_ATAPI_SETUP_COMPLETE);
571
572 tmp = readw(mmio + NV_ADMA_CTL);
573 writew(tmp | NV_ADMA_CTL_GO, mmio + NV_ADMA_CTL);
574
575 status = readw(mmio + NV_ADMA_STAT);
576 while(((status & NV_ADMA_STAT_LEGACY) ||
577 !(status & NV_ADMA_STAT_IDLE)) && count < 20) {
578 ndelay(50);
579 status = readw(mmio + NV_ADMA_STAT);
580 count++;
581 }
582 if(count == 20)
583 ata_port_printk(ap, KERN_WARNING,
584 "timeout waiting for ADMA LEGACY clear and IDLE, stat=0x%hx\n",
585 status);
586
587 pp->flags &= ~NV_ADMA_PORT_REGISTER_MODE;
588 }
589
590 static int nv_adma_slave_config(struct scsi_device *sdev)
591 {
592 struct ata_port *ap = ata_shost_to_port(sdev->host);
593 struct nv_adma_port_priv *pp = ap->private_data;
594 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
595 u64 bounce_limit;
596 unsigned long segment_boundary;
597 unsigned short sg_tablesize;
598 int rc;
599 int adma_enable;
600 u32 current_reg, new_reg, config_mask;
601
602 rc = ata_scsi_slave_config(sdev);
603
604 if (sdev->id >= ATA_MAX_DEVICES || sdev->channel || sdev->lun)
605 /* Not a proper libata device, ignore */
606 return rc;
607
608 if (ap->device[sdev->id].class == ATA_DEV_ATAPI) {
609 /*
610 * NVIDIA reports that ADMA mode does not support ATAPI commands.
611 * Therefore ATAPI commands are sent through the legacy interface.
612 * However, the legacy interface only supports 32-bit DMA.
613 * Restrict DMA parameters as required by the legacy interface
614 * when an ATAPI device is connected.
615 */
616 bounce_limit = ATA_DMA_MASK;
617 segment_boundary = ATA_DMA_BOUNDARY;
618 /* Subtract 1 since an extra entry may be needed for padding, see
619 libata-scsi.c */
620 sg_tablesize = LIBATA_MAX_PRD - 1;
621
622 /* Since the legacy DMA engine is in use, we need to disable ADMA
623 on the port. */
624 adma_enable = 0;
625 nv_adma_register_mode(ap);
626 }
627 else {
628 bounce_limit = *ap->dev->dma_mask;
629 segment_boundary = NV_ADMA_DMA_BOUNDARY;
630 sg_tablesize = NV_ADMA_SGTBL_TOTAL_LEN;
631 adma_enable = 1;
632 }
633
634 pci_read_config_dword(pdev, NV_MCP_SATA_CFG_20, &current_reg);
635
636 if(ap->port_no == 1)
637 config_mask = NV_MCP_SATA_CFG_20_PORT1_EN |
638 NV_MCP_SATA_CFG_20_PORT1_PWB_EN;
639 else
640 config_mask = NV_MCP_SATA_CFG_20_PORT0_EN |
641 NV_MCP_SATA_CFG_20_PORT0_PWB_EN;
642
643 if(adma_enable) {
644 new_reg = current_reg | config_mask;
645 pp->flags &= ~NV_ADMA_ATAPI_SETUP_COMPLETE;
646 }
647 else {
648 new_reg = current_reg & ~config_mask;
649 pp->flags |= NV_ADMA_ATAPI_SETUP_COMPLETE;
650 }
651
652 if(current_reg != new_reg)
653 pci_write_config_dword(pdev, NV_MCP_SATA_CFG_20, new_reg);
654
655 blk_queue_bounce_limit(sdev->request_queue, bounce_limit);
656 blk_queue_segment_boundary(sdev->request_queue, segment_boundary);
657 blk_queue_max_hw_segments(sdev->request_queue, sg_tablesize);
658 ata_port_printk(ap, KERN_INFO,
659 "bounce limit 0x%llX, segment boundary 0x%lX, hw segs %hu\n",
660 (unsigned long long)bounce_limit, segment_boundary, sg_tablesize);
661 return rc;
662 }
663
664 static int nv_adma_check_atapi_dma(struct ata_queued_cmd *qc)
665 {
666 struct nv_adma_port_priv *pp = qc->ap->private_data;
667 return !(pp->flags & NV_ADMA_ATAPI_SETUP_COMPLETE);
668 }
669
670 static unsigned int nv_adma_tf_to_cpb(struct ata_taskfile *tf, __le16 *cpb)
671 {
672 unsigned int idx = 0;
673
674 if(tf->flags & ATA_TFLAG_ISADDR) {
675 if (tf->flags & ATA_TFLAG_LBA48) {
676 cpb[idx++] = cpu_to_le16((ATA_REG_ERR << 8) | tf->hob_feature | WNB);
677 cpb[idx++] = cpu_to_le16((ATA_REG_NSECT << 8) | tf->hob_nsect);
678 cpb[idx++] = cpu_to_le16((ATA_REG_LBAL << 8) | tf->hob_lbal);
679 cpb[idx++] = cpu_to_le16((ATA_REG_LBAM << 8) | tf->hob_lbam);
680 cpb[idx++] = cpu_to_le16((ATA_REG_LBAH << 8) | tf->hob_lbah);
681 cpb[idx++] = cpu_to_le16((ATA_REG_ERR << 8) | tf->feature);
682 } else
683 cpb[idx++] = cpu_to_le16((ATA_REG_ERR << 8) | tf->feature | WNB);
684
685 cpb[idx++] = cpu_to_le16((ATA_REG_NSECT << 8) | tf->nsect);
686 cpb[idx++] = cpu_to_le16((ATA_REG_LBAL << 8) | tf->lbal);
687 cpb[idx++] = cpu_to_le16((ATA_REG_LBAM << 8) | tf->lbam);
688 cpb[idx++] = cpu_to_le16((ATA_REG_LBAH << 8) | tf->lbah);
689 }
690
691 if(tf->flags & ATA_TFLAG_DEVICE)
692 cpb[idx++] = cpu_to_le16((ATA_REG_DEVICE << 8) | tf->device);
693
694 cpb[idx++] = cpu_to_le16((ATA_REG_CMD << 8) | tf->command | CMDEND);
695
696 while(idx < 12)
697 cpb[idx++] = cpu_to_le16(IGN);
698
699 return idx;
700 }
701
702 static int nv_adma_check_cpb(struct ata_port *ap, int cpb_num, int force_err)
703 {
704 struct nv_adma_port_priv *pp = ap->private_data;
705 u8 flags = pp->cpb[cpb_num].resp_flags;
706
707 VPRINTK("CPB %d, flags=0x%x\n", cpb_num, flags);
708
709 if (unlikely((force_err ||
710 flags & (NV_CPB_RESP_ATA_ERR |
711 NV_CPB_RESP_CMD_ERR |
712 NV_CPB_RESP_CPB_ERR)))) {
713 struct ata_eh_info *ehi = &ap->eh_info;
714 int freeze = 0;
715
716 ata_ehi_clear_desc(ehi);
717 ata_ehi_push_desc(ehi, "CPB resp_flags 0x%x", flags );
718 if (flags & NV_CPB_RESP_ATA_ERR) {
719 ata_ehi_push_desc(ehi, ": ATA error");
720 ehi->err_mask |= AC_ERR_DEV;
721 } else if (flags & NV_CPB_RESP_CMD_ERR) {
722 ata_ehi_push_desc(ehi, ": CMD error");
723 ehi->err_mask |= AC_ERR_DEV;
724 } else if (flags & NV_CPB_RESP_CPB_ERR) {
725 ata_ehi_push_desc(ehi, ": CPB error");
726 ehi->err_mask |= AC_ERR_SYSTEM;
727 freeze = 1;
728 } else {
729 /* notifier error, but no error in CPB flags? */
730 ehi->err_mask |= AC_ERR_OTHER;
731 freeze = 1;
732 }
733 /* Kill all commands. EH will determine what actually failed. */
734 if (freeze)
735 ata_port_freeze(ap);
736 else
737 ata_port_abort(ap);
738 return 1;
739 }
740
741 if (flags & NV_CPB_RESP_DONE) {
742 struct ata_queued_cmd *qc = ata_qc_from_tag(ap, cpb_num);
743 VPRINTK("CPB flags done, flags=0x%x\n", flags);
744 if (likely(qc)) {
745 /* Grab the ATA port status for non-NCQ commands.
746 For NCQ commands the current status may have nothing to do with
747 the command just completed. */
748 if (qc->tf.protocol != ATA_PROT_NCQ) {
749 u8 ata_status = readb(pp->ctl_block + (ATA_REG_STATUS * 4));
750 qc->err_mask |= ac_err_mask(ata_status);
751 }
752 DPRINTK("Completing qc from tag %d with err_mask %u\n",cpb_num,
753 qc->err_mask);
754 ata_qc_complete(qc);
755 } else {
756 struct ata_eh_info *ehi = &ap->eh_info;
757 /* Notifier bits set without a command may indicate the drive
758 is misbehaving. Raise host state machine violation on this
759 condition. */
760 ata_port_printk(ap, KERN_ERR, "notifier for tag %d with no command?\n",
761 cpb_num);
762 ehi->err_mask |= AC_ERR_HSM;
763 ehi->action |= ATA_EH_SOFTRESET;
764 ata_port_freeze(ap);
765 return 1;
766 }
767 }
768 return 0;
769 }
770
771 static int nv_host_intr(struct ata_port *ap, u8 irq_stat)
772 {
773 struct ata_queued_cmd *qc = ata_qc_from_tag(ap, ap->active_tag);
774
775 /* freeze if hotplugged */
776 if (unlikely(irq_stat & (NV_INT_ADDED | NV_INT_REMOVED))) {
777 ata_port_freeze(ap);
778 return 1;
779 }
780
781 /* bail out if not our interrupt */
782 if (!(irq_stat & NV_INT_DEV))
783 return 0;
784
785 /* DEV interrupt w/ no active qc? */
786 if (unlikely(!qc || (qc->tf.flags & ATA_TFLAG_POLLING))) {
787 ata_check_status(ap);
788 return 1;
789 }
790
791 /* handle interrupt */
792 return ata_host_intr(ap, qc);
793 }
794
795 static irqreturn_t nv_adma_interrupt(int irq, void *dev_instance)
796 {
797 struct ata_host *host = dev_instance;
798 int i, handled = 0;
799 u32 notifier_clears[2];
800
801 spin_lock(&host->lock);
802
803 for (i = 0; i < host->n_ports; i++) {
804 struct ata_port *ap = host->ports[i];
805 notifier_clears[i] = 0;
806
807 if (ap && !(ap->flags & ATA_FLAG_DISABLED)) {
808 struct nv_adma_port_priv *pp = ap->private_data;
809 void __iomem *mmio = pp->ctl_block;
810 u16 status;
811 u32 gen_ctl;
812 u32 notifier, notifier_error;
813
814 /* if in ATA register mode, use standard ata interrupt handler */
815 if (pp->flags & NV_ADMA_PORT_REGISTER_MODE) {
816 u8 irq_stat = readb(host->iomap[NV_MMIO_BAR] + NV_INT_STATUS_CK804)
817 >> (NV_INT_PORT_SHIFT * i);
818 if(ata_tag_valid(ap->active_tag))
819 /** NV_INT_DEV indication seems unreliable at times
820 at least in ADMA mode. Force it on always when a
821 command is active, to prevent losing interrupts. */
822 irq_stat |= NV_INT_DEV;
823 handled += nv_host_intr(ap, irq_stat);
824 continue;
825 }
826
827 notifier = readl(mmio + NV_ADMA_NOTIFIER);
828 notifier_error = readl(mmio + NV_ADMA_NOTIFIER_ERROR);
829 notifier_clears[i] = notifier | notifier_error;
830
831 gen_ctl = readl(pp->gen_block + NV_ADMA_GEN_CTL);
832
833 if( !NV_ADMA_CHECK_INTR(gen_ctl, ap->port_no) && !notifier &&
834 !notifier_error)
835 /* Nothing to do */
836 continue;
837
838 status = readw(mmio + NV_ADMA_STAT);
839
840 /* Clear status. Ensure the controller sees the clearing before we start
841 looking at any of the CPB statuses, so that any CPB completions after
842 this point in the handler will raise another interrupt. */
843 writew(status, mmio + NV_ADMA_STAT);
844 readw(mmio + NV_ADMA_STAT); /* flush posted write */
845 rmb();
846
847 handled++; /* irq handled if we got here */
848
849 /* freeze if hotplugged or controller error */
850 if (unlikely(status & (NV_ADMA_STAT_HOTPLUG |
851 NV_ADMA_STAT_HOTUNPLUG |
852 NV_ADMA_STAT_TIMEOUT |
853 NV_ADMA_STAT_SERROR))) {
854 struct ata_eh_info *ehi = &ap->eh_info;
855
856 ata_ehi_clear_desc(ehi);
857 ata_ehi_push_desc(ehi, "ADMA status 0x%08x", status );
858 if (status & NV_ADMA_STAT_TIMEOUT) {
859 ehi->err_mask |= AC_ERR_SYSTEM;
860 ata_ehi_push_desc(ehi, ": timeout");
861 } else if (status & NV_ADMA_STAT_HOTPLUG) {
862 ata_ehi_hotplugged(ehi);
863 ata_ehi_push_desc(ehi, ": hotplug");
864 } else if (status & NV_ADMA_STAT_HOTUNPLUG) {
865 ata_ehi_hotplugged(ehi);
866 ata_ehi_push_desc(ehi, ": hot unplug");
867 } else if (status & NV_ADMA_STAT_SERROR) {
868 /* let libata analyze SError and figure out the cause */
869 ata_ehi_push_desc(ehi, ": SError");
870 }
871 ata_port_freeze(ap);
872 continue;
873 }
874
875 if (status & (NV_ADMA_STAT_DONE |
876 NV_ADMA_STAT_CPBERR)) {
877 u32 check_commands;
878 int pos, error = 0;
879
880 if(ata_tag_valid(ap->active_tag))
881 check_commands = 1 << ap->active_tag;
882 else
883 check_commands = ap->sactive;
884
885 /** Check CPBs for completed commands */
886 while ((pos = ffs(check_commands)) && !error) {
887 pos--;
888 error = nv_adma_check_cpb(ap, pos,
889 notifier_error & (1 << pos) );
890 check_commands &= ~(1 << pos );
891 }
892 }
893 }
894 }
895
896 if(notifier_clears[0] || notifier_clears[1]) {
897 /* Note: Both notifier clear registers must be written
898 if either is set, even if one is zero, according to NVIDIA. */
899 struct nv_adma_port_priv *pp = host->ports[0]->private_data;
900 writel(notifier_clears[0], pp->notifier_clear_block);
901 pp = host->ports[1]->private_data;
902 writel(notifier_clears[1], pp->notifier_clear_block);
903 }
904
905 spin_unlock(&host->lock);
906
907 return IRQ_RETVAL(handled);
908 }
909
910 static void nv_adma_irq_clear(struct ata_port *ap)
911 {
912 struct nv_adma_port_priv *pp = ap->private_data;
913 void __iomem *mmio = pp->ctl_block;
914 u16 status = readw(mmio + NV_ADMA_STAT);
915 u32 notifier = readl(mmio + NV_ADMA_NOTIFIER);
916 u32 notifier_error = readl(mmio + NV_ADMA_NOTIFIER_ERROR);
917 void __iomem *dma_stat_addr = ap->ioaddr.bmdma_addr + ATA_DMA_STATUS;
918
919 /* clear ADMA status */
920 writew(status, mmio + NV_ADMA_STAT);
921 writel(notifier | notifier_error,
922 pp->notifier_clear_block);
923
924 /** clear legacy status */
925 iowrite8(ioread8(dma_stat_addr), dma_stat_addr);
926 }
927
928 static void nv_adma_post_internal_cmd(struct ata_queued_cmd *qc)
929 {
930 struct nv_adma_port_priv *pp = qc->ap->private_data;
931
932 if(pp->flags & NV_ADMA_PORT_REGISTER_MODE)
933 ata_bmdma_post_internal_cmd(qc);
934 }
935
936 static int nv_adma_port_start(struct ata_port *ap)
937 {
938 struct device *dev = ap->host->dev;
939 struct nv_adma_port_priv *pp;
940 int rc;
941 void *mem;
942 dma_addr_t mem_dma;
943 void __iomem *mmio;
944 u16 tmp;
945
946 VPRINTK("ENTER\n");
947
948 rc = ata_port_start(ap);
949 if (rc)
950 return rc;
951
952 pp = devm_kzalloc(dev, sizeof(*pp), GFP_KERNEL);
953 if (!pp)
954 return -ENOMEM;
955
956 mmio = ap->host->iomap[NV_MMIO_BAR] + NV_ADMA_PORT +
957 ap->port_no * NV_ADMA_PORT_SIZE;
958 pp->ctl_block = mmio;
959 pp->gen_block = ap->host->iomap[NV_MMIO_BAR] + NV_ADMA_GEN;
960 pp->notifier_clear_block = pp->gen_block +
961 NV_ADMA_NOTIFIER_CLEAR + (4 * ap->port_no);
962
963 mem = dmam_alloc_coherent(dev, NV_ADMA_PORT_PRIV_DMA_SZ,
964 &mem_dma, GFP_KERNEL);
965 if (!mem)
966 return -ENOMEM;
967 memset(mem, 0, NV_ADMA_PORT_PRIV_DMA_SZ);
968
969 /*
970 * First item in chunk of DMA memory:
971 * 128-byte command parameter block (CPB)
972 * one for each command tag
973 */
974 pp->cpb = mem;
975 pp->cpb_dma = mem_dma;
976
977 writel(mem_dma & 0xFFFFFFFF, mmio + NV_ADMA_CPB_BASE_LOW);
978 writel((mem_dma >> 16 ) >> 16, mmio + NV_ADMA_CPB_BASE_HIGH);
979
980 mem += NV_ADMA_MAX_CPBS * NV_ADMA_CPB_SZ;
981 mem_dma += NV_ADMA_MAX_CPBS * NV_ADMA_CPB_SZ;
982
983 /*
984 * Second item: block of ADMA_SGTBL_LEN s/g entries
985 */
986 pp->aprd = mem;
987 pp->aprd_dma = mem_dma;
988
989 ap->private_data = pp;
990
991 /* clear any outstanding interrupt conditions */
992 writew(0xffff, mmio + NV_ADMA_STAT);
993
994 /* initialize port variables */
995 pp->flags = NV_ADMA_PORT_REGISTER_MODE;
996
997 /* clear CPB fetch count */
998 writew(0, mmio + NV_ADMA_CPB_COUNT);
999
1000 /* clear GO for register mode, enable interrupt */
1001 tmp = readw(mmio + NV_ADMA_CTL);
1002 writew( (tmp & ~NV_ADMA_CTL_GO) | NV_ADMA_CTL_AIEN |
1003 NV_ADMA_CTL_HOTPLUG_IEN, mmio + NV_ADMA_CTL);
1004
1005 tmp = readw(mmio + NV_ADMA_CTL);
1006 writew(tmp | NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1007 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1008 udelay(1);
1009 writew(tmp & ~NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1010 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1011
1012 return 0;
1013 }
1014
1015 static void nv_adma_port_stop(struct ata_port *ap)
1016 {
1017 struct nv_adma_port_priv *pp = ap->private_data;
1018 void __iomem *mmio = pp->ctl_block;
1019
1020 VPRINTK("ENTER\n");
1021 writew(0, mmio + NV_ADMA_CTL);
1022 }
1023
1024 #ifdef CONFIG_PM
1025 static int nv_adma_port_suspend(struct ata_port *ap, pm_message_t mesg)
1026 {
1027 struct nv_adma_port_priv *pp = ap->private_data;
1028 void __iomem *mmio = pp->ctl_block;
1029
1030 /* Go to register mode - clears GO */
1031 nv_adma_register_mode(ap);
1032
1033 /* clear CPB fetch count */
1034 writew(0, mmio + NV_ADMA_CPB_COUNT);
1035
1036 /* disable interrupt, shut down port */
1037 writew(0, mmio + NV_ADMA_CTL);
1038
1039 return 0;
1040 }
1041
1042 static int nv_adma_port_resume(struct ata_port *ap)
1043 {
1044 struct nv_adma_port_priv *pp = ap->private_data;
1045 void __iomem *mmio = pp->ctl_block;
1046 u16 tmp;
1047
1048 /* set CPB block location */
1049 writel(pp->cpb_dma & 0xFFFFFFFF, mmio + NV_ADMA_CPB_BASE_LOW);
1050 writel((pp->cpb_dma >> 16 ) >> 16, mmio + NV_ADMA_CPB_BASE_HIGH);
1051
1052 /* clear any outstanding interrupt conditions */
1053 writew(0xffff, mmio + NV_ADMA_STAT);
1054
1055 /* initialize port variables */
1056 pp->flags |= NV_ADMA_PORT_REGISTER_MODE;
1057
1058 /* clear CPB fetch count */
1059 writew(0, mmio + NV_ADMA_CPB_COUNT);
1060
1061 /* clear GO for register mode, enable interrupt */
1062 tmp = readw(mmio + NV_ADMA_CTL);
1063 writew( (tmp & ~NV_ADMA_CTL_GO) | NV_ADMA_CTL_AIEN |
1064 NV_ADMA_CTL_HOTPLUG_IEN, mmio + NV_ADMA_CTL);
1065
1066 tmp = readw(mmio + NV_ADMA_CTL);
1067 writew(tmp | NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1068 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1069 udelay(1);
1070 writew(tmp & ~NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1071 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1072
1073 return 0;
1074 }
1075 #endif
1076
1077 static void nv_adma_setup_port(struct ata_probe_ent *probe_ent, unsigned int port)
1078 {
1079 void __iomem *mmio = probe_ent->iomap[NV_MMIO_BAR];
1080 struct ata_ioports *ioport = &probe_ent->port[port];
1081
1082 VPRINTK("ENTER\n");
1083
1084 mmio += NV_ADMA_PORT + port * NV_ADMA_PORT_SIZE;
1085
1086 ioport->cmd_addr = mmio;
1087 ioport->data_addr = mmio + (ATA_REG_DATA * 4);
1088 ioport->error_addr =
1089 ioport->feature_addr = mmio + (ATA_REG_ERR * 4);
1090 ioport->nsect_addr = mmio + (ATA_REG_NSECT * 4);
1091 ioport->lbal_addr = mmio + (ATA_REG_LBAL * 4);
1092 ioport->lbam_addr = mmio + (ATA_REG_LBAM * 4);
1093 ioport->lbah_addr = mmio + (ATA_REG_LBAH * 4);
1094 ioport->device_addr = mmio + (ATA_REG_DEVICE * 4);
1095 ioport->status_addr =
1096 ioport->command_addr = mmio + (ATA_REG_STATUS * 4);
1097 ioport->altstatus_addr =
1098 ioport->ctl_addr = mmio + 0x20;
1099 }
1100
1101 static int nv_adma_host_init(struct ata_probe_ent *probe_ent)
1102 {
1103 struct pci_dev *pdev = to_pci_dev(probe_ent->dev);
1104 unsigned int i;
1105 u32 tmp32;
1106
1107 VPRINTK("ENTER\n");
1108
1109 /* enable ADMA on the ports */
1110 pci_read_config_dword(pdev, NV_MCP_SATA_CFG_20, &tmp32);
1111 tmp32 |= NV_MCP_SATA_CFG_20_PORT0_EN |
1112 NV_MCP_SATA_CFG_20_PORT0_PWB_EN |
1113 NV_MCP_SATA_CFG_20_PORT1_EN |
1114 NV_MCP_SATA_CFG_20_PORT1_PWB_EN;
1115
1116 pci_write_config_dword(pdev, NV_MCP_SATA_CFG_20, tmp32);
1117
1118 for (i = 0; i < probe_ent->n_ports; i++)
1119 nv_adma_setup_port(probe_ent, i);
1120
1121 return 0;
1122 }
1123
1124 static void nv_adma_fill_aprd(struct ata_queued_cmd *qc,
1125 struct scatterlist *sg,
1126 int idx,
1127 struct nv_adma_prd *aprd)
1128 {
1129 u8 flags = 0;
1130 if (qc->tf.flags & ATA_TFLAG_WRITE)
1131 flags |= NV_APRD_WRITE;
1132 if (idx == qc->n_elem - 1)
1133 flags |= NV_APRD_END;
1134 else if (idx != 4)
1135 flags |= NV_APRD_CONT;
1136
1137 aprd->addr = cpu_to_le64(((u64)sg_dma_address(sg)));
1138 aprd->len = cpu_to_le32(((u32)sg_dma_len(sg))); /* len in bytes */
1139 aprd->flags = flags;
1140 aprd->packet_len = 0;
1141 }
1142
1143 static void nv_adma_fill_sg(struct ata_queued_cmd *qc, struct nv_adma_cpb *cpb)
1144 {
1145 struct nv_adma_port_priv *pp = qc->ap->private_data;
1146 unsigned int idx;
1147 struct nv_adma_prd *aprd;
1148 struct scatterlist *sg;
1149
1150 VPRINTK("ENTER\n");
1151
1152 idx = 0;
1153
1154 ata_for_each_sg(sg, qc) {
1155 aprd = (idx < 5) ? &cpb->aprd[idx] : &pp->aprd[NV_ADMA_SGTBL_LEN * qc->tag + (idx-5)];
1156 nv_adma_fill_aprd(qc, sg, idx, aprd);
1157 idx++;
1158 }
1159 if (idx > 5)
1160 cpb->next_aprd = cpu_to_le64(((u64)(pp->aprd_dma + NV_ADMA_SGTBL_SZ * qc->tag)));
1161 else
1162 cpb->next_aprd = cpu_to_le64(0);
1163 }
1164
1165 static int nv_adma_use_reg_mode(struct ata_queued_cmd *qc)
1166 {
1167 struct nv_adma_port_priv *pp = qc->ap->private_data;
1168
1169 /* ADMA engine can only be used for non-ATAPI DMA commands,
1170 or interrupt-driven no-data commands. */
1171 if((pp->flags & NV_ADMA_ATAPI_SETUP_COMPLETE) ||
1172 (qc->tf.flags & ATA_TFLAG_POLLING))
1173 return 1;
1174
1175 if((qc->flags & ATA_QCFLAG_DMAMAP) ||
1176 (qc->tf.protocol == ATA_PROT_NODATA))
1177 return 0;
1178
1179 return 1;
1180 }
1181
1182 static void nv_adma_qc_prep(struct ata_queued_cmd *qc)
1183 {
1184 struct nv_adma_port_priv *pp = qc->ap->private_data;
1185 struct nv_adma_cpb *cpb = &pp->cpb[qc->tag];
1186 u8 ctl_flags = NV_CPB_CTL_CPB_VALID |
1187 NV_CPB_CTL_IEN;
1188
1189 if (nv_adma_use_reg_mode(qc)) {
1190 nv_adma_register_mode(qc->ap);
1191 ata_qc_prep(qc);
1192 return;
1193 }
1194
1195 cpb->resp_flags = NV_CPB_RESP_DONE;
1196 wmb();
1197 cpb->ctl_flags = 0;
1198 wmb();
1199
1200 cpb->len = 3;
1201 cpb->tag = qc->tag;
1202 cpb->next_cpb_idx = 0;
1203
1204 /* turn on NCQ flags for NCQ commands */
1205 if (qc->tf.protocol == ATA_PROT_NCQ)
1206 ctl_flags |= NV_CPB_CTL_QUEUE | NV_CPB_CTL_FPDMA;
1207
1208 VPRINTK("qc->flags = 0x%lx\n", qc->flags);
1209
1210 nv_adma_tf_to_cpb(&qc->tf, cpb->tf);
1211
1212 if(qc->flags & ATA_QCFLAG_DMAMAP) {
1213 nv_adma_fill_sg(qc, cpb);
1214 ctl_flags |= NV_CPB_CTL_APRD_VALID;
1215 } else
1216 memset(&cpb->aprd[0], 0, sizeof(struct nv_adma_prd) * 5);
1217
1218 /* Be paranoid and don't let the device see NV_CPB_CTL_CPB_VALID until we are
1219 finished filling in all of the contents */
1220 wmb();
1221 cpb->ctl_flags = ctl_flags;
1222 wmb();
1223 cpb->resp_flags = 0;
1224 }
1225
1226 static unsigned int nv_adma_qc_issue(struct ata_queued_cmd *qc)
1227 {
1228 struct nv_adma_port_priv *pp = qc->ap->private_data;
1229 void __iomem *mmio = pp->ctl_block;
1230 int curr_ncq = (qc->tf.protocol == ATA_PROT_NCQ);
1231
1232 VPRINTK("ENTER\n");
1233
1234 if (nv_adma_use_reg_mode(qc)) {
1235 /* use ATA register mode */
1236 VPRINTK("using ATA register mode: 0x%lx\n", qc->flags);
1237 nv_adma_register_mode(qc->ap);
1238 return ata_qc_issue_prot(qc);
1239 } else
1240 nv_adma_mode(qc->ap);
1241
1242 /* write append register, command tag in lower 8 bits
1243 and (number of cpbs to append -1) in top 8 bits */
1244 wmb();
1245
1246 if(curr_ncq != pp->last_issue_ncq) {
1247 /* Seems to need some delay before switching between NCQ and non-NCQ
1248 commands, else we get command timeouts and such. */
1249 udelay(20);
1250 pp->last_issue_ncq = curr_ncq;
1251 }
1252
1253 writew(qc->tag, mmio + NV_ADMA_APPEND);
1254
1255 DPRINTK("Issued tag %u\n",qc->tag);
1256
1257 return 0;
1258 }
1259
1260 static irqreturn_t nv_generic_interrupt(int irq, void *dev_instance)
1261 {
1262 struct ata_host *host = dev_instance;
1263 unsigned int i;
1264 unsigned int handled = 0;
1265 unsigned long flags;
1266
1267 spin_lock_irqsave(&host->lock, flags);
1268
1269 for (i = 0; i < host->n_ports; i++) {
1270 struct ata_port *ap;
1271
1272 ap = host->ports[i];
1273 if (ap &&
1274 !(ap->flags & ATA_FLAG_DISABLED)) {
1275 struct ata_queued_cmd *qc;
1276
1277 qc = ata_qc_from_tag(ap, ap->active_tag);
1278 if (qc && (!(qc->tf.flags & ATA_TFLAG_POLLING)))
1279 handled += ata_host_intr(ap, qc);
1280 else
1281 // No request pending? Clear interrupt status
1282 // anyway, in case there's one pending.
1283 ap->ops->check_status(ap);
1284 }
1285
1286 }
1287
1288 spin_unlock_irqrestore(&host->lock, flags);
1289
1290 return IRQ_RETVAL(handled);
1291 }
1292
1293 static irqreturn_t nv_do_interrupt(struct ata_host *host, u8 irq_stat)
1294 {
1295 int i, handled = 0;
1296
1297 for (i = 0; i < host->n_ports; i++) {
1298 struct ata_port *ap = host->ports[i];
1299
1300 if (ap && !(ap->flags & ATA_FLAG_DISABLED))
1301 handled += nv_host_intr(ap, irq_stat);
1302
1303 irq_stat >>= NV_INT_PORT_SHIFT;
1304 }
1305
1306 return IRQ_RETVAL(handled);
1307 }
1308
1309 static irqreturn_t nv_nf2_interrupt(int irq, void *dev_instance)
1310 {
1311 struct ata_host *host = dev_instance;
1312 u8 irq_stat;
1313 irqreturn_t ret;
1314
1315 spin_lock(&host->lock);
1316 irq_stat = ioread8(host->ports[0]->ioaddr.scr_addr + NV_INT_STATUS);
1317 ret = nv_do_interrupt(host, irq_stat);
1318 spin_unlock(&host->lock);
1319
1320 return ret;
1321 }
1322
1323 static irqreturn_t nv_ck804_interrupt(int irq, void *dev_instance)
1324 {
1325 struct ata_host *host = dev_instance;
1326 u8 irq_stat;
1327 irqreturn_t ret;
1328
1329 spin_lock(&host->lock);
1330 irq_stat = readb(host->iomap[NV_MMIO_BAR] + NV_INT_STATUS_CK804);
1331 ret = nv_do_interrupt(host, irq_stat);
1332 spin_unlock(&host->lock);
1333
1334 return ret;
1335 }
1336
1337 static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg)
1338 {
1339 if (sc_reg > SCR_CONTROL)
1340 return 0xffffffffU;
1341
1342 return ioread32(ap->ioaddr.scr_addr + (sc_reg * 4));
1343 }
1344
1345 static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val)
1346 {
1347 if (sc_reg > SCR_CONTROL)
1348 return;
1349
1350 iowrite32(val, ap->ioaddr.scr_addr + (sc_reg * 4));
1351 }
1352
1353 static void nv_nf2_freeze(struct ata_port *ap)
1354 {
1355 void __iomem *scr_addr = ap->host->ports[0]->ioaddr.scr_addr;
1356 int shift = ap->port_no * NV_INT_PORT_SHIFT;
1357 u8 mask;
1358
1359 mask = ioread8(scr_addr + NV_INT_ENABLE);
1360 mask &= ~(NV_INT_ALL << shift);
1361 iowrite8(mask, scr_addr + NV_INT_ENABLE);
1362 }
1363
1364 static void nv_nf2_thaw(struct ata_port *ap)
1365 {
1366 void __iomem *scr_addr = ap->host->ports[0]->ioaddr.scr_addr;
1367 int shift = ap->port_no * NV_INT_PORT_SHIFT;
1368 u8 mask;
1369
1370 iowrite8(NV_INT_ALL << shift, scr_addr + NV_INT_STATUS);
1371
1372 mask = ioread8(scr_addr + NV_INT_ENABLE);
1373 mask |= (NV_INT_MASK << shift);
1374 iowrite8(mask, scr_addr + NV_INT_ENABLE);
1375 }
1376
1377 static void nv_ck804_freeze(struct ata_port *ap)
1378 {
1379 void __iomem *mmio_base = ap->host->iomap[NV_MMIO_BAR];
1380 int shift = ap->port_no * NV_INT_PORT_SHIFT;
1381 u8 mask;
1382
1383 mask = readb(mmio_base + NV_INT_ENABLE_CK804);
1384 mask &= ~(NV_INT_ALL << shift);
1385 writeb(mask, mmio_base + NV_INT_ENABLE_CK804);
1386 }
1387
1388 static void nv_ck804_thaw(struct ata_port *ap)
1389 {
1390 void __iomem *mmio_base = ap->host->iomap[NV_MMIO_BAR];
1391 int shift = ap->port_no * NV_INT_PORT_SHIFT;
1392 u8 mask;
1393
1394 writeb(NV_INT_ALL << shift, mmio_base + NV_INT_STATUS_CK804);
1395
1396 mask = readb(mmio_base + NV_INT_ENABLE_CK804);
1397 mask |= (NV_INT_MASK << shift);
1398 writeb(mask, mmio_base + NV_INT_ENABLE_CK804);
1399 }
1400
1401 static int nv_hardreset(struct ata_port *ap, unsigned int *class)
1402 {
1403 unsigned int dummy;
1404
1405 /* SATA hardreset fails to retrieve proper device signature on
1406 * some controllers. Don't classify on hardreset. For more
1407 * info, see http://bugme.osdl.org/show_bug.cgi?id=3352
1408 */
1409 return sata_std_hardreset(ap, &dummy);
1410 }
1411
1412 static void nv_error_handler(struct ata_port *ap)
1413 {
1414 ata_bmdma_drive_eh(ap, ata_std_prereset, ata_std_softreset,
1415 nv_hardreset, ata_std_postreset);
1416 }
1417
1418 static void nv_adma_error_handler(struct ata_port *ap)
1419 {
1420 struct nv_adma_port_priv *pp = ap->private_data;
1421 if(!(pp->flags & NV_ADMA_PORT_REGISTER_MODE)) {
1422 void __iomem *mmio = pp->ctl_block;
1423 int i;
1424 u16 tmp;
1425
1426 if(ata_tag_valid(ap->active_tag) || ap->sactive) {
1427 u32 notifier = readl(mmio + NV_ADMA_NOTIFIER);
1428 u32 notifier_error = readl(mmio + NV_ADMA_NOTIFIER_ERROR);
1429 u32 gen_ctl = readl(pp->gen_block + NV_ADMA_GEN_CTL);
1430 u32 status = readw(mmio + NV_ADMA_STAT);
1431 u8 cpb_count = readb(mmio + NV_ADMA_CPB_COUNT);
1432 u8 next_cpb_idx = readb(mmio + NV_ADMA_NEXT_CPB_IDX);
1433
1434 ata_port_printk(ap, KERN_ERR, "EH in ADMA mode, notifier 0x%X "
1435 "notifier_error 0x%X gen_ctl 0x%X status 0x%X "
1436 "next cpb count 0x%X next cpb idx 0x%x\n",
1437 notifier, notifier_error, gen_ctl, status,
1438 cpb_count, next_cpb_idx);
1439
1440 for( i=0;i<NV_ADMA_MAX_CPBS;i++) {
1441 struct nv_adma_cpb *cpb = &pp->cpb[i];
1442 if( (ata_tag_valid(ap->active_tag) && i == ap->active_tag) ||
1443 ap->sactive & (1 << i) )
1444 ata_port_printk(ap, KERN_ERR,
1445 "CPB %d: ctl_flags 0x%x, resp_flags 0x%x\n",
1446 i, cpb->ctl_flags, cpb->resp_flags);
1447 }
1448 }
1449
1450 /* Push us back into port register mode for error handling. */
1451 nv_adma_register_mode(ap);
1452
1453 /* Mark all of the CPBs as invalid to prevent them from being executed */
1454 for( i=0;i<NV_ADMA_MAX_CPBS;i++)
1455 pp->cpb[i].ctl_flags &= ~NV_CPB_CTL_CPB_VALID;
1456
1457 /* clear CPB fetch count */
1458 writew(0, mmio + NV_ADMA_CPB_COUNT);
1459
1460 /* Reset channel */
1461 tmp = readw(mmio + NV_ADMA_CTL);
1462 writew(tmp | NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1463 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1464 udelay(1);
1465 writew(tmp & ~NV_ADMA_CTL_CHANNEL_RESET, mmio + NV_ADMA_CTL);
1466 readw( mmio + NV_ADMA_CTL ); /* flush posted write */
1467 }
1468
1469 ata_bmdma_drive_eh(ap, ata_std_prereset, ata_std_softreset,
1470 nv_hardreset, ata_std_postreset);
1471 }
1472
1473 static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
1474 {
1475 static int printed_version = 0;
1476 struct ata_port_info *ppi[2];
1477 struct ata_probe_ent *probe_ent;
1478 struct nv_host_priv *hpriv;
1479 int rc;
1480 u32 bar;
1481 void __iomem *base;
1482 unsigned long type = ent->driver_data;
1483 int mask_set = 0;
1484
1485 // Make sure this is a SATA controller by counting the number of bars
1486 // (NVIDIA SATA controllers will always have six bars). Otherwise,
1487 // it's an IDE controller and we ignore it.
1488 for (bar=0; bar<6; bar++)
1489 if (pci_resource_start(pdev, bar) == 0)
1490 return -ENODEV;
1491
1492 if (!printed_version++)
1493 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
1494
1495 rc = pcim_enable_device(pdev);
1496 if (rc)
1497 return rc;
1498
1499 rc = pci_request_regions(pdev, DRV_NAME);
1500 if (rc) {
1501 pcim_pin_device(pdev);
1502 return rc;
1503 }
1504
1505 if(type >= CK804 && adma_enabled) {
1506 dev_printk(KERN_NOTICE, &pdev->dev, "Using ADMA mode\n");
1507 type = ADMA;
1508 if(!pci_set_dma_mask(pdev, DMA_64BIT_MASK) &&
1509 !pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK))
1510 mask_set = 1;
1511 }
1512
1513 if(!mask_set) {
1514 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
1515 if (rc)
1516 return rc;
1517 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
1518 if (rc)
1519 return rc;
1520 }
1521
1522 rc = -ENOMEM;
1523
1524 hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL);
1525 if (!hpriv)
1526 return -ENOMEM;
1527
1528 ppi[0] = ppi[1] = &nv_port_info[type];
1529 probe_ent = ata_pci_init_native_mode(pdev, ppi, ATA_PORT_PRIMARY | ATA_PORT_SECONDARY);
1530 if (!probe_ent)
1531 return -ENOMEM;
1532
1533 if (!pcim_iomap(pdev, NV_MMIO_BAR, 0))
1534 return -EIO;
1535 probe_ent->iomap = pcim_iomap_table(pdev);
1536
1537 probe_ent->private_data = hpriv;
1538 hpriv->type = type;
1539
1540 base = probe_ent->iomap[NV_MMIO_BAR];
1541 probe_ent->port[0].scr_addr = base + NV_PORT0_SCR_REG_OFFSET;
1542 probe_ent->port[1].scr_addr = base + NV_PORT1_SCR_REG_OFFSET;
1543
1544 /* enable SATA space for CK804 */
1545 if (type >= CK804) {
1546 u8 regval;
1547
1548 pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
1549 regval |= NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
1550 pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
1551 }
1552
1553 pci_set_master(pdev);
1554
1555 if (type == ADMA) {
1556 rc = nv_adma_host_init(probe_ent);
1557 if (rc)
1558 return rc;
1559 }
1560
1561 rc = ata_device_add(probe_ent);
1562 if (rc != NV_PORTS)
1563 return -ENODEV;
1564
1565 devm_kfree(&pdev->dev, probe_ent);
1566 return 0;
1567 }
1568
1569 static void nv_remove_one (struct pci_dev *pdev)
1570 {
1571 struct ata_host *host = dev_get_drvdata(&pdev->dev);
1572 struct nv_host_priv *hpriv = host->private_data;
1573
1574 ata_pci_remove_one(pdev);
1575 kfree(hpriv);
1576 }
1577
1578 #ifdef CONFIG_PM
1579 static int nv_pci_device_resume(struct pci_dev *pdev)
1580 {
1581 struct ata_host *host = dev_get_drvdata(&pdev->dev);
1582 struct nv_host_priv *hpriv = host->private_data;
1583 int rc;
1584
1585 rc = ata_pci_device_do_resume(pdev);
1586 if(rc)
1587 return rc;
1588
1589 if (pdev->dev.power.power_state.event == PM_EVENT_SUSPEND) {
1590 if(hpriv->type >= CK804) {
1591 u8 regval;
1592
1593 pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
1594 regval |= NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
1595 pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
1596 }
1597 if(hpriv->type == ADMA) {
1598 u32 tmp32;
1599 struct nv_adma_port_priv *pp;
1600 /* enable/disable ADMA on the ports appropriately */
1601 pci_read_config_dword(pdev, NV_MCP_SATA_CFG_20, &tmp32);
1602
1603 pp = host->ports[0]->private_data;
1604 if(pp->flags & NV_ADMA_ATAPI_SETUP_COMPLETE)
1605 tmp32 &= ~(NV_MCP_SATA_CFG_20_PORT0_EN |
1606 NV_MCP_SATA_CFG_20_PORT0_PWB_EN);
1607 else
1608 tmp32 |= (NV_MCP_SATA_CFG_20_PORT0_EN |
1609 NV_MCP_SATA_CFG_20_PORT0_PWB_EN);
1610 pp = host->ports[1]->private_data;
1611 if(pp->flags & NV_ADMA_ATAPI_SETUP_COMPLETE)
1612 tmp32 &= ~(NV_MCP_SATA_CFG_20_PORT1_EN |
1613 NV_MCP_SATA_CFG_20_PORT1_PWB_EN);
1614 else
1615 tmp32 |= (NV_MCP_SATA_CFG_20_PORT1_EN |
1616 NV_MCP_SATA_CFG_20_PORT1_PWB_EN);
1617
1618 pci_write_config_dword(pdev, NV_MCP_SATA_CFG_20, tmp32);
1619 }
1620 }
1621
1622 ata_host_resume(host);
1623
1624 return 0;
1625 }
1626 #endif
1627
1628 static void nv_ck804_host_stop(struct ata_host *host)
1629 {
1630 struct pci_dev *pdev = to_pci_dev(host->dev);
1631 u8 regval;
1632
1633 /* disable SATA space for CK804 */
1634 pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
1635 regval &= ~NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
1636 pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
1637 }
1638
1639 static void nv_adma_host_stop(struct ata_host *host)
1640 {
1641 struct pci_dev *pdev = to_pci_dev(host->dev);
1642 u32 tmp32;
1643
1644 /* disable ADMA on the ports */
1645 pci_read_config_dword(pdev, NV_MCP_SATA_CFG_20, &tmp32);
1646 tmp32 &= ~(NV_MCP_SATA_CFG_20_PORT0_EN |
1647 NV_MCP_SATA_CFG_20_PORT0_PWB_EN |
1648 NV_MCP_SATA_CFG_20_PORT1_EN |
1649 NV_MCP_SATA_CFG_20_PORT1_PWB_EN);
1650
1651 pci_write_config_dword(pdev, NV_MCP_SATA_CFG_20, tmp32);
1652
1653 nv_ck804_host_stop(host);
1654 }
1655
1656 static int __init nv_init(void)
1657 {
1658 return pci_register_driver(&nv_pci_driver);
1659 }
1660
1661 static void __exit nv_exit(void)
1662 {
1663 pci_unregister_driver(&nv_pci_driver);
1664 }
1665
1666 module_init(nv_init);
1667 module_exit(nv_exit);
1668 module_param_named(adma, adma_enabled, bool, 0444);
1669 MODULE_PARM_DESC(adma, "Enable use of ADMA (Default: true)");
Verdex Pro support