scc_pata.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807
  1. /*
  2. * Support for IDE interfaces on Celleb platform
  3. *
  4. * (C) Copyright 2006 TOSHIBA CORPORATION
  5. *
  6. * This code is based on drivers/ide/pci/siimage.c:
  7. * Copyright (C) 2001-2002 Andre Hedrick <andre@linux-ide.org>
  8. * Copyright (C) 2003 Red Hat <alan@redhat.com>
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License as published by
  12. * the Free Software Foundation; either version 2 of the License, or
  13. * (at your option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License along
  21. * with this program; if not, write to the Free Software Foundation, Inc.,
  22. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  23. */
  24. #include <linux/types.h>
  25. #include <linux/module.h>
  26. #include <linux/pci.h>
  27. #include <linux/delay.h>
  28. #include <linux/hdreg.h>
  29. #include <linux/ide.h>
  30. #include <linux/init.h>
  31. #define PCI_DEVICE_ID_TOSHIBA_SCC_ATA 0x01b4
  32. #define SCC_PATA_NAME "scc IDE"
  33. #define TDVHSEL_MASTER 0x00000001
  34. #define TDVHSEL_SLAVE 0x00000004
  35. #define MODE_JCUSFEN 0x00000080
  36. #define CCKCTRL_ATARESET 0x00040000
  37. #define CCKCTRL_BUFCNT 0x00020000
  38. #define CCKCTRL_CRST 0x00010000
  39. #define CCKCTRL_OCLKEN 0x00000100
  40. #define CCKCTRL_ATACLKOEN 0x00000002
  41. #define CCKCTRL_LCLKEN 0x00000001
  42. #define QCHCD_IOS_SS 0x00000001
  43. #define QCHSD_STPDIAG 0x00020000
  44. #define INTMASK_MSK 0xD1000012
  45. #define INTSTS_SERROR 0x80000000
  46. #define INTSTS_PRERR 0x40000000
  47. #define INTSTS_RERR 0x10000000
  48. #define INTSTS_ICERR 0x01000000
  49. #define INTSTS_BMSINT 0x00000010
  50. #define INTSTS_BMHE 0x00000008
  51. #define INTSTS_IOIRQS 0x00000004
  52. #define INTSTS_INTRQ 0x00000002
  53. #define INTSTS_ACTEINT 0x00000001
  54. #define ECMODE_VALUE 0x01
  55. static struct scc_ports {
  56. unsigned long ctl, dma;
  57. ide_hwif_t *hwif; /* for removing port from system */
  58. } scc_ports[MAX_HWIFS];
  59. /* PIO transfer mode table */
  60. /* JCHST */
  61. static unsigned long JCHSTtbl[2][7] = {
  62. {0x0E, 0x05, 0x02, 0x03, 0x02, 0x00, 0x00}, /* 100MHz */
  63. {0x13, 0x07, 0x04, 0x04, 0x03, 0x00, 0x00} /* 133MHz */
  64. };
  65. /* JCHHT */
  66. static unsigned long JCHHTtbl[2][7] = {
  67. {0x0E, 0x02, 0x02, 0x02, 0x02, 0x00, 0x00}, /* 100MHz */
  68. {0x13, 0x03, 0x03, 0x03, 0x03, 0x00, 0x00} /* 133MHz */
  69. };
  70. /* JCHCT */
  71. static unsigned long JCHCTtbl[2][7] = {
  72. {0x1D, 0x1D, 0x1C, 0x0B, 0x06, 0x00, 0x00}, /* 100MHz */
  73. {0x27, 0x26, 0x26, 0x0E, 0x09, 0x00, 0x00} /* 133MHz */
  74. };
  75. /* DMA transfer mode table */
  76. /* JCHDCTM/JCHDCTS */
  77. static unsigned long JCHDCTxtbl[2][7] = {
  78. {0x0A, 0x06, 0x04, 0x03, 0x01, 0x00, 0x00}, /* 100MHz */
  79. {0x0E, 0x09, 0x06, 0x04, 0x02, 0x01, 0x00} /* 133MHz */
  80. };
  81. /* JCSTWTM/JCSTWTS */
  82. static unsigned long JCSTWTxtbl[2][7] = {
  83. {0x06, 0x04, 0x03, 0x02, 0x02, 0x02, 0x00}, /* 100MHz */
  84. {0x09, 0x06, 0x04, 0x02, 0x02, 0x02, 0x02} /* 133MHz */
  85. };
  86. /* JCTSS */
  87. static unsigned long JCTSStbl[2][7] = {
  88. {0x05, 0x05, 0x05, 0x05, 0x05, 0x05, 0x00}, /* 100MHz */
  89. {0x05, 0x05, 0x05, 0x05, 0x05, 0x05, 0x05} /* 133MHz */
  90. };
  91. /* JCENVT */
  92. static unsigned long JCENVTtbl[2][7] = {
  93. {0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00}, /* 100MHz */
  94. {0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02} /* 133MHz */
  95. };
  96. /* JCACTSELS/JCACTSELM */
  97. static unsigned long JCACTSELtbl[2][7] = {
  98. {0x00, 0x00, 0x00, 0x00, 0x01, 0x01, 0x00}, /* 100MHz */
  99. {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01} /* 133MHz */
  100. };
  101. static u8 scc_ide_inb(unsigned long port)
  102. {
  103. u32 data = in_be32((void*)port);
  104. return (u8)data;
  105. }
  106. static u16 scc_ide_inw(unsigned long port)
  107. {
  108. u32 data = in_be32((void*)port);
  109. return (u16)data;
  110. }
  111. static void scc_ide_insw(unsigned long port, void *addr, u32 count)
  112. {
  113. u16 *ptr = (u16 *)addr;
  114. while (count--) {
  115. *ptr++ = le16_to_cpu(in_be32((void*)port));
  116. }
  117. }
  118. static void scc_ide_insl(unsigned long port, void *addr, u32 count)
  119. {
  120. u16 *ptr = (u16 *)addr;
  121. while (count--) {
  122. *ptr++ = le16_to_cpu(in_be32((void*)port));
  123. *ptr++ = le16_to_cpu(in_be32((void*)port));
  124. }
  125. }
  126. static void scc_ide_outb(u8 addr, unsigned long port)
  127. {
  128. out_be32((void*)port, addr);
  129. }
  130. static void scc_ide_outw(u16 addr, unsigned long port)
  131. {
  132. out_be32((void*)port, addr);
  133. }
  134. static void
  135. scc_ide_outbsync(ide_drive_t * drive, u8 addr, unsigned long port)
  136. {
  137. ide_hwif_t *hwif = HWIF(drive);
  138. out_be32((void*)port, addr);
  139. eieio();
  140. in_be32((void*)(hwif->dma_base + 0x01c));
  141. eieio();
  142. }
  143. static void
  144. scc_ide_outsw(unsigned long port, void *addr, u32 count)
  145. {
  146. u16 *ptr = (u16 *)addr;
  147. while (count--) {
  148. out_be32((void*)port, cpu_to_le16(*ptr++));
  149. }
  150. }
  151. static void
  152. scc_ide_outsl(unsigned long port, void *addr, u32 count)
  153. {
  154. u16 *ptr = (u16 *)addr;
  155. while (count--) {
  156. out_be32((void*)port, cpu_to_le16(*ptr++));
  157. out_be32((void*)port, cpu_to_le16(*ptr++));
  158. }
  159. }
  160. /**
  161. * scc_set_pio_mode - set host controller for PIO mode
  162. * @drive: drive
  163. * @pio: PIO mode number
  164. *
  165. * Load the timing settings for this device mode into the
  166. * controller.
  167. */
  168. static void scc_set_pio_mode(ide_drive_t *drive, const u8 pio)
  169. {
  170. ide_hwif_t *hwif = HWIF(drive);
  171. struct scc_ports *ports = ide_get_hwifdata(hwif);
  172. unsigned long ctl_base = ports->ctl;
  173. unsigned long cckctrl_port = ctl_base + 0xff0;
  174. unsigned long piosht_port = ctl_base + 0x000;
  175. unsigned long pioct_port = ctl_base + 0x004;
  176. unsigned long reg;
  177. int offset;
  178. reg = in_be32((void __iomem *)cckctrl_port);
  179. if (reg & CCKCTRL_ATACLKOEN) {
  180. offset = 1; /* 133MHz */
  181. } else {
  182. offset = 0; /* 100MHz */
  183. }
  184. reg = JCHSTtbl[offset][pio] << 16 | JCHHTtbl[offset][pio];
  185. out_be32((void __iomem *)piosht_port, reg);
  186. reg = JCHCTtbl[offset][pio];
  187. out_be32((void __iomem *)pioct_port, reg);
  188. }
  189. /**
  190. * scc_set_dma_mode - set host controller for DMA mode
  191. * @drive: drive
  192. * @speed: DMA mode
  193. *
  194. * Load the timing settings for this device mode into the
  195. * controller.
  196. */
  197. static void scc_set_dma_mode(ide_drive_t *drive, const u8 speed)
  198. {
  199. ide_hwif_t *hwif = HWIF(drive);
  200. struct scc_ports *ports = ide_get_hwifdata(hwif);
  201. unsigned long ctl_base = ports->ctl;
  202. unsigned long cckctrl_port = ctl_base + 0xff0;
  203. unsigned long mdmact_port = ctl_base + 0x008;
  204. unsigned long mcrcst_port = ctl_base + 0x00c;
  205. unsigned long sdmact_port = ctl_base + 0x010;
  206. unsigned long scrcst_port = ctl_base + 0x014;
  207. unsigned long udenvt_port = ctl_base + 0x018;
  208. unsigned long tdvhsel_port = ctl_base + 0x020;
  209. int is_slave = (&hwif->drives[1] == drive);
  210. int offset, idx;
  211. unsigned long reg;
  212. unsigned long jcactsel;
  213. reg = in_be32((void __iomem *)cckctrl_port);
  214. if (reg & CCKCTRL_ATACLKOEN) {
  215. offset = 1; /* 133MHz */
  216. } else {
  217. offset = 0; /* 100MHz */
  218. }
  219. idx = speed - XFER_UDMA_0;
  220. jcactsel = JCACTSELtbl[offset][idx];
  221. if (is_slave) {
  222. out_be32((void __iomem *)sdmact_port, JCHDCTxtbl[offset][idx]);
  223. out_be32((void __iomem *)scrcst_port, JCSTWTxtbl[offset][idx]);
  224. jcactsel = jcactsel << 2;
  225. out_be32((void __iomem *)tdvhsel_port, (in_be32((void __iomem *)tdvhsel_port) & ~TDVHSEL_SLAVE) | jcactsel);
  226. } else {
  227. out_be32((void __iomem *)mdmact_port, JCHDCTxtbl[offset][idx]);
  228. out_be32((void __iomem *)mcrcst_port, JCSTWTxtbl[offset][idx]);
  229. out_be32((void __iomem *)tdvhsel_port, (in_be32((void __iomem *)tdvhsel_port) & ~TDVHSEL_MASTER) | jcactsel);
  230. }
  231. reg = JCTSStbl[offset][idx] << 16 | JCENVTtbl[offset][idx];
  232. out_be32((void __iomem *)udenvt_port, reg);
  233. }
  234. /**
  235. * scc_ide_dma_setup - begin a DMA phase
  236. * @drive: target device
  237. *
  238. * Build an IDE DMA PRD (IDE speak for scatter gather table)
  239. * and then set up the DMA transfer registers.
  240. *
  241. * Returns 0 on success. If a PIO fallback is required then 1
  242. * is returned.
  243. */
  244. static int scc_dma_setup(ide_drive_t *drive)
  245. {
  246. ide_hwif_t *hwif = drive->hwif;
  247. struct request *rq = HWGROUP(drive)->rq;
  248. unsigned int reading;
  249. u8 dma_stat;
  250. if (rq_data_dir(rq))
  251. reading = 0;
  252. else
  253. reading = 1 << 3;
  254. /* fall back to pio! */
  255. if (!ide_build_dmatable(drive, rq)) {
  256. ide_map_sg(drive, rq);
  257. return 1;
  258. }
  259. /* PRD table */
  260. out_be32((void __iomem *)hwif->dma_prdtable, hwif->dmatable_dma);
  261. /* specify r/w */
  262. out_be32((void __iomem *)hwif->dma_command, reading);
  263. /* read dma_status for INTR & ERROR flags */
  264. dma_stat = in_be32((void __iomem *)hwif->dma_status);
  265. /* clear INTR & ERROR flags */
  266. out_be32((void __iomem *)hwif->dma_status, dma_stat|6);
  267. drive->waiting_for_dma = 1;
  268. return 0;
  269. }
  270. /**
  271. * scc_ide_dma_end - Stop DMA
  272. * @drive: IDE drive
  273. *
  274. * Check and clear INT Status register.
  275. * Then call __ide_dma_end().
  276. */
  277. static int scc_ide_dma_end(ide_drive_t * drive)
  278. {
  279. ide_hwif_t *hwif = HWIF(drive);
  280. unsigned long intsts_port = hwif->dma_base + 0x014;
  281. u32 reg;
  282. int dma_stat, data_loss = 0;
  283. static int retry = 0;
  284. /* errata A308 workaround: Step5 (check data loss) */
  285. /* We don't check non ide_disk because it is limited to UDMA4 */
  286. if (!(in_be32((void __iomem *)hwif->io_ports[IDE_ALTSTATUS_OFFSET])
  287. & ERR_STAT) &&
  288. drive->media == ide_disk && drive->current_speed > XFER_UDMA_4) {
  289. reg = in_be32((void __iomem *)intsts_port);
  290. if (!(reg & INTSTS_ACTEINT)) {
  291. printk(KERN_WARNING "%s: operation failed (transfer data loss)\n",
  292. drive->name);
  293. data_loss = 1;
  294. if (retry++) {
  295. struct request *rq = HWGROUP(drive)->rq;
  296. int unit;
  297. /* ERROR_RESET and drive->crc_count are needed
  298. * to reduce DMA transfer mode in retry process.
  299. */
  300. if (rq)
  301. rq->errors |= ERROR_RESET;
  302. for (unit = 0; unit < MAX_DRIVES; unit++) {
  303. ide_drive_t *drive = &hwif->drives[unit];
  304. drive->crc_count++;
  305. }
  306. }
  307. }
  308. }
  309. while (1) {
  310. reg = in_be32((void __iomem *)intsts_port);
  311. if (reg & INTSTS_SERROR) {
  312. printk(KERN_WARNING "%s: SERROR\n", SCC_PATA_NAME);
  313. out_be32((void __iomem *)intsts_port, INTSTS_SERROR|INTSTS_BMSINT);
  314. out_be32((void __iomem *)hwif->dma_command, in_be32((void __iomem *)hwif->dma_command) & ~QCHCD_IOS_SS);
  315. continue;
  316. }
  317. if (reg & INTSTS_PRERR) {
  318. u32 maea0, maec0;
  319. unsigned long ctl_base = hwif->config_data;
  320. maea0 = in_be32((void __iomem *)(ctl_base + 0xF50));
  321. maec0 = in_be32((void __iomem *)(ctl_base + 0xF54));
  322. printk(KERN_WARNING "%s: PRERR [addr:%x cmd:%x]\n", SCC_PATA_NAME, maea0, maec0);
  323. out_be32((void __iomem *)intsts_port, INTSTS_PRERR|INTSTS_BMSINT);
  324. out_be32((void __iomem *)hwif->dma_command, in_be32((void __iomem *)hwif->dma_command) & ~QCHCD_IOS_SS);
  325. continue;
  326. }
  327. if (reg & INTSTS_RERR) {
  328. printk(KERN_WARNING "%s: Response Error\n", SCC_PATA_NAME);
  329. out_be32((void __iomem *)intsts_port, INTSTS_RERR|INTSTS_BMSINT);
  330. out_be32((void __iomem *)hwif->dma_command, in_be32((void __iomem *)hwif->dma_command) & ~QCHCD_IOS_SS);
  331. continue;
  332. }
  333. if (reg & INTSTS_ICERR) {
  334. out_be32((void __iomem *)hwif->dma_command, in_be32((void __iomem *)hwif->dma_command) & ~QCHCD_IOS_SS);
  335. printk(KERN_WARNING "%s: Illegal Configuration\n", SCC_PATA_NAME);
  336. out_be32((void __iomem *)intsts_port, INTSTS_ICERR|INTSTS_BMSINT);
  337. continue;
  338. }
  339. if (reg & INTSTS_BMSINT) {
  340. printk(KERN_WARNING "%s: Internal Bus Error\n", SCC_PATA_NAME);
  341. out_be32((void __iomem *)intsts_port, INTSTS_BMSINT);
  342. ide_do_reset(drive);
  343. continue;
  344. }
  345. if (reg & INTSTS_BMHE) {
  346. out_be32((void __iomem *)intsts_port, INTSTS_BMHE);
  347. continue;
  348. }
  349. if (reg & INTSTS_ACTEINT) {
  350. out_be32((void __iomem *)intsts_port, INTSTS_ACTEINT);
  351. continue;
  352. }
  353. if (reg & INTSTS_IOIRQS) {
  354. out_be32((void __iomem *)intsts_port, INTSTS_IOIRQS);
  355. continue;
  356. }
  357. break;
  358. }
  359. dma_stat = __ide_dma_end(drive);
  360. if (data_loss)
  361. dma_stat |= 2; /* emulate DMA error (to retry command) */
  362. return dma_stat;
  363. }
  364. /* returns 1 if dma irq issued, 0 otherwise */
  365. static int scc_dma_test_irq(ide_drive_t *drive)
  366. {
  367. ide_hwif_t *hwif = HWIF(drive);
  368. u32 int_stat = in_be32((void __iomem *)hwif->dma_base + 0x014);
  369. /* SCC errata A252,A308 workaround: Step4 */
  370. if ((in_be32((void __iomem *)hwif->io_ports[IDE_ALTSTATUS_OFFSET])
  371. & ERR_STAT) &&
  372. (int_stat & INTSTS_INTRQ))
  373. return 1;
  374. /* SCC errata A308 workaround: Step5 (polling IOIRQS) */
  375. if (int_stat & INTSTS_IOIRQS)
  376. return 1;
  377. if (!drive->waiting_for_dma)
  378. printk(KERN_WARNING "%s: (%s) called while not waiting\n",
  379. drive->name, __FUNCTION__);
  380. return 0;
  381. }
  382. static u8 scc_udma_filter(ide_drive_t *drive)
  383. {
  384. ide_hwif_t *hwif = drive->hwif;
  385. u8 mask = hwif->ultra_mask;
  386. /* errata A308 workaround: limit non ide_disk drive to UDMA4 */
  387. if ((drive->media != ide_disk) && (mask & 0xE0)) {
  388. printk(KERN_INFO "%s: limit %s to UDMA4\n",
  389. SCC_PATA_NAME, drive->name);
  390. mask = ATA_UDMA4;
  391. }
  392. return mask;
  393. }
  394. /**
  395. * setup_mmio_scc - map CTRL/BMID region
  396. * @dev: PCI device we are configuring
  397. * @name: device name
  398. *
  399. */
  400. static int setup_mmio_scc (struct pci_dev *dev, const char *name)
  401. {
  402. unsigned long ctl_base = pci_resource_start(dev, 0);
  403. unsigned long dma_base = pci_resource_start(dev, 1);
  404. unsigned long ctl_size = pci_resource_len(dev, 0);
  405. unsigned long dma_size = pci_resource_len(dev, 1);
  406. void __iomem *ctl_addr;
  407. void __iomem *dma_addr;
  408. int i;
  409. for (i = 0; i < MAX_HWIFS; i++) {
  410. if (scc_ports[i].ctl == 0)
  411. break;
  412. }
  413. if (i >= MAX_HWIFS)
  414. return -ENOMEM;
  415. if (!request_mem_region(ctl_base, ctl_size, name)) {
  416. printk(KERN_WARNING "%s: IDE controller MMIO ports not available.\n", SCC_PATA_NAME);
  417. goto fail_0;
  418. }
  419. if (!request_mem_region(dma_base, dma_size, name)) {
  420. printk(KERN_WARNING "%s: IDE controller MMIO ports not available.\n", SCC_PATA_NAME);
  421. goto fail_1;
  422. }
  423. if ((ctl_addr = ioremap(ctl_base, ctl_size)) == NULL)
  424. goto fail_2;
  425. if ((dma_addr = ioremap(dma_base, dma_size)) == NULL)
  426. goto fail_3;
  427. pci_set_master(dev);
  428. scc_ports[i].ctl = (unsigned long)ctl_addr;
  429. scc_ports[i].dma = (unsigned long)dma_addr;
  430. pci_set_drvdata(dev, (void *) &scc_ports[i]);
  431. return 1;
  432. fail_3:
  433. iounmap(ctl_addr);
  434. fail_2:
  435. release_mem_region(dma_base, dma_size);
  436. fail_1:
  437. release_mem_region(ctl_base, ctl_size);
  438. fail_0:
  439. return -ENOMEM;
  440. }
  441. static int scc_ide_setup_pci_device(struct pci_dev *dev,
  442. const struct ide_port_info *d)
  443. {
  444. struct scc_ports *ports = pci_get_drvdata(dev);
  445. ide_hwif_t *hwif = NULL;
  446. hw_regs_t hw;
  447. u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
  448. int i;
  449. hwif = ide_find_port();
  450. if (hwif == NULL) {
  451. printk(KERN_ERR "%s: too many IDE interfaces, "
  452. "no room in table\n", SCC_PATA_NAME);
  453. return -ENOMEM;
  454. }
  455. memset(&hw, 0, sizeof(hw));
  456. for (i = IDE_DATA_OFFSET; i <= IDE_CONTROL_OFFSET; i++)
  457. hw.io_ports[i] = ports->dma + 0x20 + i * 4;
  458. hw.irq = dev->irq;
  459. hw.dev = &dev->dev;
  460. hw.chipset = ide_pci;
  461. ide_init_port_hw(hwif, &hw);
  462. hwif->dev = &dev->dev;
  463. hwif->cds = d;
  464. idx[0] = hwif->index;
  465. ide_device_add(idx, d);
  466. return 0;
  467. }
  468. /**
  469. * init_setup_scc - set up an SCC PATA Controller
  470. * @dev: PCI device
  471. * @d: IDE port info
  472. *
  473. * Perform the initial set up for this device.
  474. */
  475. static int __devinit init_setup_scc(struct pci_dev *dev,
  476. const struct ide_port_info *d)
  477. {
  478. unsigned long ctl_base;
  479. unsigned long dma_base;
  480. unsigned long cckctrl_port;
  481. unsigned long intmask_port;
  482. unsigned long mode_port;
  483. unsigned long ecmode_port;
  484. unsigned long dma_status_port;
  485. u32 reg = 0;
  486. struct scc_ports *ports;
  487. int rc;
  488. rc = pci_enable_device(dev);
  489. if (rc)
  490. goto end;
  491. rc = setup_mmio_scc(dev, d->name);
  492. if (rc < 0)
  493. goto end;
  494. ports = pci_get_drvdata(dev);
  495. ctl_base = ports->ctl;
  496. dma_base = ports->dma;
  497. cckctrl_port = ctl_base + 0xff0;
  498. intmask_port = dma_base + 0x010;
  499. mode_port = ctl_base + 0x024;
  500. ecmode_port = ctl_base + 0xf00;
  501. dma_status_port = dma_base + 0x004;
  502. /* controller initialization */
  503. reg = 0;
  504. out_be32((void*)cckctrl_port, reg);
  505. reg |= CCKCTRL_ATACLKOEN;
  506. out_be32((void*)cckctrl_port, reg);
  507. reg |= CCKCTRL_LCLKEN | CCKCTRL_OCLKEN;
  508. out_be32((void*)cckctrl_port, reg);
  509. reg |= CCKCTRL_CRST;
  510. out_be32((void*)cckctrl_port, reg);
  511. for (;;) {
  512. reg = in_be32((void*)cckctrl_port);
  513. if (reg & CCKCTRL_CRST)
  514. break;
  515. udelay(5000);
  516. }
  517. reg |= CCKCTRL_ATARESET;
  518. out_be32((void*)cckctrl_port, reg);
  519. out_be32((void*)ecmode_port, ECMODE_VALUE);
  520. out_be32((void*)mode_port, MODE_JCUSFEN);
  521. out_be32((void*)intmask_port, INTMASK_MSK);
  522. rc = scc_ide_setup_pci_device(dev, d);
  523. end:
  524. return rc;
  525. }
  526. /**
  527. * init_mmio_iops_scc - set up the iops for MMIO
  528. * @hwif: interface to set up
  529. *
  530. */
  531. static void __devinit init_mmio_iops_scc(ide_hwif_t *hwif)
  532. {
  533. struct pci_dev *dev = to_pci_dev(hwif->dev);
  534. struct scc_ports *ports = pci_get_drvdata(dev);
  535. unsigned long dma_base = ports->dma;
  536. ide_set_hwifdata(hwif, ports);
  537. hwif->INB = scc_ide_inb;
  538. hwif->INW = scc_ide_inw;
  539. hwif->INSW = scc_ide_insw;
  540. hwif->INSL = scc_ide_insl;
  541. hwif->OUTB = scc_ide_outb;
  542. hwif->OUTBSYNC = scc_ide_outbsync;
  543. hwif->OUTW = scc_ide_outw;
  544. hwif->OUTSW = scc_ide_outsw;
  545. hwif->OUTSL = scc_ide_outsl;
  546. hwif->dma_base = dma_base;
  547. hwif->config_data = ports->ctl;
  548. hwif->mmio = 1;
  549. }
  550. /**
  551. * init_iops_scc - set up iops
  552. * @hwif: interface to set up
  553. *
  554. * Do the basic setup for the SCC hardware interface
  555. * and then do the MMIO setup.
  556. */
  557. static void __devinit init_iops_scc(ide_hwif_t *hwif)
  558. {
  559. struct pci_dev *dev = to_pci_dev(hwif->dev);
  560. hwif->hwif_data = NULL;
  561. if (pci_get_drvdata(dev) == NULL)
  562. return;
  563. init_mmio_iops_scc(hwif);
  564. }
  565. static u8 __devinit scc_cable_detect(ide_hwif_t *hwif)
  566. {
  567. return ATA_CBL_PATA80;
  568. }
  569. /**
  570. * init_hwif_scc - set up hwif
  571. * @hwif: interface to set up
  572. *
  573. * We do the basic set up of the interface structure. The SCC
  574. * requires several custom handlers so we override the default
  575. * ide DMA handlers appropriately.
  576. */
  577. static void __devinit init_hwif_scc(ide_hwif_t *hwif)
  578. {
  579. struct scc_ports *ports = ide_get_hwifdata(hwif);
  580. ports->hwif = hwif;
  581. hwif->dma_command = hwif->dma_base;
  582. hwif->dma_status = hwif->dma_base + 0x04;
  583. hwif->dma_prdtable = hwif->dma_base + 0x08;
  584. /* PTERADD */
  585. out_be32((void __iomem *)(hwif->dma_base + 0x018), hwif->dmatable_dma);
  586. hwif->dma_setup = scc_dma_setup;
  587. hwif->ide_dma_end = scc_ide_dma_end;
  588. hwif->set_pio_mode = scc_set_pio_mode;
  589. hwif->set_dma_mode = scc_set_dma_mode;
  590. hwif->ide_dma_test_irq = scc_dma_test_irq;
  591. hwif->udma_filter = scc_udma_filter;
  592. if (in_be32((void __iomem *)(hwif->config_data + 0xff0)) & CCKCTRL_ATACLKOEN)
  593. hwif->ultra_mask = ATA_UDMA6; /* 133MHz */
  594. else
  595. hwif->ultra_mask = ATA_UDMA5; /* 100MHz */
  596. hwif->cable_detect = scc_cable_detect;
  597. }
  598. #define DECLARE_SCC_DEV(name_str) \
  599. { \
  600. .name = name_str, \
  601. .init_iops = init_iops_scc, \
  602. .init_hwif = init_hwif_scc, \
  603. .host_flags = IDE_HFLAG_SINGLE, \
  604. .pio_mask = ATA_PIO4, \
  605. }
  606. static const struct ide_port_info scc_chipsets[] __devinitdata = {
  607. /* 0 */ DECLARE_SCC_DEV("sccIDE"),
  608. };
  609. /**
  610. * scc_init_one - pci layer discovery entry
  611. * @dev: PCI device
  612. * @id: ident table entry
  613. *
  614. * Called by the PCI code when it finds an SCC PATA controller.
  615. * We then use the IDE PCI generic helper to do most of the work.
  616. */
  617. static int __devinit scc_init_one(struct pci_dev *dev, const struct pci_device_id *id)
  618. {
  619. return init_setup_scc(dev, &scc_chipsets[id->driver_data]);
  620. }
  621. /**
  622. * scc_remove - pci layer remove entry
  623. * @dev: PCI device
  624. *
  625. * Called by the PCI code when it removes an SCC PATA controller.
  626. */
  627. static void __devexit scc_remove(struct pci_dev *dev)
  628. {
  629. struct scc_ports *ports = pci_get_drvdata(dev);
  630. ide_hwif_t *hwif = ports->hwif;
  631. unsigned long ctl_base = pci_resource_start(dev, 0);
  632. unsigned long dma_base = pci_resource_start(dev, 1);
  633. unsigned long ctl_size = pci_resource_len(dev, 0);
  634. unsigned long dma_size = pci_resource_len(dev, 1);
  635. if (hwif->dmatable_cpu) {
  636. pci_free_consistent(dev, PRD_ENTRIES * PRD_BYTES,
  637. hwif->dmatable_cpu, hwif->dmatable_dma);
  638. hwif->dmatable_cpu = NULL;
  639. }
  640. ide_unregister(hwif->index);
  641. hwif->chipset = ide_unknown;
  642. iounmap((void*)ports->dma);
  643. iounmap((void*)ports->ctl);
  644. release_mem_region(dma_base, dma_size);
  645. release_mem_region(ctl_base, ctl_size);
  646. memset(ports, 0, sizeof(*ports));
  647. }
  648. static const struct pci_device_id scc_pci_tbl[] = {
  649. { PCI_VDEVICE(TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_SCC_ATA), 0 },
  650. { 0, },
  651. };
  652. MODULE_DEVICE_TABLE(pci, scc_pci_tbl);
  653. static struct pci_driver driver = {
  654. .name = "SCC IDE",
  655. .id_table = scc_pci_tbl,
  656. .probe = scc_init_one,
  657. .remove = scc_remove,
  658. };
  659. static int scc_ide_init(void)
  660. {
  661. return ide_pci_register_driver(&driver);
  662. }
  663. module_init(scc_ide_init);
  664. /* -- No exit code?
  665. static void scc_ide_exit(void)
  666. {
  667. ide_pci_unregister_driver(&driver);
  668. }
  669. module_exit(scc_ide_exit);
  670. */
  671. MODULE_DESCRIPTION("PCI driver module for Toshiba SCC IDE");
  672. MODULE_LICENSE("GPL");