icside.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837
  1. /*
  2. * linux/drivers/ide/arm/icside.c
  3. *
  4. * Copyright (c) 1996-2004 Russell King.
  5. *
  6. * Please note that this platform does not support 32-bit IDE IO.
  7. */
  8. #include <linux/string.h>
  9. #include <linux/module.h>
  10. #include <linux/ioport.h>
  11. #include <linux/slab.h>
  12. #include <linux/blkdev.h>
  13. #include <linux/errno.h>
  14. #include <linux/hdreg.h>
  15. #include <linux/ide.h>
  16. #include <linux/dma-mapping.h>
  17. #include <linux/device.h>
  18. #include <linux/init.h>
  19. #include <linux/scatterlist.h>
  20. #include <asm/dma.h>
  21. #include <asm/ecard.h>
  22. #include <asm/io.h>
  23. #define ICS_IDENT_OFFSET 0x2280
  24. #define ICS_ARCIN_V5_INTRSTAT 0x0000
  25. #define ICS_ARCIN_V5_INTROFFSET 0x0004
  26. #define ICS_ARCIN_V5_IDEOFFSET 0x2800
  27. #define ICS_ARCIN_V5_IDEALTOFFSET 0x2b80
  28. #define ICS_ARCIN_V5_IDESTEPPING 6
  29. #define ICS_ARCIN_V6_IDEOFFSET_1 0x2000
  30. #define ICS_ARCIN_V6_INTROFFSET_1 0x2200
  31. #define ICS_ARCIN_V6_INTRSTAT_1 0x2290
  32. #define ICS_ARCIN_V6_IDEALTOFFSET_1 0x2380
  33. #define ICS_ARCIN_V6_IDEOFFSET_2 0x3000
  34. #define ICS_ARCIN_V6_INTROFFSET_2 0x3200
  35. #define ICS_ARCIN_V6_INTRSTAT_2 0x3290
  36. #define ICS_ARCIN_V6_IDEALTOFFSET_2 0x3380
  37. #define ICS_ARCIN_V6_IDESTEPPING 6
  38. struct cardinfo {
  39. unsigned int dataoffset;
  40. unsigned int ctrloffset;
  41. unsigned int stepping;
  42. };
  43. static struct cardinfo icside_cardinfo_v5 = {
  44. .dataoffset = ICS_ARCIN_V5_IDEOFFSET,
  45. .ctrloffset = ICS_ARCIN_V5_IDEALTOFFSET,
  46. .stepping = ICS_ARCIN_V5_IDESTEPPING,
  47. };
  48. static struct cardinfo icside_cardinfo_v6_1 = {
  49. .dataoffset = ICS_ARCIN_V6_IDEOFFSET_1,
  50. .ctrloffset = ICS_ARCIN_V6_IDEALTOFFSET_1,
  51. .stepping = ICS_ARCIN_V6_IDESTEPPING,
  52. };
  53. static struct cardinfo icside_cardinfo_v6_2 = {
  54. .dataoffset = ICS_ARCIN_V6_IDEOFFSET_2,
  55. .ctrloffset = ICS_ARCIN_V6_IDEALTOFFSET_2,
  56. .stepping = ICS_ARCIN_V6_IDESTEPPING,
  57. };
  58. struct icside_state {
  59. unsigned int channel;
  60. unsigned int enabled;
  61. void __iomem *irq_port;
  62. void __iomem *ioc_base;
  63. unsigned int type;
  64. /* parent device... until the IDE core gets one of its own */
  65. struct device *dev;
  66. ide_hwif_t *hwif[2];
  67. };
  68. #define ICS_TYPE_A3IN 0
  69. #define ICS_TYPE_A3USER 1
  70. #define ICS_TYPE_V6 3
  71. #define ICS_TYPE_V5 15
  72. #define ICS_TYPE_NOTYPE ((unsigned int)-1)
  73. /* ---------------- Version 5 PCB Support Functions --------------------- */
  74. /* Prototype: icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr)
  75. * Purpose : enable interrupts from card
  76. */
  77. static void icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr)
  78. {
  79. struct icside_state *state = ec->irq_data;
  80. writeb(0, state->irq_port + ICS_ARCIN_V5_INTROFFSET);
  81. }
  82. /* Prototype: icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr)
  83. * Purpose : disable interrupts from card
  84. */
  85. static void icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr)
  86. {
  87. struct icside_state *state = ec->irq_data;
  88. readb(state->irq_port + ICS_ARCIN_V5_INTROFFSET);
  89. }
  90. static const expansioncard_ops_t icside_ops_arcin_v5 = {
  91. .irqenable = icside_irqenable_arcin_v5,
  92. .irqdisable = icside_irqdisable_arcin_v5,
  93. };
  94. /* ---------------- Version 6 PCB Support Functions --------------------- */
  95. /* Prototype: icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr)
  96. * Purpose : enable interrupts from card
  97. */
  98. static void icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr)
  99. {
  100. struct icside_state *state = ec->irq_data;
  101. void __iomem *base = state->irq_port;
  102. state->enabled = 1;
  103. switch (state->channel) {
  104. case 0:
  105. writeb(0, base + ICS_ARCIN_V6_INTROFFSET_1);
  106. readb(base + ICS_ARCIN_V6_INTROFFSET_2);
  107. break;
  108. case 1:
  109. writeb(0, base + ICS_ARCIN_V6_INTROFFSET_2);
  110. readb(base + ICS_ARCIN_V6_INTROFFSET_1);
  111. break;
  112. }
  113. }
  114. /* Prototype: icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr)
  115. * Purpose : disable interrupts from card
  116. */
  117. static void icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr)
  118. {
  119. struct icside_state *state = ec->irq_data;
  120. state->enabled = 0;
  121. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
  122. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
  123. }
  124. /* Prototype: icside_irqprobe(struct expansion_card *ec)
  125. * Purpose : detect an active interrupt from card
  126. */
  127. static int icside_irqpending_arcin_v6(struct expansion_card *ec)
  128. {
  129. struct icside_state *state = ec->irq_data;
  130. return readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_1) & 1 ||
  131. readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_2) & 1;
  132. }
  133. static const expansioncard_ops_t icside_ops_arcin_v6 = {
  134. .irqenable = icside_irqenable_arcin_v6,
  135. .irqdisable = icside_irqdisable_arcin_v6,
  136. .irqpending = icside_irqpending_arcin_v6,
  137. };
  138. /*
  139. * Handle routing of interrupts. This is called before
  140. * we write the command to the drive.
  141. */
  142. static void icside_maskproc(ide_drive_t *drive, int mask)
  143. {
  144. ide_hwif_t *hwif = HWIF(drive);
  145. struct icside_state *state = hwif->hwif_data;
  146. unsigned long flags;
  147. local_irq_save(flags);
  148. state->channel = hwif->channel;
  149. if (state->enabled && !mask) {
  150. switch (hwif->channel) {
  151. case 0:
  152. writeb(0, state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
  153. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
  154. break;
  155. case 1:
  156. writeb(0, state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
  157. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
  158. break;
  159. }
  160. } else {
  161. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
  162. readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
  163. }
  164. local_irq_restore(flags);
  165. }
  166. #ifdef CONFIG_BLK_DEV_IDEDMA_ICS
  167. /*
  168. * SG-DMA support.
  169. *
  170. * Similar to the BM-DMA, but we use the RiscPCs IOMD DMA controllers.
  171. * There is only one DMA controller per card, which means that only
  172. * one drive can be accessed at one time. NOTE! We do not enforce that
  173. * here, but we rely on the main IDE driver spotting that both
  174. * interfaces use the same IRQ, which should guarantee this.
  175. */
  176. static void icside_build_sglist(ide_drive_t *drive, struct request *rq)
  177. {
  178. ide_hwif_t *hwif = drive->hwif;
  179. struct icside_state *state = hwif->hwif_data;
  180. struct scatterlist *sg = hwif->sg_table;
  181. ide_map_sg(drive, rq);
  182. if (rq_data_dir(rq) == READ)
  183. hwif->sg_dma_direction = DMA_FROM_DEVICE;
  184. else
  185. hwif->sg_dma_direction = DMA_TO_DEVICE;
  186. hwif->sg_nents = dma_map_sg(state->dev, sg, hwif->sg_nents,
  187. hwif->sg_dma_direction);
  188. }
  189. /*
  190. * Configure the IOMD to give the appropriate timings for the transfer
  191. * mode being requested. We take the advice of the ATA standards, and
  192. * calculate the cycle time based on the transfer mode, and the EIDE
  193. * MW DMA specs that the drive provides in the IDENTIFY command.
  194. *
  195. * We have the following IOMD DMA modes to choose from:
  196. *
  197. * Type Active Recovery Cycle
  198. * A 250 (250) 312 (550) 562 (800)
  199. * B 187 250 437
  200. * C 125 (125) 125 (375) 250 (500)
  201. * D 62 125 187
  202. *
  203. * (figures in brackets are actual measured timings)
  204. *
  205. * However, we also need to take care of the read/write active and
  206. * recovery timings:
  207. *
  208. * Read Write
  209. * Mode Active -- Recovery -- Cycle IOMD type
  210. * MW0 215 50 215 480 A
  211. * MW1 80 50 50 150 C
  212. * MW2 70 25 25 120 C
  213. */
  214. static int icside_set_speed(ide_drive_t *drive, u8 xfer_mode)
  215. {
  216. int on = 0, cycle_time = 0, use_dma_info = 0;
  217. /*
  218. * Limit the transfer speed to MW_DMA_2.
  219. */
  220. if (xfer_mode > XFER_MW_DMA_2)
  221. xfer_mode = XFER_MW_DMA_2;
  222. switch (xfer_mode) {
  223. case XFER_MW_DMA_2:
  224. cycle_time = 250;
  225. use_dma_info = 1;
  226. break;
  227. case XFER_MW_DMA_1:
  228. cycle_time = 250;
  229. use_dma_info = 1;
  230. break;
  231. case XFER_MW_DMA_0:
  232. cycle_time = 480;
  233. break;
  234. case XFER_SW_DMA_2:
  235. case XFER_SW_DMA_1:
  236. case XFER_SW_DMA_0:
  237. cycle_time = 480;
  238. break;
  239. }
  240. /*
  241. * If we're going to be doing MW_DMA_1 or MW_DMA_2, we should
  242. * take care to note the values in the ID...
  243. */
  244. if (use_dma_info && drive->id->eide_dma_time > cycle_time)
  245. cycle_time = drive->id->eide_dma_time;
  246. drive->drive_data = cycle_time;
  247. if (cycle_time && ide_config_drive_speed(drive, xfer_mode) == 0)
  248. on = 1;
  249. else
  250. drive->drive_data = 480;
  251. printk("%s: %s selected (peak %dMB/s)\n", drive->name,
  252. ide_xfer_verbose(xfer_mode), 2000 / drive->drive_data);
  253. drive->current_speed = xfer_mode;
  254. return on;
  255. }
  256. static void icside_dma_host_off(ide_drive_t *drive)
  257. {
  258. }
  259. static void icside_dma_off_quietly(ide_drive_t *drive)
  260. {
  261. drive->using_dma = 0;
  262. }
  263. static void icside_dma_host_on(ide_drive_t *drive)
  264. {
  265. }
  266. static int icside_dma_on(ide_drive_t *drive)
  267. {
  268. drive->using_dma = 1;
  269. return 0;
  270. }
  271. static int icside_dma_check(ide_drive_t *drive)
  272. {
  273. struct hd_driveid *id = drive->id;
  274. ide_hwif_t *hwif = HWIF(drive);
  275. int xfer_mode = XFER_PIO_2;
  276. int on;
  277. if (!(id->capability & 1) || !hwif->autodma)
  278. goto out;
  279. /*
  280. * Consult the list of known "bad" drives
  281. */
  282. if (__ide_dma_bad_drive(drive))
  283. goto out;
  284. /*
  285. * Enable DMA on any drive that has multiword DMA
  286. */
  287. if (id->field_valid & 2) {
  288. xfer_mode = ide_max_dma_mode(drive);
  289. goto out;
  290. }
  291. /*
  292. * Consult the list of known "good" drives
  293. */
  294. if (__ide_dma_good_drive(drive)) {
  295. if (id->eide_dma_time > 150)
  296. goto out;
  297. xfer_mode = XFER_MW_DMA_1;
  298. }
  299. out:
  300. on = icside_set_speed(drive, xfer_mode);
  301. return on ? 0 : -1;
  302. }
  303. static int icside_dma_end(ide_drive_t *drive)
  304. {
  305. ide_hwif_t *hwif = HWIF(drive);
  306. struct icside_state *state = hwif->hwif_data;
  307. drive->waiting_for_dma = 0;
  308. disable_dma(hwif->hw.dma);
  309. /* Teardown mappings after DMA has completed. */
  310. dma_unmap_sg(state->dev, hwif->sg_table, hwif->sg_nents,
  311. hwif->sg_dma_direction);
  312. return get_dma_residue(hwif->hw.dma) != 0;
  313. }
  314. static void icside_dma_start(ide_drive_t *drive)
  315. {
  316. ide_hwif_t *hwif = HWIF(drive);
  317. /* We can not enable DMA on both channels simultaneously. */
  318. BUG_ON(dma_channel_active(hwif->hw.dma));
  319. enable_dma(hwif->hw.dma);
  320. }
  321. static int icside_dma_setup(ide_drive_t *drive)
  322. {
  323. ide_hwif_t *hwif = HWIF(drive);
  324. struct request *rq = hwif->hwgroup->rq;
  325. unsigned int dma_mode;
  326. if (rq_data_dir(rq))
  327. dma_mode = DMA_MODE_WRITE;
  328. else
  329. dma_mode = DMA_MODE_READ;
  330. /*
  331. * We can not enable DMA on both channels.
  332. */
  333. BUG_ON(dma_channel_active(hwif->hw.dma));
  334. icside_build_sglist(drive, rq);
  335. /*
  336. * Ensure that we have the right interrupt routed.
  337. */
  338. icside_maskproc(drive, 0);
  339. /*
  340. * Route the DMA signals to the correct interface.
  341. */
  342. writeb(hwif->select_data, hwif->config_data);
  343. /*
  344. * Select the correct timing for this drive.
  345. */
  346. set_dma_speed(hwif->hw.dma, drive->drive_data);
  347. /*
  348. * Tell the DMA engine about the SG table and
  349. * data direction.
  350. */
  351. set_dma_sg(hwif->hw.dma, hwif->sg_table, hwif->sg_nents);
  352. set_dma_mode(hwif->hw.dma, dma_mode);
  353. drive->waiting_for_dma = 1;
  354. return 0;
  355. }
  356. static void icside_dma_exec_cmd(ide_drive_t *drive, u8 cmd)
  357. {
  358. /* issue cmd to drive */
  359. ide_execute_command(drive, cmd, ide_dma_intr, 2 * WAIT_CMD, NULL);
  360. }
  361. static int icside_dma_test_irq(ide_drive_t *drive)
  362. {
  363. ide_hwif_t *hwif = HWIF(drive);
  364. struct icside_state *state = hwif->hwif_data;
  365. return readb(state->irq_port +
  366. (hwif->channel ?
  367. ICS_ARCIN_V6_INTRSTAT_2 :
  368. ICS_ARCIN_V6_INTRSTAT_1)) & 1;
  369. }
  370. static int icside_dma_timeout(ide_drive_t *drive)
  371. {
  372. printk(KERN_ERR "%s: DMA timeout occurred: ", drive->name);
  373. if (icside_dma_test_irq(drive))
  374. return 0;
  375. ide_dump_status(drive, "DMA timeout",
  376. HWIF(drive)->INB(IDE_STATUS_REG));
  377. return icside_dma_end(drive);
  378. }
  379. static int icside_dma_lostirq(ide_drive_t *drive)
  380. {
  381. printk(KERN_ERR "%s: IRQ lost\n", drive->name);
  382. return 1;
  383. }
  384. static void icside_dma_init(ide_hwif_t *hwif)
  385. {
  386. printk(" %s: SG-DMA", hwif->name);
  387. hwif->atapi_dma = 1;
  388. hwif->mwdma_mask = 7; /* MW0..2 */
  389. hwif->swdma_mask = 7; /* SW0..2 */
  390. hwif->dmatable_cpu = NULL;
  391. hwif->dmatable_dma = 0;
  392. hwif->speedproc = icside_set_speed;
  393. hwif->autodma = 1;
  394. hwif->ide_dma_check = icside_dma_check;
  395. hwif->dma_host_off = icside_dma_host_off;
  396. hwif->dma_off_quietly = icside_dma_off_quietly;
  397. hwif->dma_host_on = icside_dma_host_on;
  398. hwif->ide_dma_on = icside_dma_on;
  399. hwif->dma_setup = icside_dma_setup;
  400. hwif->dma_exec_cmd = icside_dma_exec_cmd;
  401. hwif->dma_start = icside_dma_start;
  402. hwif->ide_dma_end = icside_dma_end;
  403. hwif->ide_dma_test_irq = icside_dma_test_irq;
  404. hwif->ide_dma_timeout = icside_dma_timeout;
  405. hwif->ide_dma_lostirq = icside_dma_lostirq;
  406. hwif->drives[0].autodma = hwif->autodma;
  407. hwif->drives[1].autodma = hwif->autodma;
  408. printk(" capable%s\n", hwif->autodma ? ", auto-enable" : "");
  409. }
  410. #else
  411. #define icside_dma_init(hwif) (0)
  412. #endif
  413. static ide_hwif_t *icside_find_hwif(unsigned long dataport)
  414. {
  415. ide_hwif_t *hwif;
  416. int index;
  417. for (index = 0; index < MAX_HWIFS; ++index) {
  418. hwif = &ide_hwifs[index];
  419. if (hwif->io_ports[IDE_DATA_OFFSET] == dataport)
  420. goto found;
  421. }
  422. for (index = 0; index < MAX_HWIFS; ++index) {
  423. hwif = &ide_hwifs[index];
  424. if (!hwif->io_ports[IDE_DATA_OFFSET])
  425. goto found;
  426. }
  427. hwif = NULL;
  428. found:
  429. return hwif;
  430. }
  431. static ide_hwif_t *
  432. icside_setup(void __iomem *base, struct cardinfo *info, struct expansion_card *ec)
  433. {
  434. unsigned long port = (unsigned long)base + info->dataoffset;
  435. ide_hwif_t *hwif;
  436. hwif = icside_find_hwif(port);
  437. if (hwif) {
  438. int i;
  439. memset(&hwif->hw, 0, sizeof(hw_regs_t));
  440. /*
  441. * Ensure we're using MMIO
  442. */
  443. default_hwif_mmiops(hwif);
  444. hwif->mmio = 1;
  445. for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
  446. hwif->hw.io_ports[i] = port;
  447. hwif->io_ports[i] = port;
  448. port += 1 << info->stepping;
  449. }
  450. hwif->hw.io_ports[IDE_CONTROL_OFFSET] = (unsigned long)base + info->ctrloffset;
  451. hwif->io_ports[IDE_CONTROL_OFFSET] = (unsigned long)base + info->ctrloffset;
  452. hwif->hw.irq = ec->irq;
  453. hwif->irq = ec->irq;
  454. hwif->noprobe = 0;
  455. hwif->chipset = ide_acorn;
  456. hwif->gendev.parent = &ec->dev;
  457. }
  458. return hwif;
  459. }
  460. static int __init
  461. icside_register_v5(struct icside_state *state, struct expansion_card *ec)
  462. {
  463. ide_hwif_t *hwif;
  464. void __iomem *base;
  465. base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
  466. if (!base)
  467. return -ENOMEM;
  468. state->irq_port = base;
  469. ec->irqaddr = base + ICS_ARCIN_V5_INTRSTAT;
  470. ec->irqmask = 1;
  471. ecard_setirq(ec, &icside_ops_arcin_v5, state);
  472. /*
  473. * Be on the safe side - disable interrupts
  474. */
  475. icside_irqdisable_arcin_v5(ec, 0);
  476. hwif = icside_setup(base, &icside_cardinfo_v5, ec);
  477. if (!hwif)
  478. return -ENODEV;
  479. state->hwif[0] = hwif;
  480. probe_hwif_init(hwif);
  481. ide_proc_register_port(hwif);
  482. return 0;
  483. }
  484. static int __init
  485. icside_register_v6(struct icside_state *state, struct expansion_card *ec)
  486. {
  487. ide_hwif_t *hwif, *mate;
  488. void __iomem *ioc_base, *easi_base;
  489. unsigned int sel = 0;
  490. int ret;
  491. ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
  492. if (!ioc_base) {
  493. ret = -ENOMEM;
  494. goto out;
  495. }
  496. easi_base = ioc_base;
  497. if (ecard_resource_flags(ec, ECARD_RES_EASI)) {
  498. easi_base = ecardm_iomap(ec, ECARD_RES_EASI, 0, 0);
  499. if (!easi_base) {
  500. ret = -ENOMEM;
  501. goto out;
  502. }
  503. /*
  504. * Enable access to the EASI region.
  505. */
  506. sel = 1 << 5;
  507. }
  508. writeb(sel, ioc_base);
  509. ecard_setirq(ec, &icside_ops_arcin_v6, state);
  510. state->irq_port = easi_base;
  511. state->ioc_base = ioc_base;
  512. /*
  513. * Be on the safe side - disable interrupts
  514. */
  515. icside_irqdisable_arcin_v6(ec, 0);
  516. /*
  517. * Find and register the interfaces.
  518. */
  519. hwif = icside_setup(easi_base, &icside_cardinfo_v6_1, ec);
  520. mate = icside_setup(easi_base, &icside_cardinfo_v6_2, ec);
  521. if (!hwif || !mate) {
  522. ret = -ENODEV;
  523. goto out;
  524. }
  525. state->hwif[0] = hwif;
  526. state->hwif[1] = mate;
  527. hwif->maskproc = icside_maskproc;
  528. hwif->channel = 0;
  529. hwif->hwif_data = state;
  530. hwif->mate = mate;
  531. hwif->serialized = 1;
  532. hwif->config_data = (unsigned long)ioc_base;
  533. hwif->select_data = sel;
  534. hwif->hw.dma = ec->dma;
  535. mate->maskproc = icside_maskproc;
  536. mate->channel = 1;
  537. mate->hwif_data = state;
  538. mate->mate = hwif;
  539. mate->serialized = 1;
  540. mate->config_data = (unsigned long)ioc_base;
  541. mate->select_data = sel | 1;
  542. mate->hw.dma = ec->dma;
  543. if (ec->dma != NO_DMA && !request_dma(ec->dma, hwif->name)) {
  544. icside_dma_init(hwif);
  545. icside_dma_init(mate);
  546. }
  547. probe_hwif_init(hwif);
  548. probe_hwif_init(mate);
  549. ide_proc_register_port(hwif);
  550. ide_proc_register_port(mate);
  551. return 0;
  552. out:
  553. return ret;
  554. }
  555. static int __devinit
  556. icside_probe(struct expansion_card *ec, const struct ecard_id *id)
  557. {
  558. struct icside_state *state;
  559. void __iomem *idmem;
  560. int ret;
  561. ret = ecard_request_resources(ec);
  562. if (ret)
  563. goto out;
  564. state = kmalloc(sizeof(struct icside_state), GFP_KERNEL);
  565. if (!state) {
  566. ret = -ENOMEM;
  567. goto release;
  568. }
  569. memset(state, 0, sizeof(state));
  570. state->type = ICS_TYPE_NOTYPE;
  571. state->dev = &ec->dev;
  572. idmem = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
  573. if (idmem) {
  574. unsigned int type;
  575. type = readb(idmem + ICS_IDENT_OFFSET) & 1;
  576. type |= (readb(idmem + ICS_IDENT_OFFSET + 4) & 1) << 1;
  577. type |= (readb(idmem + ICS_IDENT_OFFSET + 8) & 1) << 2;
  578. type |= (readb(idmem + ICS_IDENT_OFFSET + 12) & 1) << 3;
  579. ecardm_iounmap(ec, idmem);
  580. state->type = type;
  581. }
  582. switch (state->type) {
  583. case ICS_TYPE_A3IN:
  584. dev_warn(&ec->dev, "A3IN unsupported\n");
  585. ret = -ENODEV;
  586. break;
  587. case ICS_TYPE_A3USER:
  588. dev_warn(&ec->dev, "A3USER unsupported\n");
  589. ret = -ENODEV;
  590. break;
  591. case ICS_TYPE_V5:
  592. ret = icside_register_v5(state, ec);
  593. break;
  594. case ICS_TYPE_V6:
  595. ret = icside_register_v6(state, ec);
  596. break;
  597. default:
  598. dev_warn(&ec->dev, "unknown interface type\n");
  599. ret = -ENODEV;
  600. break;
  601. }
  602. if (ret == 0) {
  603. ecard_set_drvdata(ec, state);
  604. goto out;
  605. }
  606. kfree(state);
  607. release:
  608. ecard_release_resources(ec);
  609. out:
  610. return ret;
  611. }
  612. static void __devexit icside_remove(struct expansion_card *ec)
  613. {
  614. struct icside_state *state = ecard_get_drvdata(ec);
  615. switch (state->type) {
  616. case ICS_TYPE_V5:
  617. /* FIXME: tell IDE to stop using the interface */
  618. /* Disable interrupts */
  619. icside_irqdisable_arcin_v5(ec, 0);
  620. break;
  621. case ICS_TYPE_V6:
  622. /* FIXME: tell IDE to stop using the interface */
  623. if (ec->dma != NO_DMA)
  624. free_dma(ec->dma);
  625. /* Disable interrupts */
  626. icside_irqdisable_arcin_v6(ec, 0);
  627. /* Reset the ROM pointer/EASI selection */
  628. writeb(0, state->ioc_base);
  629. break;
  630. }
  631. ecard_set_drvdata(ec, NULL);
  632. kfree(state);
  633. ecard_release_resources(ec);
  634. }
  635. static void icside_shutdown(struct expansion_card *ec)
  636. {
  637. struct icside_state *state = ecard_get_drvdata(ec);
  638. unsigned long flags;
  639. /*
  640. * Disable interrupts from this card. We need to do
  641. * this before disabling EASI since we may be accessing
  642. * this register via that region.
  643. */
  644. local_irq_save(flags);
  645. ec->ops->irqdisable(ec, 0);
  646. local_irq_restore(flags);
  647. /*
  648. * Reset the ROM pointer so that we can read the ROM
  649. * after a soft reboot. This also disables access to
  650. * the IDE taskfile via the EASI region.
  651. */
  652. if (state->ioc_base)
  653. writeb(0, state->ioc_base);
  654. }
  655. static const struct ecard_id icside_ids[] = {
  656. { MANU_ICS, PROD_ICS_IDE },
  657. { MANU_ICS2, PROD_ICS2_IDE },
  658. { 0xffff, 0xffff }
  659. };
  660. static struct ecard_driver icside_driver = {
  661. .probe = icside_probe,
  662. .remove = __devexit_p(icside_remove),
  663. .shutdown = icside_shutdown,
  664. .id_table = icside_ids,
  665. .drv = {
  666. .name = "icside",
  667. },
  668. };
  669. static int __init icside_init(void)
  670. {
  671. return ecard_register_driver(&icside_driver);
  672. }
  673. MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
  674. MODULE_LICENSE("GPL");
  675. MODULE_DESCRIPTION("ICS IDE driver");
  676. module_init(icside_init);