scc_pata.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812
  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. unsigned char hwif_id; /* for removing hwif 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 u32 scc_ide_inl(unsigned long port)
  112. {
  113. u32 data = in_be32((void*)port);
  114. return data;
  115. }
  116. static void scc_ide_insw(unsigned long port, void *addr, u32 count)
  117. {
  118. u16 *ptr = (u16 *)addr;
  119. while (count--) {
  120. *ptr++ = le16_to_cpu(in_be32((void*)port));
  121. }
  122. }
  123. static void scc_ide_insl(unsigned long port, void *addr, u32 count)
  124. {
  125. u16 *ptr = (u16 *)addr;
  126. while (count--) {
  127. *ptr++ = le16_to_cpu(in_be32((void*)port));
  128. *ptr++ = le16_to_cpu(in_be32((void*)port));
  129. }
  130. }
  131. static void scc_ide_outb(u8 addr, unsigned long port)
  132. {
  133. out_be32((void*)port, addr);
  134. }
  135. static void scc_ide_outw(u16 addr, unsigned long port)
  136. {
  137. out_be32((void*)port, addr);
  138. }
  139. static void scc_ide_outl(u32 addr, unsigned long port)
  140. {
  141. out_be32((void*)port, addr);
  142. }
  143. static void
  144. scc_ide_outbsync(ide_drive_t * drive, u8 addr, unsigned long port)
  145. {
  146. ide_hwif_t *hwif = HWIF(drive);
  147. out_be32((void*)port, addr);
  148. __asm__ __volatile__("eieio":::"memory");
  149. in_be32((void*)(hwif->dma_base + 0x01c));
  150. __asm__ __volatile__("eieio":::"memory");
  151. }
  152. static void
  153. scc_ide_outsw(unsigned long port, void *addr, u32 count)
  154. {
  155. u16 *ptr = (u16 *)addr;
  156. while (count--) {
  157. out_be32((void*)port, cpu_to_le16(*ptr++));
  158. }
  159. }
  160. static void
  161. scc_ide_outsl(unsigned long port, void *addr, u32 count)
  162. {
  163. u16 *ptr = (u16 *)addr;
  164. while (count--) {
  165. out_be32((void*)port, cpu_to_le16(*ptr++));
  166. out_be32((void*)port, cpu_to_le16(*ptr++));
  167. }
  168. }
  169. /**
  170. * scc_ratemask - Compute available modes
  171. * @drive: IDE drive
  172. *
  173. * Compute the available speeds for the devices on the interface.
  174. * Enforce UDMA33 as a limit if there is no 80pin cable present.
  175. */
  176. static u8 scc_ratemask(ide_drive_t *drive)
  177. {
  178. u8 mode = 4;
  179. if (!eighty_ninty_three(drive))
  180. mode = min(mode, (u8)1);
  181. return mode;
  182. }
  183. /**
  184. * scc_tuneproc - tune a drive PIO mode
  185. * @drive: drive to tune
  186. * @mode_wanted: the target operating mode
  187. *
  188. * Load the timing settings for this device mode into the
  189. * controller.
  190. */
  191. static void scc_tuneproc(ide_drive_t *drive, byte mode_wanted)
  192. {
  193. ide_hwif_t *hwif = HWIF(drive);
  194. struct scc_ports *ports = ide_get_hwifdata(hwif);
  195. unsigned long ctl_base = ports->ctl;
  196. unsigned long cckctrl_port = ctl_base + 0xff0;
  197. unsigned long piosht_port = ctl_base + 0x000;
  198. unsigned long pioct_port = ctl_base + 0x004;
  199. unsigned long reg;
  200. unsigned char speed = XFER_PIO_0;
  201. int offset;
  202. mode_wanted = ide_get_best_pio_mode(drive, mode_wanted, 4, NULL);
  203. switch (mode_wanted) {
  204. case 4:
  205. speed = XFER_PIO_4;
  206. break;
  207. case 3:
  208. speed = XFER_PIO_3;
  209. break;
  210. case 2:
  211. speed = XFER_PIO_2;
  212. break;
  213. case 1:
  214. speed = XFER_PIO_1;
  215. break;
  216. case 0:
  217. default:
  218. speed = XFER_PIO_0;
  219. break;
  220. }
  221. reg = hwif->INL(cckctrl_port);
  222. if (reg & CCKCTRL_ATACLKOEN) {
  223. offset = 1; /* 133MHz */
  224. } else {
  225. offset = 0; /* 100MHz */
  226. }
  227. reg = JCHSTtbl[offset][mode_wanted] << 16 | JCHHTtbl[offset][mode_wanted];
  228. hwif->OUTL(reg, piosht_port);
  229. reg = JCHCTtbl[offset][mode_wanted];
  230. hwif->OUTL(reg, pioct_port);
  231. ide_config_drive_speed(drive, speed);
  232. }
  233. /**
  234. * scc_tune_chipset - tune a drive DMA mode
  235. * @drive: Drive to set up
  236. * @xferspeed: speed we want to achieve
  237. *
  238. * Load the timing settings for this device mode into the
  239. * controller.
  240. */
  241. static int scc_tune_chipset(ide_drive_t *drive, byte xferspeed)
  242. {
  243. ide_hwif_t *hwif = HWIF(drive);
  244. u8 speed = ide_rate_filter(scc_ratemask(drive), xferspeed);
  245. struct scc_ports *ports = ide_get_hwifdata(hwif);
  246. unsigned long ctl_base = ports->ctl;
  247. unsigned long cckctrl_port = ctl_base + 0xff0;
  248. unsigned long mdmact_port = ctl_base + 0x008;
  249. unsigned long mcrcst_port = ctl_base + 0x00c;
  250. unsigned long sdmact_port = ctl_base + 0x010;
  251. unsigned long scrcst_port = ctl_base + 0x014;
  252. unsigned long udenvt_port = ctl_base + 0x018;
  253. unsigned long tdvhsel_port = ctl_base + 0x020;
  254. int is_slave = (&hwif->drives[1] == drive);
  255. int offset, idx;
  256. unsigned long reg;
  257. unsigned long jcactsel;
  258. reg = hwif->INL(cckctrl_port);
  259. if (reg & CCKCTRL_ATACLKOEN) {
  260. offset = 1; /* 133MHz */
  261. } else {
  262. offset = 0; /* 100MHz */
  263. }
  264. switch (speed) {
  265. case XFER_UDMA_6:
  266. idx = 6;
  267. break;
  268. case XFER_UDMA_5:
  269. idx = 5;
  270. break;
  271. case XFER_UDMA_4:
  272. idx = 4;
  273. break;
  274. case XFER_UDMA_3:
  275. idx = 3;
  276. break;
  277. case XFER_UDMA_2:
  278. idx = 2;
  279. break;
  280. case XFER_UDMA_1:
  281. idx = 1;
  282. break;
  283. case XFER_UDMA_0:
  284. idx = 0;
  285. break;
  286. default:
  287. return 1;
  288. }
  289. jcactsel = JCACTSELtbl[offset][idx];
  290. if (is_slave) {
  291. hwif->OUTL(JCHDCTxtbl[offset][idx], sdmact_port);
  292. hwif->OUTL(JCSTWTxtbl[offset][idx], scrcst_port);
  293. jcactsel = jcactsel << 2 ;
  294. hwif->OUTL( (hwif->INL( tdvhsel_port ) & ~TDVHSEL_SLAVE) | jcactsel, tdvhsel_port );
  295. } else {
  296. hwif->OUTL(JCHDCTxtbl[offset][idx], mdmact_port);
  297. hwif->OUTL(JCSTWTxtbl[offset][idx], mcrcst_port);
  298. hwif->OUTL( (hwif->INL( tdvhsel_port ) & ~TDVHSEL_MASTER) | jcactsel, tdvhsel_port );
  299. }
  300. reg = JCTSStbl[offset][idx] << 16 | JCENVTtbl[offset][idx];
  301. hwif->OUTL(reg, udenvt_port);
  302. return ide_config_drive_speed(drive, speed);
  303. }
  304. /**
  305. * scc_config_chipset_for_dma - configure for DMA
  306. * @drive: drive to configure
  307. *
  308. * Called by scc_config_drive_for_dma().
  309. */
  310. static int scc_config_chipset_for_dma(ide_drive_t *drive)
  311. {
  312. u8 speed = ide_dma_speed(drive, scc_ratemask(drive));
  313. if (!speed)
  314. return 0;
  315. if (ide_set_xfer_rate(drive, speed))
  316. return 0;
  317. if (!drive->init_speed)
  318. drive->init_speed = speed;
  319. return ide_dma_enable(drive);
  320. }
  321. /**
  322. * scc_configure_drive_for_dma - set up for DMA transfers
  323. * @drive: drive we are going to set up
  324. *
  325. * Set up the drive for DMA, tune the controller and drive as
  326. * required.
  327. * If the drive isn't suitable for DMA or we hit other problems
  328. * then we will drop down to PIO and set up PIO appropriately.
  329. * (return 1)
  330. */
  331. static int scc_config_drive_for_dma(ide_drive_t *drive)
  332. {
  333. ide_hwif_t *hwif = HWIF(drive);
  334. struct hd_driveid *id = drive->id;
  335. if ((id->capability & 1) != 0 && drive->autodma) {
  336. if (ide_use_dma(drive)) {
  337. if (scc_config_chipset_for_dma(drive))
  338. return hwif->ide_dma_on(drive);
  339. }
  340. goto fast_ata_pio;
  341. } else if ((id->capability & 8) || (id->field_valid & 2)) {
  342. fast_ata_pio:
  343. hwif->tuneproc(drive, 4);
  344. hwif->ide_dma_off_quietly(drive);
  345. }
  346. return 1; /* DMA is not supported */
  347. }
  348. /**
  349. * scc_ide_dma_end - Stop DMA
  350. * @drive: IDE drive
  351. *
  352. * Check and clear INT Status register.
  353. * Then call __ide_dma_end().
  354. */
  355. static int scc_ide_dma_end(ide_drive_t * drive)
  356. {
  357. ide_hwif_t *hwif = HWIF(drive);
  358. unsigned long intsts_port = hwif->dma_base + 0x014;
  359. u32 reg;
  360. while (1) {
  361. reg = hwif->INL(intsts_port);
  362. if (reg & INTSTS_SERROR) {
  363. printk(KERN_WARNING "%s: SERROR\n", SCC_PATA_NAME);
  364. hwif->OUTL(INTSTS_SERROR|INTSTS_BMSINT, intsts_port);
  365. hwif->OUTB(hwif->INB(hwif->dma_command) & ~QCHCD_IOS_SS,
  366. hwif->dma_command);
  367. continue;
  368. }
  369. if (reg & INTSTS_PRERR) {
  370. u32 maea0, maec0;
  371. unsigned long ctl_base = hwif->config_data;
  372. maea0 = hwif->INL(ctl_base + 0xF50);
  373. maec0 = hwif->INL(ctl_base + 0xF54);
  374. printk(KERN_WARNING "%s: PRERR [addr:%x cmd:%x]\n", SCC_PATA_NAME, maea0, maec0);
  375. hwif->OUTL(INTSTS_PRERR|INTSTS_BMSINT, intsts_port);
  376. hwif->OUTB(hwif->INB(hwif->dma_command) & ~QCHCD_IOS_SS,
  377. hwif->dma_command);
  378. continue;
  379. }
  380. if (reg & INTSTS_RERR) {
  381. printk(KERN_WARNING "%s: Response Error\n", SCC_PATA_NAME);
  382. hwif->OUTL(INTSTS_RERR|INTSTS_BMSINT, intsts_port);
  383. hwif->OUTB(hwif->INB(hwif->dma_command) & ~QCHCD_IOS_SS,
  384. hwif->dma_command);
  385. continue;
  386. }
  387. if (reg & INTSTS_ICERR) {
  388. hwif->OUTB(hwif->INB(hwif->dma_command) & ~QCHCD_IOS_SS,
  389. hwif->dma_command);
  390. printk(KERN_WARNING "%s: Illegal Configuration\n", SCC_PATA_NAME);
  391. hwif->OUTL(INTSTS_ICERR|INTSTS_BMSINT, intsts_port);
  392. continue;
  393. }
  394. if (reg & INTSTS_BMSINT) {
  395. printk(KERN_WARNING "%s: Internal Bus Error\n", SCC_PATA_NAME);
  396. hwif->OUTL(INTSTS_BMSINT, intsts_port);
  397. ide_do_reset(drive);
  398. continue;
  399. }
  400. if (reg & INTSTS_BMHE) {
  401. hwif->OUTL(INTSTS_BMHE, intsts_port);
  402. continue;
  403. }
  404. if (reg & INTSTS_ACTEINT) {
  405. hwif->OUTL(INTSTS_ACTEINT, intsts_port);
  406. continue;
  407. }
  408. if (reg & INTSTS_IOIRQS) {
  409. hwif->OUTL(INTSTS_IOIRQS, intsts_port);
  410. continue;
  411. }
  412. break;
  413. }
  414. return __ide_dma_end(drive);
  415. }
  416. /**
  417. * setup_mmio_scc - map CTRL/BMID region
  418. * @dev: PCI device we are configuring
  419. * @name: device name
  420. *
  421. */
  422. static int setup_mmio_scc (struct pci_dev *dev, const char *name)
  423. {
  424. unsigned long ctl_base = pci_resource_start(dev, 0);
  425. unsigned long dma_base = pci_resource_start(dev, 1);
  426. unsigned long ctl_size = pci_resource_len(dev, 0);
  427. unsigned long dma_size = pci_resource_len(dev, 1);
  428. void *ctl_addr;
  429. void *dma_addr;
  430. int i;
  431. for (i = 0; i < MAX_HWIFS; i++) {
  432. if (scc_ports[i].ctl == 0)
  433. break;
  434. }
  435. if (i >= MAX_HWIFS)
  436. return -ENOMEM;
  437. if (!request_mem_region(ctl_base, ctl_size, name)) {
  438. printk(KERN_WARNING "%s: IDE controller MMIO ports not available.\n", SCC_PATA_NAME);
  439. goto fail_0;
  440. }
  441. if (!request_mem_region(dma_base, dma_size, name)) {
  442. printk(KERN_WARNING "%s: IDE controller MMIO ports not available.\n", SCC_PATA_NAME);
  443. goto fail_1;
  444. }
  445. if ((ctl_addr = ioremap(ctl_base, ctl_size)) == NULL)
  446. goto fail_2;
  447. if ((dma_addr = ioremap(dma_base, dma_size)) == NULL)
  448. goto fail_3;
  449. pci_set_master(dev);
  450. scc_ports[i].ctl = (unsigned long)ctl_addr;
  451. scc_ports[i].dma = (unsigned long)dma_addr;
  452. pci_set_drvdata(dev, (void *) &scc_ports[i]);
  453. return 1;
  454. fail_3:
  455. iounmap(ctl_addr);
  456. fail_2:
  457. release_mem_region(dma_base, dma_size);
  458. fail_1:
  459. release_mem_region(ctl_base, ctl_size);
  460. fail_0:
  461. return -ENOMEM;
  462. }
  463. /**
  464. * init_setup_scc - set up an SCC PATA Controller
  465. * @dev: PCI device
  466. * @d: IDE PCI device
  467. *
  468. * Perform the initial set up for this device.
  469. */
  470. static int __devinit init_setup_scc(struct pci_dev *dev, ide_pci_device_t *d)
  471. {
  472. unsigned long ctl_base;
  473. unsigned long dma_base;
  474. unsigned long cckctrl_port;
  475. unsigned long intmask_port;
  476. unsigned long mode_port;
  477. unsigned long ecmode_port;
  478. unsigned long dma_status_port;
  479. u32 reg = 0;
  480. struct scc_ports *ports;
  481. int rc;
  482. rc = setup_mmio_scc(dev, d->name);
  483. if (rc < 0) {
  484. return rc;
  485. }
  486. ports = pci_get_drvdata(dev);
  487. ctl_base = ports->ctl;
  488. dma_base = ports->dma;
  489. cckctrl_port = ctl_base + 0xff0;
  490. intmask_port = dma_base + 0x010;
  491. mode_port = ctl_base + 0x024;
  492. ecmode_port = ctl_base + 0xf00;
  493. dma_status_port = dma_base + 0x004;
  494. /* controller initialization */
  495. reg = 0;
  496. out_be32((void*)cckctrl_port, reg);
  497. reg |= CCKCTRL_ATACLKOEN;
  498. out_be32((void*)cckctrl_port, reg);
  499. reg |= CCKCTRL_LCLKEN | CCKCTRL_OCLKEN;
  500. out_be32((void*)cckctrl_port, reg);
  501. reg |= CCKCTRL_CRST;
  502. out_be32((void*)cckctrl_port, reg);
  503. for (;;) {
  504. reg = in_be32((void*)cckctrl_port);
  505. if (reg & CCKCTRL_CRST)
  506. break;
  507. udelay(5000);
  508. }
  509. reg |= CCKCTRL_ATARESET;
  510. out_be32((void*)cckctrl_port, reg);
  511. out_be32((void*)ecmode_port, ECMODE_VALUE);
  512. out_be32((void*)mode_port, MODE_JCUSFEN);
  513. out_be32((void*)intmask_port, INTMASK_MSK);
  514. return ide_setup_pci_device(dev, d);
  515. }
  516. /**
  517. * init_mmio_iops_scc - set up the iops for MMIO
  518. * @hwif: interface to set up
  519. *
  520. */
  521. static void __devinit init_mmio_iops_scc(ide_hwif_t *hwif)
  522. {
  523. struct pci_dev *dev = hwif->pci_dev;
  524. struct scc_ports *ports = pci_get_drvdata(dev);
  525. unsigned long dma_base = ports->dma;
  526. ide_set_hwifdata(hwif, ports);
  527. hwif->INB = scc_ide_inb;
  528. hwif->INW = scc_ide_inw;
  529. hwif->INL = scc_ide_inl;
  530. hwif->INSW = scc_ide_insw;
  531. hwif->INSL = scc_ide_insl;
  532. hwif->OUTB = scc_ide_outb;
  533. hwif->OUTBSYNC = scc_ide_outbsync;
  534. hwif->OUTW = scc_ide_outw;
  535. hwif->OUTL = scc_ide_outl;
  536. hwif->OUTSW = scc_ide_outsw;
  537. hwif->OUTSL = scc_ide_outsl;
  538. hwif->io_ports[IDE_DATA_OFFSET] = dma_base + 0x20;
  539. hwif->io_ports[IDE_ERROR_OFFSET] = dma_base + 0x24;
  540. hwif->io_ports[IDE_NSECTOR_OFFSET] = dma_base + 0x28;
  541. hwif->io_ports[IDE_SECTOR_OFFSET] = dma_base + 0x2c;
  542. hwif->io_ports[IDE_LCYL_OFFSET] = dma_base + 0x30;
  543. hwif->io_ports[IDE_HCYL_OFFSET] = dma_base + 0x34;
  544. hwif->io_ports[IDE_SELECT_OFFSET] = dma_base + 0x38;
  545. hwif->io_ports[IDE_STATUS_OFFSET] = dma_base + 0x3c;
  546. hwif->io_ports[IDE_CONTROL_OFFSET] = dma_base + 0x40;
  547. hwif->irq = hwif->pci_dev->irq;
  548. hwif->dma_base = dma_base;
  549. hwif->config_data = ports->ctl;
  550. hwif->mmio = 2;
  551. }
  552. /**
  553. * init_iops_scc - set up iops
  554. * @hwif: interface to set up
  555. *
  556. * Do the basic setup for the SCC hardware interface
  557. * and then do the MMIO setup.
  558. */
  559. static void __devinit init_iops_scc(ide_hwif_t *hwif)
  560. {
  561. struct pci_dev *dev = hwif->pci_dev;
  562. hwif->hwif_data = NULL;
  563. if (pci_get_drvdata(dev) == NULL)
  564. return;
  565. init_mmio_iops_scc(hwif);
  566. }
  567. /**
  568. * init_hwif_scc - set up hwif
  569. * @hwif: interface to set up
  570. *
  571. * We do the basic set up of the interface structure. The SCC
  572. * requires several custom handlers so we override the default
  573. * ide DMA handlers appropriately.
  574. */
  575. static void __devinit init_hwif_scc(ide_hwif_t *hwif)
  576. {
  577. struct scc_ports *ports = ide_get_hwifdata(hwif);
  578. ports->hwif_id = hwif->index;
  579. hwif->dma_command = hwif->dma_base;
  580. hwif->dma_status = hwif->dma_base + 0x04;
  581. hwif->dma_prdtable = hwif->dma_base + 0x08;
  582. hwif->OUTL(hwif->dmatable_dma, (hwif->dma_base + 0x018)); /* PTERADD */
  583. hwif->ide_dma_end = scc_ide_dma_end;
  584. hwif->speedproc = scc_tune_chipset;
  585. hwif->tuneproc = scc_tuneproc;
  586. hwif->ide_dma_check = scc_config_drive_for_dma;
  587. hwif->drives[0].autotune = IDE_TUNE_AUTO;
  588. hwif->drives[1].autotune = IDE_TUNE_AUTO;
  589. if (hwif->INL(hwif->config_data + 0xff0) & CCKCTRL_ATACLKOEN) {
  590. hwif->ultra_mask = 0x7f; /* 133MHz */
  591. } else {
  592. hwif->ultra_mask = 0x3f; /* 100MHz */
  593. }
  594. hwif->mwdma_mask = 0x00;
  595. hwif->swdma_mask = 0x00;
  596. hwif->atapi_dma = 1;
  597. /* we support 80c cable only. */
  598. hwif->udma_four = 1;
  599. hwif->autodma = 0;
  600. if (!noautodma)
  601. hwif->autodma = 1;
  602. hwif->drives[0].autodma = hwif->autodma;
  603. hwif->drives[1].autodma = hwif->autodma;
  604. }
  605. #define DECLARE_SCC_DEV(name_str) \
  606. { \
  607. .name = name_str, \
  608. .init_setup = init_setup_scc, \
  609. .init_iops = init_iops_scc, \
  610. .init_hwif = init_hwif_scc, \
  611. .channels = 1, \
  612. .autodma = AUTODMA, \
  613. .bootable = ON_BOARD, \
  614. }
  615. static ide_pci_device_t scc_chipsets[] __devinitdata = {
  616. /* 0 */ DECLARE_SCC_DEV("sccIDE"),
  617. };
  618. /**
  619. * scc_init_one - pci layer discovery entry
  620. * @dev: PCI device
  621. * @id: ident table entry
  622. *
  623. * Called by the PCI code when it finds an SCC PATA controller.
  624. * We then use the IDE PCI generic helper to do most of the work.
  625. */
  626. static int __devinit scc_init_one(struct pci_dev *dev, const struct pci_device_id *id)
  627. {
  628. ide_pci_device_t *d = &scc_chipsets[id->driver_data];
  629. return d->init_setup(dev, d);
  630. }
  631. /**
  632. * scc_remove - pci layer remove entry
  633. * @dev: PCI device
  634. *
  635. * Called by the PCI code when it removes an SCC PATA controller.
  636. */
  637. static void __devexit scc_remove(struct pci_dev *dev)
  638. {
  639. struct scc_ports *ports = pci_get_drvdata(dev);
  640. ide_hwif_t *hwif = &ide_hwifs[ports->hwif_id];
  641. unsigned long ctl_base = pci_resource_start(dev, 0);
  642. unsigned long dma_base = pci_resource_start(dev, 1);
  643. unsigned long ctl_size = pci_resource_len(dev, 0);
  644. unsigned long dma_size = pci_resource_len(dev, 1);
  645. if (hwif->dmatable_cpu) {
  646. pci_free_consistent(hwif->pci_dev,
  647. PRD_ENTRIES * PRD_BYTES,
  648. hwif->dmatable_cpu,
  649. hwif->dmatable_dma);
  650. hwif->dmatable_cpu = NULL;
  651. }
  652. ide_unregister(hwif->index);
  653. hwif->chipset = ide_unknown;
  654. iounmap((void*)ports->dma);
  655. iounmap((void*)ports->ctl);
  656. release_mem_region(dma_base, dma_size);
  657. release_mem_region(ctl_base, ctl_size);
  658. memset(ports, 0, sizeof(*ports));
  659. }
  660. static struct pci_device_id scc_pci_tbl[] = {
  661. { PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_SCC_ATA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  662. { 0, },
  663. };
  664. MODULE_DEVICE_TABLE(pci, scc_pci_tbl);
  665. static struct pci_driver driver = {
  666. .name = "SCC IDE",
  667. .id_table = scc_pci_tbl,
  668. .probe = scc_init_one,
  669. .remove = scc_remove,
  670. };
  671. static int scc_ide_init(void)
  672. {
  673. return ide_pci_register_driver(&driver);
  674. }
  675. module_init(scc_ide_init);
  676. /* -- No exit code?
  677. static void scc_ide_exit(void)
  678. {
  679. ide_pci_unregister_driver(&driver);
  680. }
  681. module_exit(scc_ide_exit);
  682. */
  683. MODULE_DESCRIPTION("PCI driver module for Toshiba SCC IDE");
  684. MODULE_LICENSE("GPL");