parport_ax88796.c 9.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443
  1. /* linux/drivers/parport/parport_ax88796.c
  2. *
  3. * (c) 2005,2006 Simtec Electronics
  4. * Ben Dooks <ben@simtec.co.uk>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. *
  10. */
  11. #include <linux/module.h>
  12. #include <linux/kernel.h>
  13. #include <linux/parport.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/errno.h>
  16. #include <linux/platform_device.h>
  17. #include <asm/io.h>
  18. #include <asm/irq.h>
  19. #define AX_SPR_BUSY (1<<7)
  20. #define AX_SPR_ACK (1<<6)
  21. #define AX_SPR_PE (1<<5)
  22. #define AX_SPR_SLCT (1<<4)
  23. #define AX_SPR_ERR (1<<3)
  24. #define AX_CPR_nDOE (1<<5)
  25. #define AX_CPR_SLCTIN (1<<3)
  26. #define AX_CPR_nINIT (1<<2)
  27. #define AX_CPR_ATFD (1<<1)
  28. #define AX_CPR_STRB (1<<0)
  29. struct ax_drvdata {
  30. struct parport *parport;
  31. struct parport_state suspend;
  32. struct device *dev;
  33. struct resource *io;
  34. unsigned char irq_enabled;
  35. void __iomem *base;
  36. void __iomem *spp_data;
  37. void __iomem *spp_spr;
  38. void __iomem *spp_cpr;
  39. };
  40. static inline struct ax_drvdata *pp_to_drv(struct parport *p)
  41. {
  42. return p->private_data;
  43. }
  44. static unsigned char
  45. parport_ax88796_read_data(struct parport *p)
  46. {
  47. struct ax_drvdata *dd = pp_to_drv(p);
  48. return readb(dd->spp_data);
  49. }
  50. static void
  51. parport_ax88796_write_data(struct parport *p, unsigned char data)
  52. {
  53. struct ax_drvdata *dd = pp_to_drv(p);
  54. writeb(data, dd->spp_data);
  55. }
  56. static unsigned char
  57. parport_ax88796_read_control(struct parport *p)
  58. {
  59. struct ax_drvdata *dd = pp_to_drv(p);
  60. unsigned int cpr = readb(dd->spp_cpr);
  61. unsigned int ret = 0;
  62. if (!(cpr & AX_CPR_STRB))
  63. ret |= PARPORT_CONTROL_STROBE;
  64. if (!(cpr & AX_CPR_ATFD))
  65. ret |= PARPORT_CONTROL_AUTOFD;
  66. if (cpr & AX_CPR_nINIT)
  67. ret |= PARPORT_CONTROL_INIT;
  68. if (!(cpr & AX_CPR_SLCTIN))
  69. ret |= PARPORT_CONTROL_SELECT;
  70. return ret;
  71. }
  72. static void
  73. parport_ax88796_write_control(struct parport *p, unsigned char control)
  74. {
  75. struct ax_drvdata *dd = pp_to_drv(p);
  76. unsigned int cpr = readb(dd->spp_cpr);
  77. cpr &= AX_CPR_nDOE;
  78. if (!(control & PARPORT_CONTROL_STROBE))
  79. cpr |= AX_CPR_STRB;
  80. if (!(control & PARPORT_CONTROL_AUTOFD))
  81. cpr |= AX_CPR_ATFD;
  82. if (control & PARPORT_CONTROL_INIT)
  83. cpr |= AX_CPR_nINIT;
  84. if (!(control & PARPORT_CONTROL_SELECT))
  85. cpr |= AX_CPR_SLCTIN;
  86. dev_dbg(dd->dev, "write_control: ctrl=%02x, cpr=%02x\n", control, cpr);
  87. writeb(cpr, dd->spp_cpr);
  88. if (parport_ax88796_read_control(p) != control) {
  89. dev_err(dd->dev, "write_control: read != set (%02x, %02x)\n",
  90. parport_ax88796_read_control(p), control);
  91. }
  92. }
  93. static unsigned char
  94. parport_ax88796_read_status(struct parport *p)
  95. {
  96. struct ax_drvdata *dd = pp_to_drv(p);
  97. unsigned int status = readb(dd->spp_spr);
  98. unsigned int ret = 0;
  99. if (status & AX_SPR_BUSY)
  100. ret |= PARPORT_STATUS_BUSY;
  101. if (status & AX_SPR_ACK)
  102. ret |= PARPORT_STATUS_ACK;
  103. if (status & AX_SPR_ERR)
  104. ret |= PARPORT_STATUS_ERROR;
  105. if (status & AX_SPR_SLCT)
  106. ret |= PARPORT_STATUS_SELECT;
  107. if (status & AX_SPR_PE)
  108. ret |= PARPORT_STATUS_PAPEROUT;
  109. return ret;
  110. }
  111. static unsigned char
  112. parport_ax88796_frob_control(struct parport *p, unsigned char mask,
  113. unsigned char val)
  114. {
  115. struct ax_drvdata *dd = pp_to_drv(p);
  116. unsigned char old = parport_ax88796_read_control(p);
  117. dev_dbg(dd->dev, "frob: mask=%02x, val=%02x, old=%02x\n",
  118. mask, val, old);
  119. parport_ax88796_write_control(p, (old & ~mask) | val);
  120. return old;
  121. }
  122. static void
  123. parport_ax88796_enable_irq(struct parport *p)
  124. {
  125. struct ax_drvdata *dd = pp_to_drv(p);
  126. unsigned long flags;
  127. local_irq_save(flags);
  128. if (!dd->irq_enabled) {
  129. enable_irq(p->irq);
  130. dd->irq_enabled = 1;
  131. }
  132. local_irq_restore(flags);
  133. }
  134. static void
  135. parport_ax88796_disable_irq(struct parport *p)
  136. {
  137. struct ax_drvdata *dd = pp_to_drv(p);
  138. unsigned long flags;
  139. local_irq_save(flags);
  140. if (dd->irq_enabled) {
  141. disable_irq(p->irq);
  142. dd->irq_enabled = 0;
  143. }
  144. local_irq_restore(flags);
  145. }
  146. static void
  147. parport_ax88796_data_forward(struct parport *p)
  148. {
  149. struct ax_drvdata *dd = pp_to_drv(p);
  150. void __iomem *cpr = dd->spp_cpr;
  151. writeb((readb(cpr) & ~AX_CPR_nDOE), cpr);
  152. }
  153. static void
  154. parport_ax88796_data_reverse(struct parport *p)
  155. {
  156. struct ax_drvdata *dd = pp_to_drv(p);
  157. void __iomem *cpr = dd->spp_cpr;
  158. writeb(readb(cpr) | AX_CPR_nDOE, cpr);
  159. }
  160. static void
  161. parport_ax88796_init_state(struct pardevice *d, struct parport_state *s)
  162. {
  163. struct ax_drvdata *dd = pp_to_drv(d->port);
  164. memset(s, 0, sizeof(struct parport_state));
  165. dev_dbg(dd->dev, "init_state: %p: state=%p\n", d, s);
  166. s->u.ax88796.cpr = readb(dd->spp_cpr);
  167. }
  168. static void
  169. parport_ax88796_save_state(struct parport *p, struct parport_state *s)
  170. {
  171. struct ax_drvdata *dd = pp_to_drv(p);
  172. dev_dbg(dd->dev, "save_state: %p: state=%p\n", p, s);
  173. s->u.ax88796.cpr = readb(dd->spp_cpr);
  174. }
  175. static void
  176. parport_ax88796_restore_state(struct parport *p, struct parport_state *s)
  177. {
  178. struct ax_drvdata *dd = pp_to_drv(p);
  179. dev_dbg(dd->dev, "restore_state: %p: state=%p\n", p, s);
  180. writeb(s->u.ax88796.cpr, dd->spp_cpr);
  181. }
  182. static irqreturn_t
  183. parport_ax88796_interrupt(int irq, void *dev_id)
  184. {
  185. parport_generic_irq(irq, dev_id);
  186. return IRQ_HANDLED;
  187. }
  188. static struct parport_operations parport_ax88796_ops = {
  189. .write_data = parport_ax88796_write_data,
  190. .read_data = parport_ax88796_read_data,
  191. .write_control = parport_ax88796_write_control,
  192. .read_control = parport_ax88796_read_control,
  193. .frob_control = parport_ax88796_frob_control,
  194. .read_status = parport_ax88796_read_status,
  195. .enable_irq = parport_ax88796_enable_irq,
  196. .disable_irq = parport_ax88796_disable_irq,
  197. .data_forward = parport_ax88796_data_forward,
  198. .data_reverse = parport_ax88796_data_reverse,
  199. .init_state = parport_ax88796_init_state,
  200. .save_state = parport_ax88796_save_state,
  201. .restore_state = parport_ax88796_restore_state,
  202. .epp_write_data = parport_ieee1284_epp_write_data,
  203. .epp_read_data = parport_ieee1284_epp_read_data,
  204. .epp_write_addr = parport_ieee1284_epp_write_addr,
  205. .epp_read_addr = parport_ieee1284_epp_read_addr,
  206. .ecp_write_data = parport_ieee1284_ecp_write_data,
  207. .ecp_read_data = parport_ieee1284_ecp_read_data,
  208. .ecp_write_addr = parport_ieee1284_ecp_write_addr,
  209. .compat_write_data = parport_ieee1284_write_compat,
  210. .nibble_read_data = parport_ieee1284_read_nibble,
  211. .byte_read_data = parport_ieee1284_read_byte,
  212. .owner = THIS_MODULE,
  213. };
  214. static int parport_ax88796_probe(struct platform_device *pdev)
  215. {
  216. struct device *_dev = &pdev->dev;
  217. struct ax_drvdata *dd;
  218. struct parport *pp = NULL;
  219. struct resource *res;
  220. unsigned long size;
  221. int spacing;
  222. int irq;
  223. int ret;
  224. dd = kzalloc(sizeof(struct ax_drvdata), GFP_KERNEL);
  225. if (dd == NULL) {
  226. dev_err(_dev, "no memory for private data\n");
  227. return -ENOMEM;
  228. }
  229. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  230. if (res == NULL) {
  231. dev_err(_dev, "no MEM specified\n");
  232. ret = -ENXIO;
  233. goto exit_mem;
  234. }
  235. size = (res->end - res->start) + 1;
  236. spacing = size / 3;
  237. dd->io = request_mem_region(res->start, size, pdev->name);
  238. if (dd->io == NULL) {
  239. dev_err(_dev, "cannot reserve memory\n");
  240. ret = -ENXIO;
  241. goto exit_mem;
  242. }
  243. dd->base = ioremap(res->start, size);
  244. if (dd->base == NULL) {
  245. dev_err(_dev, "cannot ioremap region\n");
  246. ret = -ENXIO;
  247. goto exit_res;
  248. }
  249. irq = platform_get_irq(pdev, 0);
  250. if (irq <= 0)
  251. irq = PARPORT_IRQ_NONE;
  252. pp = parport_register_port((unsigned long)dd->base, irq,
  253. PARPORT_DMA_NONE,
  254. &parport_ax88796_ops);
  255. if (pp == NULL) {
  256. dev_err(_dev, "failed to register parallel port\n");
  257. ret = -ENOMEM;
  258. goto exit_unmap;
  259. }
  260. pp->private_data = dd;
  261. dd->parport = pp;
  262. dd->dev = _dev;
  263. dd->spp_data = dd->base;
  264. dd->spp_spr = dd->base + (spacing * 1);
  265. dd->spp_cpr = dd->base + (spacing * 2);
  266. /* initialise the port controls */
  267. writeb(AX_CPR_STRB, dd->spp_cpr);
  268. if (irq >= 0) {
  269. /* request irq */
  270. ret = request_irq(irq, parport_ax88796_interrupt,
  271. IRQF_TRIGGER_FALLING, pdev->name, pp);
  272. if (ret < 0)
  273. goto exit_port;
  274. dd->irq_enabled = 1;
  275. }
  276. platform_set_drvdata(pdev, pp);
  277. dev_info(_dev, "attached parallel port driver\n");
  278. parport_announce_port(pp);
  279. return 0;
  280. exit_port:
  281. parport_remove_port(pp);
  282. exit_unmap:
  283. iounmap(dd->base);
  284. exit_res:
  285. release_resource(dd->io);
  286. kfree(dd->io);
  287. exit_mem:
  288. kfree(dd);
  289. return ret;
  290. }
  291. static int parport_ax88796_remove(struct platform_device *pdev)
  292. {
  293. struct parport *p = platform_get_drvdata(pdev);
  294. struct ax_drvdata *dd = pp_to_drv(p);
  295. free_irq(p->irq, p);
  296. parport_remove_port(p);
  297. iounmap(dd->base);
  298. release_resource(dd->io);
  299. kfree(dd->io);
  300. kfree(dd);
  301. return 0;
  302. }
  303. #ifdef CONFIG_PM
  304. static int parport_ax88796_suspend(struct platform_device *dev,
  305. pm_message_t state)
  306. {
  307. struct parport *p = platform_get_drvdata(dev);
  308. struct ax_drvdata *dd = pp_to_drv(p);
  309. parport_ax88796_save_state(p, &dd->suspend);
  310. writeb(AX_CPR_nDOE | AX_CPR_STRB, dd->spp_cpr);
  311. return 0;
  312. }
  313. static int parport_ax88796_resume(struct platform_device *dev)
  314. {
  315. struct parport *p = platform_get_drvdata(dev);
  316. struct ax_drvdata *dd = pp_to_drv(p);
  317. parport_ax88796_restore_state(p, &dd->suspend);
  318. return 0;
  319. }
  320. #else
  321. #define parport_ax88796_suspend NULL
  322. #define parport_ax88796_resume NULL
  323. #endif
  324. static struct platform_driver axdrv = {
  325. .driver = {
  326. .name = "ax88796-pp",
  327. .owner = THIS_MODULE,
  328. },
  329. .probe = parport_ax88796_probe,
  330. .remove = parport_ax88796_remove,
  331. .suspend = parport_ax88796_suspend,
  332. .resume = parport_ax88796_resume,
  333. };
  334. static int __init parport_ax88796_init(void)
  335. {
  336. return platform_driver_register(&axdrv);
  337. }
  338. static void __exit parport_ax88796_exit(void)
  339. {
  340. platform_driver_unregister(&axdrv);
  341. }
  342. module_init(parport_ax88796_init)
  343. module_exit(parport_ax88796_exit)
  344. MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
  345. MODULE_DESCRIPTION("AX88796 Parport parallel port driver");
  346. MODULE_LICENSE("GPL");