sata_nv.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603
  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. * 0.09
  33. * - Fixed bug introduced by 0.08's MCP51 and MCP55 support.
  34. *
  35. * 0.08
  36. * - Added support for MCP51 and MCP55.
  37. *
  38. * 0.07
  39. * - Added support for RAID class code.
  40. *
  41. * 0.06
  42. * - Added generic SATA support by using a pci_device_id that filters on
  43. * the IDE storage class code.
  44. *
  45. * 0.03
  46. * - Fixed a bug where the hotplug handlers for non-CK804/MCP04 were using
  47. * mmio_base, which is only set for the CK804/MCP04 case.
  48. *
  49. * 0.02
  50. * - Added support for CK804 SATA controller.
  51. *
  52. * 0.01
  53. * - Initial revision.
  54. */
  55. #include <linux/config.h>
  56. #include <linux/kernel.h>
  57. #include <linux/module.h>
  58. #include <linux/pci.h>
  59. #include <linux/init.h>
  60. #include <linux/blkdev.h>
  61. #include <linux/delay.h>
  62. #include <linux/interrupt.h>
  63. #include "scsi.h"
  64. #include <scsi/scsi_host.h>
  65. #include <linux/libata.h>
  66. #define DRV_NAME "sata_nv"
  67. #define DRV_VERSION "0.8"
  68. #define NV_PORTS 2
  69. #define NV_PIO_MASK 0x1f
  70. #define NV_MWDMA_MASK 0x07
  71. #define NV_UDMA_MASK 0x7f
  72. #define NV_PORT0_SCR_REG_OFFSET 0x00
  73. #define NV_PORT1_SCR_REG_OFFSET 0x40
  74. #define NV_INT_STATUS 0x10
  75. #define NV_INT_STATUS_CK804 0x440
  76. #define NV_INT_STATUS_PDEV_INT 0x01
  77. #define NV_INT_STATUS_PDEV_PM 0x02
  78. #define NV_INT_STATUS_PDEV_ADDED 0x04
  79. #define NV_INT_STATUS_PDEV_REMOVED 0x08
  80. #define NV_INT_STATUS_SDEV_INT 0x10
  81. #define NV_INT_STATUS_SDEV_PM 0x20
  82. #define NV_INT_STATUS_SDEV_ADDED 0x40
  83. #define NV_INT_STATUS_SDEV_REMOVED 0x80
  84. #define NV_INT_STATUS_PDEV_HOTPLUG (NV_INT_STATUS_PDEV_ADDED | \
  85. NV_INT_STATUS_PDEV_REMOVED)
  86. #define NV_INT_STATUS_SDEV_HOTPLUG (NV_INT_STATUS_SDEV_ADDED | \
  87. NV_INT_STATUS_SDEV_REMOVED)
  88. #define NV_INT_STATUS_HOTPLUG (NV_INT_STATUS_PDEV_HOTPLUG | \
  89. NV_INT_STATUS_SDEV_HOTPLUG)
  90. #define NV_INT_ENABLE 0x11
  91. #define NV_INT_ENABLE_CK804 0x441
  92. #define NV_INT_ENABLE_PDEV_MASK 0x01
  93. #define NV_INT_ENABLE_PDEV_PM 0x02
  94. #define NV_INT_ENABLE_PDEV_ADDED 0x04
  95. #define NV_INT_ENABLE_PDEV_REMOVED 0x08
  96. #define NV_INT_ENABLE_SDEV_MASK 0x10
  97. #define NV_INT_ENABLE_SDEV_PM 0x20
  98. #define NV_INT_ENABLE_SDEV_ADDED 0x40
  99. #define NV_INT_ENABLE_SDEV_REMOVED 0x80
  100. #define NV_INT_ENABLE_PDEV_HOTPLUG (NV_INT_ENABLE_PDEV_ADDED | \
  101. NV_INT_ENABLE_PDEV_REMOVED)
  102. #define NV_INT_ENABLE_SDEV_HOTPLUG (NV_INT_ENABLE_SDEV_ADDED | \
  103. NV_INT_ENABLE_SDEV_REMOVED)
  104. #define NV_INT_ENABLE_HOTPLUG (NV_INT_ENABLE_PDEV_HOTPLUG | \
  105. NV_INT_ENABLE_SDEV_HOTPLUG)
  106. #define NV_INT_CONFIG 0x12
  107. #define NV_INT_CONFIG_METHD 0x01 // 0 = INT, 1 = SMI
  108. // For PCI config register 20
  109. #define NV_MCP_SATA_CFG_20 0x50
  110. #define NV_MCP_SATA_CFG_20_SATA_SPACE_EN 0x04
  111. static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent);
  112. static irqreturn_t nv_interrupt (int irq, void *dev_instance,
  113. struct pt_regs *regs);
  114. static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg);
  115. static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val);
  116. static void nv_host_stop (struct ata_host_set *host_set);
  117. static void nv_enable_hotplug(struct ata_probe_ent *probe_ent);
  118. static void nv_disable_hotplug(struct ata_host_set *host_set);
  119. static void nv_check_hotplug(struct ata_host_set *host_set);
  120. static void nv_enable_hotplug_ck804(struct ata_probe_ent *probe_ent);
  121. static void nv_disable_hotplug_ck804(struct ata_host_set *host_set);
  122. static void nv_check_hotplug_ck804(struct ata_host_set *host_set);
  123. enum nv_host_type
  124. {
  125. GENERIC,
  126. NFORCE2,
  127. NFORCE3,
  128. CK804
  129. };
  130. static struct pci_device_id nv_pci_tbl[] = {
  131. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2S_SATA,
  132. PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE2 },
  133. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA,
  134. PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE3 },
  135. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA2,
  136. PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE3 },
  137. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA,
  138. PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
  139. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA2,
  140. PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
  141. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA,
  142. PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
  143. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA2,
  144. PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
  145. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA,
  146. PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
  147. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA2,
  148. PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
  149. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA,
  150. PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
  151. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA2,
  152. PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
  153. { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
  154. PCI_ANY_ID, PCI_ANY_ID,
  155. PCI_CLASS_STORAGE_IDE<<8, 0xffff00, GENERIC },
  156. { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
  157. PCI_ANY_ID, PCI_ANY_ID,
  158. PCI_CLASS_STORAGE_RAID<<8, 0xffff00, GENERIC },
  159. { 0, } /* terminate list */
  160. };
  161. #define NV_HOST_FLAGS_SCR_MMIO 0x00000001
  162. struct nv_host_desc
  163. {
  164. enum nv_host_type host_type;
  165. void (*enable_hotplug)(struct ata_probe_ent *probe_ent);
  166. void (*disable_hotplug)(struct ata_host_set *host_set);
  167. void (*check_hotplug)(struct ata_host_set *host_set);
  168. };
  169. static struct nv_host_desc nv_device_tbl[] = {
  170. {
  171. .host_type = GENERIC,
  172. .enable_hotplug = NULL,
  173. .disable_hotplug= NULL,
  174. .check_hotplug = NULL,
  175. },
  176. {
  177. .host_type = NFORCE2,
  178. .enable_hotplug = nv_enable_hotplug,
  179. .disable_hotplug= nv_disable_hotplug,
  180. .check_hotplug = nv_check_hotplug,
  181. },
  182. {
  183. .host_type = NFORCE3,
  184. .enable_hotplug = nv_enable_hotplug,
  185. .disable_hotplug= nv_disable_hotplug,
  186. .check_hotplug = nv_check_hotplug,
  187. },
  188. { .host_type = CK804,
  189. .enable_hotplug = nv_enable_hotplug_ck804,
  190. .disable_hotplug= nv_disable_hotplug_ck804,
  191. .check_hotplug = nv_check_hotplug_ck804,
  192. },
  193. };
  194. struct nv_host
  195. {
  196. struct nv_host_desc *host_desc;
  197. unsigned long host_flags;
  198. };
  199. static struct pci_driver nv_pci_driver = {
  200. .name = DRV_NAME,
  201. .id_table = nv_pci_tbl,
  202. .probe = nv_init_one,
  203. .remove = ata_pci_remove_one,
  204. };
  205. static Scsi_Host_Template nv_sht = {
  206. .module = THIS_MODULE,
  207. .name = DRV_NAME,
  208. .ioctl = ata_scsi_ioctl,
  209. .queuecommand = ata_scsi_queuecmd,
  210. .eh_strategy_handler = ata_scsi_error,
  211. .can_queue = ATA_DEF_QUEUE,
  212. .this_id = ATA_SHT_THIS_ID,
  213. .sg_tablesize = LIBATA_MAX_PRD,
  214. .max_sectors = ATA_MAX_SECTORS,
  215. .cmd_per_lun = ATA_SHT_CMD_PER_LUN,
  216. .emulated = ATA_SHT_EMULATED,
  217. .use_clustering = ATA_SHT_USE_CLUSTERING,
  218. .proc_name = DRV_NAME,
  219. .dma_boundary = ATA_DMA_BOUNDARY,
  220. .slave_configure = ata_scsi_slave_config,
  221. .bios_param = ata_std_bios_param,
  222. .ordered_flush = 1,
  223. };
  224. static const struct ata_port_operations nv_ops = {
  225. .port_disable = ata_port_disable,
  226. .tf_load = ata_tf_load,
  227. .tf_read = ata_tf_read,
  228. .exec_command = ata_exec_command,
  229. .check_status = ata_check_status,
  230. .dev_select = ata_std_dev_select,
  231. .phy_reset = sata_phy_reset,
  232. .bmdma_setup = ata_bmdma_setup,
  233. .bmdma_start = ata_bmdma_start,
  234. .bmdma_stop = ata_bmdma_stop,
  235. .bmdma_status = ata_bmdma_status,
  236. .qc_prep = ata_qc_prep,
  237. .qc_issue = ata_qc_issue_prot,
  238. .eng_timeout = ata_eng_timeout,
  239. .irq_handler = nv_interrupt,
  240. .irq_clear = ata_bmdma_irq_clear,
  241. .scr_read = nv_scr_read,
  242. .scr_write = nv_scr_write,
  243. .port_start = ata_port_start,
  244. .port_stop = ata_port_stop,
  245. .host_stop = nv_host_stop,
  246. };
  247. /* FIXME: The hardware provides the necessary SATA PHY controls
  248. * to support ATA_FLAG_SATA_RESET. However, it is currently
  249. * necessary to disable that flag, to solve misdetection problems.
  250. * See http://bugme.osdl.org/show_bug.cgi?id=3352 for more info.
  251. *
  252. * This problem really needs to be investigated further. But in the
  253. * meantime, we avoid ATA_FLAG_SATA_RESET to get people working.
  254. */
  255. static struct ata_port_info nv_port_info = {
  256. .sht = &nv_sht,
  257. .host_flags = ATA_FLAG_SATA |
  258. /* ATA_FLAG_SATA_RESET | */
  259. ATA_FLAG_SRST |
  260. ATA_FLAG_NO_LEGACY,
  261. .pio_mask = NV_PIO_MASK,
  262. .mwdma_mask = NV_MWDMA_MASK,
  263. .udma_mask = NV_UDMA_MASK,
  264. .port_ops = &nv_ops,
  265. };
  266. MODULE_AUTHOR("NVIDIA");
  267. MODULE_DESCRIPTION("low-level driver for NVIDIA nForce SATA controller");
  268. MODULE_LICENSE("GPL");
  269. MODULE_DEVICE_TABLE(pci, nv_pci_tbl);
  270. MODULE_VERSION(DRV_VERSION);
  271. static irqreturn_t nv_interrupt (int irq, void *dev_instance,
  272. struct pt_regs *regs)
  273. {
  274. struct ata_host_set *host_set = dev_instance;
  275. struct nv_host *host = host_set->private_data;
  276. unsigned int i;
  277. unsigned int handled = 0;
  278. unsigned long flags;
  279. spin_lock_irqsave(&host_set->lock, flags);
  280. for (i = 0; i < host_set->n_ports; i++) {
  281. struct ata_port *ap;
  282. ap = host_set->ports[i];
  283. if (ap &&
  284. !(ap->flags & (ATA_FLAG_PORT_DISABLED | ATA_FLAG_NOINTR))) {
  285. struct ata_queued_cmd *qc;
  286. qc = ata_qc_from_tag(ap, ap->active_tag);
  287. if (qc && (!(qc->tf.ctl & ATA_NIEN)))
  288. handled += ata_host_intr(ap, qc);
  289. }
  290. }
  291. if (host->host_desc->check_hotplug)
  292. host->host_desc->check_hotplug(host_set);
  293. spin_unlock_irqrestore(&host_set->lock, flags);
  294. return IRQ_RETVAL(handled);
  295. }
  296. static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg)
  297. {
  298. struct ata_host_set *host_set = ap->host_set;
  299. struct nv_host *host = host_set->private_data;
  300. if (sc_reg > SCR_CONTROL)
  301. return 0xffffffffU;
  302. if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
  303. return readl((void __iomem *)ap->ioaddr.scr_addr + (sc_reg * 4));
  304. else
  305. return inl(ap->ioaddr.scr_addr + (sc_reg * 4));
  306. }
  307. static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val)
  308. {
  309. struct ata_host_set *host_set = ap->host_set;
  310. struct nv_host *host = host_set->private_data;
  311. if (sc_reg > SCR_CONTROL)
  312. return;
  313. if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
  314. writel(val, (void __iomem *)ap->ioaddr.scr_addr + (sc_reg * 4));
  315. else
  316. outl(val, ap->ioaddr.scr_addr + (sc_reg * 4));
  317. }
  318. static void nv_host_stop (struct ata_host_set *host_set)
  319. {
  320. struct nv_host *host = host_set->private_data;
  321. struct pci_dev *pdev = to_pci_dev(host_set->dev);
  322. // Disable hotplug event interrupts.
  323. if (host->host_desc->disable_hotplug)
  324. host->host_desc->disable_hotplug(host_set);
  325. kfree(host);
  326. if (host_set->mmio_base)
  327. pci_iounmap(pdev, host_set->mmio_base);
  328. }
  329. static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
  330. {
  331. static int printed_version = 0;
  332. struct nv_host *host;
  333. struct ata_port_info *ppi;
  334. struct ata_probe_ent *probe_ent;
  335. int pci_dev_busy = 0;
  336. int rc;
  337. u32 bar;
  338. // Make sure this is a SATA controller by counting the number of bars
  339. // (NVIDIA SATA controllers will always have six bars). Otherwise,
  340. // it's an IDE controller and we ignore it.
  341. for (bar=0; bar<6; bar++)
  342. if (pci_resource_start(pdev, bar) == 0)
  343. return -ENODEV;
  344. if (!printed_version++)
  345. printk(KERN_DEBUG DRV_NAME " version " DRV_VERSION "\n");
  346. rc = pci_enable_device(pdev);
  347. if (rc)
  348. goto err_out;
  349. rc = pci_request_regions(pdev, DRV_NAME);
  350. if (rc) {
  351. pci_dev_busy = 1;
  352. goto err_out_disable;
  353. }
  354. rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
  355. if (rc)
  356. goto err_out_regions;
  357. rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
  358. if (rc)
  359. goto err_out_regions;
  360. rc = -ENOMEM;
  361. ppi = &nv_port_info;
  362. probe_ent = ata_pci_init_native_mode(pdev, &ppi, ATA_PORT_PRIMARY | ATA_PORT_SECONDARY);
  363. if (!probe_ent)
  364. goto err_out_regions;
  365. host = kmalloc(sizeof(struct nv_host), GFP_KERNEL);
  366. if (!host)
  367. goto err_out_free_ent;
  368. memset(host, 0, sizeof(struct nv_host));
  369. host->host_desc = &nv_device_tbl[ent->driver_data];
  370. probe_ent->private_data = host;
  371. if (pci_resource_flags(pdev, 5) & IORESOURCE_MEM)
  372. host->host_flags |= NV_HOST_FLAGS_SCR_MMIO;
  373. if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO) {
  374. unsigned long base;
  375. probe_ent->mmio_base = pci_iomap(pdev, 5, 0);
  376. if (probe_ent->mmio_base == NULL) {
  377. rc = -EIO;
  378. goto err_out_free_host;
  379. }
  380. base = (unsigned long)probe_ent->mmio_base;
  381. probe_ent->port[0].scr_addr =
  382. base + NV_PORT0_SCR_REG_OFFSET;
  383. probe_ent->port[1].scr_addr =
  384. base + NV_PORT1_SCR_REG_OFFSET;
  385. } else {
  386. probe_ent->port[0].scr_addr =
  387. pci_resource_start(pdev, 5) | NV_PORT0_SCR_REG_OFFSET;
  388. probe_ent->port[1].scr_addr =
  389. pci_resource_start(pdev, 5) | NV_PORT1_SCR_REG_OFFSET;
  390. }
  391. pci_set_master(pdev);
  392. rc = ata_device_add(probe_ent);
  393. if (rc != NV_PORTS)
  394. goto err_out_iounmap;
  395. // Enable hotplug event interrupts.
  396. if (host->host_desc->enable_hotplug)
  397. host->host_desc->enable_hotplug(probe_ent);
  398. kfree(probe_ent);
  399. return 0;
  400. err_out_iounmap:
  401. if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
  402. pci_iounmap(pdev, probe_ent->mmio_base);
  403. err_out_free_host:
  404. kfree(host);
  405. err_out_free_ent:
  406. kfree(probe_ent);
  407. err_out_regions:
  408. pci_release_regions(pdev);
  409. err_out_disable:
  410. if (!pci_dev_busy)
  411. pci_disable_device(pdev);
  412. err_out:
  413. return rc;
  414. }
  415. static void nv_enable_hotplug(struct ata_probe_ent *probe_ent)
  416. {
  417. u8 intr_mask;
  418. outb(NV_INT_STATUS_HOTPLUG,
  419. probe_ent->port[0].scr_addr + NV_INT_STATUS);
  420. intr_mask = inb(probe_ent->port[0].scr_addr + NV_INT_ENABLE);
  421. intr_mask |= NV_INT_ENABLE_HOTPLUG;
  422. outb(intr_mask, probe_ent->port[0].scr_addr + NV_INT_ENABLE);
  423. }
  424. static void nv_disable_hotplug(struct ata_host_set *host_set)
  425. {
  426. u8 intr_mask;
  427. intr_mask = inb(host_set->ports[0]->ioaddr.scr_addr + NV_INT_ENABLE);
  428. intr_mask &= ~(NV_INT_ENABLE_HOTPLUG);
  429. outb(intr_mask, host_set->ports[0]->ioaddr.scr_addr + NV_INT_ENABLE);
  430. }
  431. static void nv_check_hotplug(struct ata_host_set *host_set)
  432. {
  433. u8 intr_status;
  434. intr_status = inb(host_set->ports[0]->ioaddr.scr_addr + NV_INT_STATUS);
  435. // Clear interrupt status.
  436. outb(0xff, host_set->ports[0]->ioaddr.scr_addr + NV_INT_STATUS);
  437. if (intr_status & NV_INT_STATUS_HOTPLUG) {
  438. if (intr_status & NV_INT_STATUS_PDEV_ADDED)
  439. printk(KERN_WARNING "nv_sata: "
  440. "Primary device added\n");
  441. if (intr_status & NV_INT_STATUS_PDEV_REMOVED)
  442. printk(KERN_WARNING "nv_sata: "
  443. "Primary device removed\n");
  444. if (intr_status & NV_INT_STATUS_SDEV_ADDED)
  445. printk(KERN_WARNING "nv_sata: "
  446. "Secondary device added\n");
  447. if (intr_status & NV_INT_STATUS_SDEV_REMOVED)
  448. printk(KERN_WARNING "nv_sata: "
  449. "Secondary device removed\n");
  450. }
  451. }
  452. static void nv_enable_hotplug_ck804(struct ata_probe_ent *probe_ent)
  453. {
  454. struct pci_dev *pdev = to_pci_dev(probe_ent->dev);
  455. u8 intr_mask;
  456. u8 regval;
  457. pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
  458. regval |= NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
  459. pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
  460. writeb(NV_INT_STATUS_HOTPLUG, probe_ent->mmio_base + NV_INT_STATUS_CK804);
  461. intr_mask = readb(probe_ent->mmio_base + NV_INT_ENABLE_CK804);
  462. intr_mask |= NV_INT_ENABLE_HOTPLUG;
  463. writeb(intr_mask, probe_ent->mmio_base + NV_INT_ENABLE_CK804);
  464. }
  465. static void nv_disable_hotplug_ck804(struct ata_host_set *host_set)
  466. {
  467. struct pci_dev *pdev = to_pci_dev(host_set->dev);
  468. u8 intr_mask;
  469. u8 regval;
  470. intr_mask = readb(host_set->mmio_base + NV_INT_ENABLE_CK804);
  471. intr_mask &= ~(NV_INT_ENABLE_HOTPLUG);
  472. writeb(intr_mask, host_set->mmio_base + NV_INT_ENABLE_CK804);
  473. pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
  474. regval &= ~NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
  475. pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
  476. }
  477. static void nv_check_hotplug_ck804(struct ata_host_set *host_set)
  478. {
  479. u8 intr_status;
  480. intr_status = readb(host_set->mmio_base + NV_INT_STATUS_CK804);
  481. // Clear interrupt status.
  482. writeb(0xff, host_set->mmio_base + NV_INT_STATUS_CK804);
  483. if (intr_status & NV_INT_STATUS_HOTPLUG) {
  484. if (intr_status & NV_INT_STATUS_PDEV_ADDED)
  485. printk(KERN_WARNING "nv_sata: "
  486. "Primary device added\n");
  487. if (intr_status & NV_INT_STATUS_PDEV_REMOVED)
  488. printk(KERN_WARNING "nv_sata: "
  489. "Primary device removed\n");
  490. if (intr_status & NV_INT_STATUS_SDEV_ADDED)
  491. printk(KERN_WARNING "nv_sata: "
  492. "Secondary device added\n");
  493. if (intr_status & NV_INT_STATUS_SDEV_REMOVED)
  494. printk(KERN_WARNING "nv_sata: "
  495. "Secondary device removed\n");
  496. }
  497. }
  498. static int __init nv_init(void)
  499. {
  500. return pci_module_init(&nv_pci_driver);
  501. }
  502. static void __exit nv_exit(void)
  503. {
  504. pci_unregister_driver(&nv_pci_driver);
  505. }
  506. module_init(nv_init);
  507. module_exit(nv_exit);