cm4040_cs.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778
  1. /*
  2. * A driver for the Omnikey PCMCIA smartcard reader CardMan 4040
  3. *
  4. * (c) 2000-2004 Omnikey AG (http://www.omnikey.com/)
  5. *
  6. * (C) 2005 Harald Welte <laforge@gnumonks.org>
  7. * - add support for poll()
  8. * - driver cleanup
  9. * - add waitqueues
  10. * - adhere to linux kernel coding style and policies
  11. * - support 2.6.13 "new style" pcmcia interface
  12. *
  13. * The device basically is a USB CCID compliant device that has been
  14. * attached to an I/O-Mapped FIFO.
  15. *
  16. * All rights reserved, Dual BSD/GPL Licensed.
  17. */
  18. /* #define PCMCIA_DEBUG 6 */
  19. #include <linux/kernel.h>
  20. #include <linux/module.h>
  21. #include <linux/slab.h>
  22. #include <linux/init.h>
  23. #include <linux/fs.h>
  24. #include <linux/delay.h>
  25. #include <linux/poll.h>
  26. #include <linux/wait.h>
  27. #include <asm/uaccess.h>
  28. #include <asm/io.h>
  29. #include <pcmcia/cs_types.h>
  30. #include <pcmcia/cs.h>
  31. #include <pcmcia/cistpl.h>
  32. #include <pcmcia/cisreg.h>
  33. #include <pcmcia/ciscode.h>
  34. #include <pcmcia/ds.h>
  35. #include "cm4040_cs.h"
  36. #ifdef PCMCIA_DEBUG
  37. #define reader_to_dev(x) (&handle_to_dev(x->link.handle))
  38. static int pc_debug = PCMCIA_DEBUG;
  39. module_param(pc_debug, int, 0600);
  40. #define DEBUGP(n, rdr, x, args...) do { \
  41. if (pc_debug >= (n)) \
  42. dev_printk(KERN_DEBUG, reader_to_dev(rdr), "%s:" x, \
  43. __FUNCTION__ , ##args); \
  44. } while (0)
  45. #else
  46. #define DEBUGP(n, rdr, x, args...)
  47. #endif
  48. static char *version =
  49. "OMNIKEY CardMan 4040 v1.1.0gm4 - All bugs added by Harald Welte";
  50. #define CCID_DRIVER_BULK_DEFAULT_TIMEOUT (150*HZ)
  51. #define CCID_DRIVER_ASYNC_POWERUP_TIMEOUT (35*HZ)
  52. #define CCID_DRIVER_MINIMUM_TIMEOUT (3*HZ)
  53. #define READ_WRITE_BUFFER_SIZE 512
  54. #define POLL_LOOP_COUNT 1000
  55. /* how often to poll for fifo status change */
  56. #define POLL_PERIOD msecs_to_jiffies(10)
  57. static void reader_release(dev_link_t *link);
  58. static int major;
  59. #define BS_READABLE 0x01
  60. #define BS_WRITABLE 0x02
  61. struct reader_dev {
  62. dev_link_t link;
  63. dev_node_t node;
  64. wait_queue_head_t devq;
  65. wait_queue_head_t poll_wait;
  66. wait_queue_head_t read_wait;
  67. wait_queue_head_t write_wait;
  68. unsigned long buffer_status;
  69. unsigned long timeout;
  70. unsigned char s_buf[READ_WRITE_BUFFER_SIZE];
  71. unsigned char r_buf[READ_WRITE_BUFFER_SIZE];
  72. struct timer_list poll_timer;
  73. };
  74. static dev_link_t *dev_table[CM_MAX_DEV];
  75. #ifndef PCMCIA_DEBUG
  76. #define xoutb outb
  77. #define xinb inb
  78. #else
  79. static inline void xoutb(unsigned char val, unsigned short port)
  80. {
  81. if (pc_debug >= 7)
  82. printk(KERN_DEBUG "outb(val=%.2x,port=%.4x)\n", val, port);
  83. outb(val, port);
  84. }
  85. static inline unsigned char xinb(unsigned short port)
  86. {
  87. unsigned char val;
  88. val = inb(port);
  89. if (pc_debug >= 7)
  90. printk(KERN_DEBUG "%.2x=inb(%.4x)\n", val, port);
  91. return val;
  92. }
  93. #endif
  94. /* poll the device fifo status register. not to be confused with
  95. * the poll syscall. */
  96. static void cm4040_do_poll(unsigned long dummy)
  97. {
  98. struct reader_dev *dev = (struct reader_dev *) dummy;
  99. unsigned int obs = xinb(dev->link.io.BasePort1
  100. + REG_OFFSET_BUFFER_STATUS);
  101. if ((obs & BSR_BULK_IN_FULL)) {
  102. set_bit(BS_READABLE, &dev->buffer_status);
  103. DEBUGP(4, dev, "waking up read_wait\n");
  104. wake_up_interruptible(&dev->read_wait);
  105. } else
  106. clear_bit(BS_READABLE, &dev->buffer_status);
  107. if (!(obs & BSR_BULK_OUT_FULL)) {
  108. set_bit(BS_WRITABLE, &dev->buffer_status);
  109. DEBUGP(4, dev, "waking up write_wait\n");
  110. wake_up_interruptible(&dev->write_wait);
  111. } else
  112. clear_bit(BS_WRITABLE, &dev->buffer_status);
  113. if (dev->buffer_status)
  114. wake_up_interruptible(&dev->poll_wait);
  115. mod_timer(&dev->poll_timer, jiffies + POLL_PERIOD);
  116. }
  117. static void cm4040_stop_poll(struct reader_dev *dev)
  118. {
  119. del_timer_sync(&dev->poll_timer);
  120. }
  121. static int wait_for_bulk_out_ready(struct reader_dev *dev)
  122. {
  123. int i, rc;
  124. int iobase = dev->link.io.BasePort1;
  125. for (i = 0; i < POLL_LOOP_COUNT; i++) {
  126. if ((xinb(iobase + REG_OFFSET_BUFFER_STATUS)
  127. & BSR_BULK_OUT_FULL) == 0) {
  128. DEBUGP(4, dev, "BulkOut empty (i=%d)\n", i);
  129. return 1;
  130. }
  131. }
  132. DEBUGP(4, dev, "wait_event_interruptible_timeout(timeout=%ld\n",
  133. dev->timeout);
  134. rc = wait_event_interruptible_timeout(dev->write_wait,
  135. test_and_clear_bit(BS_WRITABLE,
  136. &dev->buffer_status),
  137. dev->timeout);
  138. if (rc > 0)
  139. DEBUGP(4, dev, "woke up: BulkOut empty\n");
  140. else if (rc == 0)
  141. DEBUGP(4, dev, "woke up: BulkOut full, returning 0 :(\n");
  142. else if (rc < 0)
  143. DEBUGP(4, dev, "woke up: signal arrived\n");
  144. return rc;
  145. }
  146. /* Write to Sync Control Register */
  147. static int write_sync_reg(unsigned char val, struct reader_dev *dev)
  148. {
  149. int iobase = dev->link.io.BasePort1;
  150. int rc;
  151. rc = wait_for_bulk_out_ready(dev);
  152. if (rc <= 0)
  153. return rc;
  154. xoutb(val, iobase + REG_OFFSET_SYNC_CONTROL);
  155. rc = wait_for_bulk_out_ready(dev);
  156. if (rc <= 0)
  157. return rc;
  158. return 1;
  159. }
  160. static int wait_for_bulk_in_ready(struct reader_dev *dev)
  161. {
  162. int i, rc;
  163. int iobase = dev->link.io.BasePort1;
  164. for (i = 0; i < POLL_LOOP_COUNT; i++) {
  165. if ((xinb(iobase + REG_OFFSET_BUFFER_STATUS)
  166. & BSR_BULK_IN_FULL) == BSR_BULK_IN_FULL) {
  167. DEBUGP(3, dev, "BulkIn full (i=%d)\n", i);
  168. return 1;
  169. }
  170. }
  171. DEBUGP(4, dev, "wait_event_interruptible_timeout(timeout=%ld\n",
  172. dev->timeout);
  173. rc = wait_event_interruptible_timeout(dev->read_wait,
  174. test_and_clear_bit(BS_READABLE,
  175. &dev->buffer_status),
  176. dev->timeout);
  177. if (rc > 0)
  178. DEBUGP(4, dev, "woke up: BulkIn full\n");
  179. else if (rc == 0)
  180. DEBUGP(4, dev, "woke up: BulkIn not full, returning 0 :(\n");
  181. else if (rc < 0)
  182. DEBUGP(4, dev, "woke up: signal arrived\n");
  183. return rc;
  184. }
  185. static ssize_t cm4040_read(struct file *filp, char __user *buf,
  186. size_t count, loff_t *ppos)
  187. {
  188. struct reader_dev *dev = filp->private_data;
  189. int iobase = dev->link.io.BasePort1;
  190. size_t bytes_to_read;
  191. unsigned long i;
  192. size_t min_bytes_to_read;
  193. int rc;
  194. unsigned char uc;
  195. DEBUGP(2, dev, "-> cm4040_read(%s,%d)\n", current->comm, current->pid);
  196. if (count == 0)
  197. return 0;
  198. if (count < 10)
  199. return -EFAULT;
  200. if (filp->f_flags & O_NONBLOCK) {
  201. DEBUGP(4, dev, "filep->f_flags O_NONBLOCK set\n");
  202. DEBUGP(2, dev, "<- cm4040_read (failure)\n");
  203. return -EAGAIN;
  204. }
  205. if ((dev->link.state & DEV_PRESENT)==0)
  206. return -ENODEV;
  207. for (i = 0; i < 5; i++) {
  208. rc = wait_for_bulk_in_ready(dev);
  209. if (rc <= 0) {
  210. DEBUGP(5, dev, "wait_for_bulk_in_ready rc=%.2x\n", rc);
  211. DEBUGP(2, dev, "<- cm4040_read (failed)\n");
  212. if (rc == -ERESTARTSYS)
  213. return rc;
  214. return -EIO;
  215. }
  216. dev->r_buf[i] = xinb(iobase + REG_OFFSET_BULK_IN);
  217. #ifdef PCMCIA_DEBUG
  218. if (pc_debug >= 6)
  219. printk(KERN_DEBUG "%lu:%2x ", i, dev->r_buf[i]);
  220. }
  221. printk("\n");
  222. #else
  223. }
  224. #endif
  225. bytes_to_read = 5 + le32_to_cpu(*(__le32 *)&dev->r_buf[1]);
  226. DEBUGP(6, dev, "BytesToRead=%lu\n", bytes_to_read);
  227. min_bytes_to_read = min(count, bytes_to_read + 5);
  228. DEBUGP(6, dev, "Min=%lu\n", min_bytes_to_read);
  229. for (i = 0; i < (min_bytes_to_read-5); i++) {
  230. rc = wait_for_bulk_in_ready(dev);
  231. if (rc <= 0) {
  232. DEBUGP(5, dev, "wait_for_bulk_in_ready rc=%.2x\n", rc);
  233. DEBUGP(2, dev, "<- cm4040_read (failed)\n");
  234. if (rc == -ERESTARTSYS)
  235. return rc;
  236. return -EIO;
  237. }
  238. dev->r_buf[i+5] = xinb(iobase + REG_OFFSET_BULK_IN);
  239. #ifdef PCMCIA_DEBUG
  240. if (pc_debug >= 6)
  241. printk(KERN_DEBUG "%lu:%2x ", i, dev->r_buf[i]);
  242. }
  243. printk("\n");
  244. #else
  245. }
  246. #endif
  247. *ppos = min_bytes_to_read;
  248. if (copy_to_user(buf, dev->r_buf, min_bytes_to_read))
  249. return -EFAULT;
  250. rc = wait_for_bulk_in_ready(dev);
  251. if (rc <= 0) {
  252. DEBUGP(5, dev, "wait_for_bulk_in_ready rc=%.2x\n", rc);
  253. DEBUGP(2, dev, "<- cm4040_read (failed)\n");
  254. if (rc == -ERESTARTSYS)
  255. return rc;
  256. return -EIO;
  257. }
  258. rc = write_sync_reg(SCR_READER_TO_HOST_DONE, dev);
  259. if (rc <= 0) {
  260. DEBUGP(5, dev, "write_sync_reg c=%.2x\n", rc);
  261. DEBUGP(2, dev, "<- cm4040_read (failed)\n");
  262. if (rc == -ERESTARTSYS)
  263. return rc;
  264. else
  265. return -EIO;
  266. }
  267. uc = xinb(iobase + REG_OFFSET_BULK_IN);
  268. DEBUGP(2, dev, "<- cm4040_read (successfully)\n");
  269. return min_bytes_to_read;
  270. }
  271. static ssize_t cm4040_write(struct file *filp, const char __user *buf,
  272. size_t count, loff_t *ppos)
  273. {
  274. struct reader_dev *dev = filp->private_data;
  275. int iobase = dev->link.io.BasePort1;
  276. ssize_t rc;
  277. int i;
  278. unsigned int bytes_to_write;
  279. DEBUGP(2, dev, "-> cm4040_write(%s,%d)\n", current->comm, current->pid);
  280. if (count == 0) {
  281. DEBUGP(2, dev, "<- cm4040_write empty read (successfully)\n");
  282. return 0;
  283. }
  284. if (count < 5) {
  285. DEBUGP(2, dev, "<- cm4040_write buffersize=%Zd < 5\n", count);
  286. return -EIO;
  287. }
  288. if (filp->f_flags & O_NONBLOCK) {
  289. DEBUGP(4, dev, "filep->f_flags O_NONBLOCK set\n");
  290. DEBUGP(4, dev, "<- cm4040_write (failure)\n");
  291. return -EAGAIN;
  292. }
  293. if ((dev->link.state & DEV_PRESENT) == 0)
  294. return -ENODEV;
  295. bytes_to_write = count;
  296. if (copy_from_user(dev->s_buf, buf, bytes_to_write))
  297. return -EFAULT;
  298. switch (dev->s_buf[0]) {
  299. case CMD_PC_TO_RDR_XFRBLOCK:
  300. case CMD_PC_TO_RDR_SECURE:
  301. case CMD_PC_TO_RDR_TEST_SECURE:
  302. case CMD_PC_TO_RDR_OK_SECURE:
  303. dev->timeout = CCID_DRIVER_BULK_DEFAULT_TIMEOUT;
  304. break;
  305. case CMD_PC_TO_RDR_ICCPOWERON:
  306. dev->timeout = CCID_DRIVER_ASYNC_POWERUP_TIMEOUT;
  307. break;
  308. case CMD_PC_TO_RDR_GETSLOTSTATUS:
  309. case CMD_PC_TO_RDR_ICCPOWEROFF:
  310. case CMD_PC_TO_RDR_GETPARAMETERS:
  311. case CMD_PC_TO_RDR_RESETPARAMETERS:
  312. case CMD_PC_TO_RDR_SETPARAMETERS:
  313. case CMD_PC_TO_RDR_ESCAPE:
  314. case CMD_PC_TO_RDR_ICCCLOCK:
  315. default:
  316. dev->timeout = CCID_DRIVER_MINIMUM_TIMEOUT;
  317. break;
  318. }
  319. rc = write_sync_reg(SCR_HOST_TO_READER_START, dev);
  320. if (rc <= 0) {
  321. DEBUGP(5, dev, "write_sync_reg c=%.2Zx\n", rc);
  322. DEBUGP(2, dev, "<- cm4040_write (failed)\n");
  323. if (rc == -ERESTARTSYS)
  324. return rc;
  325. else
  326. return -EIO;
  327. }
  328. DEBUGP(4, dev, "start \n");
  329. for (i = 0; i < bytes_to_write; i++) {
  330. rc = wait_for_bulk_out_ready(dev);
  331. if (rc <= 0) {
  332. DEBUGP(5, dev, "wait_for_bulk_out_ready rc=%.2Zx\n",
  333. rc);
  334. DEBUGP(2, dev, "<- cm4040_write (failed)\n");
  335. if (rc == -ERESTARTSYS)
  336. return rc;
  337. else
  338. return -EIO;
  339. }
  340. xoutb(dev->s_buf[i],iobase + REG_OFFSET_BULK_OUT);
  341. }
  342. DEBUGP(4, dev, "end\n");
  343. rc = write_sync_reg(SCR_HOST_TO_READER_DONE, dev);
  344. if (rc <= 0) {
  345. DEBUGP(5, dev, "write_sync_reg c=%.2Zx\n", rc);
  346. DEBUGP(2, dev, "<- cm4040_write (failed)\n");
  347. if (rc == -ERESTARTSYS)
  348. return rc;
  349. else
  350. return -EIO;
  351. }
  352. DEBUGP(2, dev, "<- cm4040_write (successfully)\n");
  353. return count;
  354. }
  355. static unsigned int cm4040_poll(struct file *filp, poll_table *wait)
  356. {
  357. struct reader_dev *dev = filp->private_data;
  358. unsigned int mask = 0;
  359. poll_wait(filp, &dev->poll_wait, wait);
  360. if (test_and_clear_bit(BS_READABLE, &dev->buffer_status))
  361. mask |= POLLIN | POLLRDNORM;
  362. if (test_and_clear_bit(BS_WRITABLE, &dev->buffer_status))
  363. mask |= POLLOUT | POLLWRNORM;
  364. DEBUGP(2, dev, "<- cm4040_poll(%u)\n", mask);
  365. return mask;
  366. }
  367. static int cm4040_open(struct inode *inode, struct file *filp)
  368. {
  369. struct reader_dev *dev;
  370. dev_link_t *link;
  371. int minor = iminor(inode);
  372. if (minor >= CM_MAX_DEV)
  373. return -ENODEV;
  374. link = dev_table[minor];
  375. if (link == NULL || !(DEV_OK(link)))
  376. return -ENODEV;
  377. if (link->open)
  378. return -EBUSY;
  379. dev = link->priv;
  380. filp->private_data = dev;
  381. if (filp->f_flags & O_NONBLOCK) {
  382. DEBUGP(4, dev, "filep->f_flags O_NONBLOCK set\n");
  383. return -EAGAIN;
  384. }
  385. link->open = 1;
  386. dev->poll_timer.data = (unsigned long) dev;
  387. mod_timer(&dev->poll_timer, jiffies + POLL_PERIOD);
  388. DEBUGP(2, dev, "<- cm4040_open (successfully)\n");
  389. return nonseekable_open(inode, filp);
  390. }
  391. static int cm4040_close(struct inode *inode, struct file *filp)
  392. {
  393. struct reader_dev *dev = filp->private_data;
  394. dev_link_t *link;
  395. int minor = iminor(inode);
  396. DEBUGP(2, dev, "-> cm4040_close(maj/min=%d.%d)\n", imajor(inode),
  397. iminor(inode));
  398. if (minor >= CM_MAX_DEV)
  399. return -ENODEV;
  400. link = dev_table[minor];
  401. if (link == NULL)
  402. return -ENODEV;
  403. cm4040_stop_poll(dev);
  404. link->open = 0;
  405. wake_up(&dev->devq);
  406. DEBUGP(2, dev, "<- cm4040_close\n");
  407. return 0;
  408. }
  409. static void cm4040_reader_release(dev_link_t *link)
  410. {
  411. struct reader_dev *dev = link->priv;
  412. DEBUGP(3, dev, "-> cm4040_reader_release\n");
  413. while (link->open) {
  414. DEBUGP(3, dev, KERN_INFO MODULE_NAME ": delaying release "
  415. "until process has terminated\n");
  416. wait_event(dev->devq, (link->open == 0));
  417. }
  418. DEBUGP(3, dev, "<- cm4040_reader_release\n");
  419. return;
  420. }
  421. static void reader_config(dev_link_t *link, int devno)
  422. {
  423. client_handle_t handle;
  424. struct reader_dev *dev;
  425. tuple_t tuple;
  426. cisparse_t parse;
  427. config_info_t conf;
  428. u_char buf[64];
  429. int fail_fn, fail_rc;
  430. int rc;
  431. handle = link->handle;
  432. tuple.DesiredTuple = CISTPL_CONFIG;
  433. tuple.Attributes = 0;
  434. tuple.TupleData = buf;
  435. tuple.TupleDataMax = sizeof(buf);
  436. tuple.TupleOffset = 0;
  437. if ((fail_rc = pcmcia_get_first_tuple(handle, &tuple)) != CS_SUCCESS) {
  438. fail_fn = GetFirstTuple;
  439. goto cs_failed;
  440. }
  441. if ((fail_rc = pcmcia_get_tuple_data(handle, &tuple)) != CS_SUCCESS) {
  442. fail_fn = GetTupleData;
  443. goto cs_failed;
  444. }
  445. if ((fail_rc = pcmcia_parse_tuple(handle, &tuple, &parse))
  446. != CS_SUCCESS) {
  447. fail_fn = ParseTuple;
  448. goto cs_failed;
  449. }
  450. if ((fail_rc = pcmcia_get_configuration_info(handle, &conf))
  451. != CS_SUCCESS) {
  452. fail_fn = GetConfigurationInfo;
  453. goto cs_failed;
  454. }
  455. link->state |= DEV_CONFIG;
  456. link->conf.ConfigBase = parse.config.base;
  457. link->conf.Present = parse.config.rmask[0];
  458. link->conf.Vcc = conf.Vcc;
  459. link->io.BasePort2 = 0;
  460. link->io.NumPorts2 = 0;
  461. link->io.Attributes2 = 0;
  462. tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
  463. for (rc = pcmcia_get_first_tuple(handle, &tuple);
  464. rc == CS_SUCCESS;
  465. rc = pcmcia_get_next_tuple(handle, &tuple)) {
  466. rc = pcmcia_get_tuple_data(handle, &tuple);
  467. if (rc != CS_SUCCESS)
  468. continue;
  469. rc = pcmcia_parse_tuple(handle, &tuple, &parse);
  470. if (rc != CS_SUCCESS)
  471. continue;
  472. link->conf.ConfigIndex = parse.cftable_entry.index;
  473. if (!parse.cftable_entry.io.nwin)
  474. continue;
  475. link->io.BasePort1 = parse.cftable_entry.io.win[0].base;
  476. link->io.NumPorts1 = parse.cftable_entry.io.win[0].len;
  477. link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
  478. if (!(parse.cftable_entry.io.flags & CISTPL_IO_8BIT))
  479. link->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
  480. if (!(parse.cftable_entry.io.flags & CISTPL_IO_16BIT))
  481. link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
  482. link->io.IOAddrLines = parse.cftable_entry.io.flags
  483. & CISTPL_IO_LINES_MASK;
  484. rc = pcmcia_request_io(handle, &link->io);
  485. dev_printk(KERN_INFO, &handle_to_dev(handle), "foo");
  486. if (rc == CS_SUCCESS)
  487. break;
  488. else
  489. dev_printk(KERN_INFO, &handle_to_dev(handle),
  490. "pcmcia_request_io failed 0x%x\n", rc);
  491. }
  492. if (rc != CS_SUCCESS)
  493. goto cs_release;
  494. link->conf.IntType = 00000002;
  495. if ((fail_rc = pcmcia_request_configuration(handle,&link->conf))
  496. !=CS_SUCCESS) {
  497. fail_fn = RequestConfiguration;
  498. dev_printk(KERN_INFO, &handle_to_dev(handle),
  499. "pcmcia_request_configuration failed 0x%x\n",
  500. fail_rc);
  501. goto cs_release;
  502. }
  503. dev = link->priv;
  504. sprintf(dev->node.dev_name, DEVICE_NAME "%d", devno);
  505. dev->node.major = major;
  506. dev->node.minor = devno;
  507. dev->node.next = NULL;
  508. link->dev = &dev->node;
  509. link->state &= ~DEV_CONFIG_PENDING;
  510. DEBUGP(2, dev, "device " DEVICE_NAME "%d at 0x%.4x-0x%.4x\n", devno,
  511. link->io.BasePort1, link->io.BasePort1+link->io.NumPorts1);
  512. DEBUGP(2, dev, "<- reader_config (succ)\n");
  513. return;
  514. cs_failed:
  515. cs_error(handle, fail_fn, fail_rc);
  516. cs_release:
  517. reader_release(link);
  518. link->state &= ~DEV_CONFIG_PENDING;
  519. }
  520. static int reader_suspend(struct pcmcia_device *p_dev)
  521. {
  522. dev_link_t *link = dev_to_instance(p_dev);
  523. link->state |= DEV_SUSPEND;
  524. if (link->state & DEV_CONFIG)
  525. pcmcia_release_configuration(link->handle);
  526. return 0;
  527. }
  528. static int reader_resume(struct pcmcia_device *p_dev)
  529. {
  530. dev_link_t *link = dev_to_instance(p_dev);
  531. link->state &= ~DEV_SUSPEND;
  532. if (link->state & DEV_CONFIG)
  533. pcmcia_request_configuration(link->handle, &link->conf);
  534. return 0;
  535. }
  536. static void reader_release(dev_link_t *link)
  537. {
  538. cm4040_reader_release(link->priv);
  539. pcmcia_release_configuration(link->handle);
  540. pcmcia_release_io(link->handle, &link->io);
  541. }
  542. static int reader_attach(struct pcmcia_device *p_dev)
  543. {
  544. struct reader_dev *dev;
  545. dev_link_t *link;
  546. int i;
  547. for (i = 0; i < CM_MAX_DEV; i++) {
  548. if (dev_table[i] == NULL)
  549. break;
  550. }
  551. if (i == CM_MAX_DEV)
  552. return -ENODEV;
  553. dev = kzalloc(sizeof(struct reader_dev), GFP_KERNEL);
  554. if (dev == NULL)
  555. return -ENOMEM;
  556. dev->timeout = CCID_DRIVER_MINIMUM_TIMEOUT;
  557. dev->buffer_status = 0;
  558. link = &dev->link;
  559. link->priv = dev;
  560. link->conf.IntType = INT_MEMORY_AND_IO;
  561. dev_table[i] = link;
  562. init_waitqueue_head(&dev->devq);
  563. init_waitqueue_head(&dev->poll_wait);
  564. init_waitqueue_head(&dev->read_wait);
  565. init_waitqueue_head(&dev->write_wait);
  566. init_timer(&dev->poll_timer);
  567. dev->poll_timer.function = &cm4040_do_poll;
  568. link->handle = p_dev;
  569. p_dev->instance = link;
  570. link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
  571. reader_config(link, i);
  572. return 0;
  573. }
  574. static void reader_detach(struct pcmcia_device *p_dev)
  575. {
  576. dev_link_t *link = dev_to_instance(p_dev);
  577. struct reader_dev *dev = link->priv;
  578. int devno;
  579. /* find device */
  580. for (devno = 0; devno < CM_MAX_DEV; devno++) {
  581. if (dev_table[devno] == link)
  582. break;
  583. }
  584. if (devno == CM_MAX_DEV)
  585. return;
  586. link->state &= ~DEV_PRESENT;
  587. if (link->state & DEV_CONFIG)
  588. reader_release(link);
  589. dev_table[devno] = NULL;
  590. kfree(dev);
  591. return;
  592. }
  593. static struct file_operations reader_fops = {
  594. .owner = THIS_MODULE,
  595. .read = cm4040_read,
  596. .write = cm4040_write,
  597. .open = cm4040_open,
  598. .release = cm4040_close,
  599. .poll = cm4040_poll,
  600. };
  601. static struct pcmcia_device_id cm4040_ids[] = {
  602. PCMCIA_DEVICE_MANF_CARD(0x0223, 0x0200),
  603. PCMCIA_DEVICE_PROD_ID12("OMNIKEY", "CardMan 4040",
  604. 0xE32CDD8C, 0x8F23318B),
  605. PCMCIA_DEVICE_NULL,
  606. };
  607. MODULE_DEVICE_TABLE(pcmcia, cm4040_ids);
  608. static struct pcmcia_driver reader_driver = {
  609. .owner = THIS_MODULE,
  610. .drv = {
  611. .name = "cm4040_cs",
  612. },
  613. .probe = reader_attach,
  614. .remove = reader_detach,
  615. .suspend = reader_suspend,
  616. .resume = reader_resume,
  617. .id_table = cm4040_ids,
  618. };
  619. static int __init cm4040_init(void)
  620. {
  621. printk(KERN_INFO "%s\n", version);
  622. pcmcia_register_driver(&reader_driver);
  623. major = register_chrdev(0, DEVICE_NAME, &reader_fops);
  624. if (major < 0) {
  625. printk(KERN_WARNING MODULE_NAME
  626. ": could not get major number\n");
  627. return -1;
  628. }
  629. return 0;
  630. }
  631. static void __exit cm4040_exit(void)
  632. {
  633. printk(KERN_INFO MODULE_NAME ": unloading\n");
  634. pcmcia_unregister_driver(&reader_driver);
  635. unregister_chrdev(major, DEVICE_NAME);
  636. }
  637. module_init(cm4040_init);
  638. module_exit(cm4040_exit);
  639. MODULE_LICENSE("Dual BSD/GPL");