pl2303.c 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207
  1. /*
  2. * Prolific PL2303 USB to serial adaptor driver
  3. *
  4. * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
  5. * Copyright (C) 2003 IBM Corp.
  6. *
  7. * Original driver for 2.2.x by anonymous
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License.
  12. *
  13. * See Documentation/usb/usb-serial.txt for more information on using this driver
  14. *
  15. */
  16. #include <linux/kernel.h>
  17. #include <linux/errno.h>
  18. #include <linux/init.h>
  19. #include <linux/slab.h>
  20. #include <linux/tty.h>
  21. #include <linux/tty_driver.h>
  22. #include <linux/tty_flip.h>
  23. #include <linux/serial.h>
  24. #include <linux/module.h>
  25. #include <linux/moduleparam.h>
  26. #include <linux/spinlock.h>
  27. #include <asm/uaccess.h>
  28. #include <linux/usb.h>
  29. #include <linux/usb/serial.h>
  30. #include "pl2303.h"
  31. /*
  32. * Version Information
  33. */
  34. #define DRIVER_DESC "Prolific PL2303 USB to serial adaptor driver"
  35. static int debug;
  36. #define PL2303_CLOSING_WAIT (30*HZ)
  37. #define PL2303_BUF_SIZE 1024
  38. #define PL2303_TMP_BUF_SIZE 1024
  39. struct pl2303_buf {
  40. unsigned int buf_size;
  41. char *buf_buf;
  42. char *buf_get;
  43. char *buf_put;
  44. };
  45. static struct usb_device_id id_table [] = {
  46. { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID) },
  47. { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_RSAQ2) },
  48. { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_DCU11) },
  49. { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_RSAQ3) },
  50. { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_PHAROS) },
  51. { USB_DEVICE(IODATA_VENDOR_ID, IODATA_PRODUCT_ID) },
  52. { USB_DEVICE(ATEN_VENDOR_ID, ATEN_PRODUCT_ID) },
  53. { USB_DEVICE(ATEN_VENDOR_ID2, ATEN_PRODUCT_ID) },
  54. { USB_DEVICE(ELCOM_VENDOR_ID, ELCOM_PRODUCT_ID) },
  55. { USB_DEVICE(ELCOM_VENDOR_ID, ELCOM_PRODUCT_ID_UCSGT) },
  56. { USB_DEVICE(ITEGNO_VENDOR_ID, ITEGNO_PRODUCT_ID) },
  57. { USB_DEVICE(ITEGNO_VENDOR_ID, ITEGNO_PRODUCT_ID_2080) },
  58. { USB_DEVICE(MA620_VENDOR_ID, MA620_PRODUCT_ID) },
  59. { USB_DEVICE(RATOC_VENDOR_ID, RATOC_PRODUCT_ID) },
  60. { USB_DEVICE(TRIPP_VENDOR_ID, TRIPP_PRODUCT_ID) },
  61. { USB_DEVICE(RADIOSHACK_VENDOR_ID, RADIOSHACK_PRODUCT_ID) },
  62. { USB_DEVICE(DCU10_VENDOR_ID, DCU10_PRODUCT_ID) },
  63. { USB_DEVICE(SITECOM_VENDOR_ID, SITECOM_PRODUCT_ID) },
  64. { USB_DEVICE(ALCATEL_VENDOR_ID, ALCATEL_PRODUCT_ID) },
  65. { USB_DEVICE(SAMSUNG_VENDOR_ID, SAMSUNG_PRODUCT_ID) },
  66. { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_SX1) },
  67. { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_X65) },
  68. { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_X75) },
  69. { USB_DEVICE(SYNTECH_VENDOR_ID, SYNTECH_PRODUCT_ID) },
  70. { USB_DEVICE(NOKIA_CA42_VENDOR_ID, NOKIA_CA42_PRODUCT_ID) },
  71. { USB_DEVICE(CA_42_CA42_VENDOR_ID, CA_42_CA42_PRODUCT_ID) },
  72. { USB_DEVICE(SAGEM_VENDOR_ID, SAGEM_PRODUCT_ID) },
  73. { USB_DEVICE(LEADTEK_VENDOR_ID, LEADTEK_9531_PRODUCT_ID) },
  74. { USB_DEVICE(SPEEDDRAGON_VENDOR_ID, SPEEDDRAGON_PRODUCT_ID) },
  75. { USB_DEVICE(OTI_VENDOR_ID, OTI_PRODUCT_ID) },
  76. { USB_DEVICE(DATAPILOT_U2_VENDOR_ID, DATAPILOT_U2_PRODUCT_ID) },
  77. { USB_DEVICE(BELKIN_VENDOR_ID, BELKIN_PRODUCT_ID) },
  78. { } /* Terminating entry */
  79. };
  80. MODULE_DEVICE_TABLE (usb, id_table);
  81. static struct usb_driver pl2303_driver = {
  82. .name = "pl2303",
  83. .probe = usb_serial_probe,
  84. .disconnect = usb_serial_disconnect,
  85. .id_table = id_table,
  86. .no_dynamic_id = 1,
  87. };
  88. #define SET_LINE_REQUEST_TYPE 0x21
  89. #define SET_LINE_REQUEST 0x20
  90. #define SET_CONTROL_REQUEST_TYPE 0x21
  91. #define SET_CONTROL_REQUEST 0x22
  92. #define CONTROL_DTR 0x01
  93. #define CONTROL_RTS 0x02
  94. #define BREAK_REQUEST_TYPE 0x21
  95. #define BREAK_REQUEST 0x23
  96. #define BREAK_ON 0xffff
  97. #define BREAK_OFF 0x0000
  98. #define GET_LINE_REQUEST_TYPE 0xa1
  99. #define GET_LINE_REQUEST 0x21
  100. #define VENDOR_WRITE_REQUEST_TYPE 0x40
  101. #define VENDOR_WRITE_REQUEST 0x01
  102. #define VENDOR_READ_REQUEST_TYPE 0xc0
  103. #define VENDOR_READ_REQUEST 0x01
  104. #define UART_STATE 0x08
  105. #define UART_STATE_TRANSIENT_MASK 0x74
  106. #define UART_DCD 0x01
  107. #define UART_DSR 0x02
  108. #define UART_BREAK_ERROR 0x04
  109. #define UART_RING 0x08
  110. #define UART_FRAME_ERROR 0x10
  111. #define UART_PARITY_ERROR 0x20
  112. #define UART_OVERRUN_ERROR 0x40
  113. #define UART_CTS 0x80
  114. /* function prototypes for a PL2303 serial converter */
  115. static int pl2303_open (struct usb_serial_port *port, struct file *filp);
  116. static void pl2303_close (struct usb_serial_port *port, struct file *filp);
  117. static void pl2303_set_termios (struct usb_serial_port *port,
  118. struct termios *old);
  119. static int pl2303_ioctl (struct usb_serial_port *port, struct file *file,
  120. unsigned int cmd, unsigned long arg);
  121. static void pl2303_read_int_callback (struct urb *urb, struct pt_regs *regs);
  122. static void pl2303_read_bulk_callback (struct urb *urb, struct pt_regs *regs);
  123. static void pl2303_write_bulk_callback (struct urb *urb, struct pt_regs *regs);
  124. static int pl2303_write (struct usb_serial_port *port,
  125. const unsigned char *buf, int count);
  126. static void pl2303_send (struct usb_serial_port *port);
  127. static int pl2303_write_room(struct usb_serial_port *port);
  128. static int pl2303_chars_in_buffer(struct usb_serial_port *port);
  129. static void pl2303_break_ctl(struct usb_serial_port *port,int break_state);
  130. static int pl2303_tiocmget (struct usb_serial_port *port, struct file *file);
  131. static int pl2303_tiocmset (struct usb_serial_port *port, struct file *file,
  132. unsigned int set, unsigned int clear);
  133. static int pl2303_startup (struct usb_serial *serial);
  134. static void pl2303_shutdown (struct usb_serial *serial);
  135. static struct pl2303_buf *pl2303_buf_alloc(unsigned int size);
  136. static void pl2303_buf_free(struct pl2303_buf *pb);
  137. static void pl2303_buf_clear(struct pl2303_buf *pb);
  138. static unsigned int pl2303_buf_data_avail(struct pl2303_buf *pb);
  139. static unsigned int pl2303_buf_space_avail(struct pl2303_buf *pb);
  140. static unsigned int pl2303_buf_put(struct pl2303_buf *pb, const char *buf,
  141. unsigned int count);
  142. static unsigned int pl2303_buf_get(struct pl2303_buf *pb, char *buf,
  143. unsigned int count);
  144. /* All of the device info needed for the PL2303 SIO serial converter */
  145. static struct usb_serial_driver pl2303_device = {
  146. .driver = {
  147. .owner = THIS_MODULE,
  148. .name = "pl2303",
  149. },
  150. .id_table = id_table,
  151. .num_interrupt_in = NUM_DONT_CARE,
  152. .num_bulk_in = 1,
  153. .num_bulk_out = 1,
  154. .num_ports = 1,
  155. .open = pl2303_open,
  156. .close = pl2303_close,
  157. .write = pl2303_write,
  158. .ioctl = pl2303_ioctl,
  159. .break_ctl = pl2303_break_ctl,
  160. .set_termios = pl2303_set_termios,
  161. .tiocmget = pl2303_tiocmget,
  162. .tiocmset = pl2303_tiocmset,
  163. .read_bulk_callback = pl2303_read_bulk_callback,
  164. .read_int_callback = pl2303_read_int_callback,
  165. .write_bulk_callback = pl2303_write_bulk_callback,
  166. .write_room = pl2303_write_room,
  167. .chars_in_buffer = pl2303_chars_in_buffer,
  168. .attach = pl2303_startup,
  169. .shutdown = pl2303_shutdown,
  170. };
  171. enum pl2303_type {
  172. type_0, /* don't know the difference between type 0 and */
  173. type_1, /* type 1, until someone from prolific tells us... */
  174. HX, /* HX version of the pl2303 chip */
  175. };
  176. struct pl2303_private {
  177. spinlock_t lock;
  178. struct pl2303_buf *buf;
  179. int write_urb_in_use;
  180. wait_queue_head_t delta_msr_wait;
  181. u8 line_control;
  182. u8 line_status;
  183. u8 termios_initialized;
  184. enum pl2303_type type;
  185. };
  186. static int pl2303_startup (struct usb_serial *serial)
  187. {
  188. struct pl2303_private *priv;
  189. enum pl2303_type type = type_0;
  190. int i;
  191. if (serial->dev->descriptor.bDeviceClass == 0x02)
  192. type = type_0;
  193. else if (serial->dev->descriptor.bMaxPacketSize0 == 0x40)
  194. type = HX;
  195. else if (serial->dev->descriptor.bDeviceClass == 0x00)
  196. type = type_1;
  197. else if (serial->dev->descriptor.bDeviceClass == 0xFF)
  198. type = type_1;
  199. dbg("device type: %d", type);
  200. for (i = 0; i < serial->num_ports; ++i) {
  201. priv = kzalloc(sizeof(struct pl2303_private), GFP_KERNEL);
  202. if (!priv)
  203. goto cleanup;
  204. spin_lock_init(&priv->lock);
  205. priv->buf = pl2303_buf_alloc(PL2303_BUF_SIZE);
  206. if (priv->buf == NULL) {
  207. kfree(priv);
  208. goto cleanup;
  209. }
  210. init_waitqueue_head(&priv->delta_msr_wait);
  211. priv->type = type;
  212. usb_set_serial_port_data(serial->port[i], priv);
  213. }
  214. return 0;
  215. cleanup:
  216. for (--i; i>=0; --i) {
  217. priv = usb_get_serial_port_data(serial->port[i]);
  218. pl2303_buf_free(priv->buf);
  219. kfree(priv);
  220. usb_set_serial_port_data(serial->port[i], NULL);
  221. }
  222. return -ENOMEM;
  223. }
  224. static int set_control_lines (struct usb_device *dev, u8 value)
  225. {
  226. int retval;
  227. retval = usb_control_msg (dev, usb_sndctrlpipe (dev, 0),
  228. SET_CONTROL_REQUEST, SET_CONTROL_REQUEST_TYPE,
  229. value, 0, NULL, 0, 100);
  230. dbg("%s - value = %d, retval = %d", __FUNCTION__, value, retval);
  231. return retval;
  232. }
  233. static int pl2303_write (struct usb_serial_port *port, const unsigned char *buf, int count)
  234. {
  235. struct pl2303_private *priv = usb_get_serial_port_data(port);
  236. unsigned long flags;
  237. dbg("%s - port %d, %d bytes", __FUNCTION__, port->number, count);
  238. if (!count)
  239. return count;
  240. spin_lock_irqsave(&priv->lock, flags);
  241. count = pl2303_buf_put(priv->buf, buf, count);
  242. spin_unlock_irqrestore(&priv->lock, flags);
  243. pl2303_send(port);
  244. return count;
  245. }
  246. static void pl2303_send(struct usb_serial_port *port)
  247. {
  248. int count, result;
  249. struct pl2303_private *priv = usb_get_serial_port_data(port);
  250. unsigned long flags;
  251. dbg("%s - port %d", __FUNCTION__, port->number);
  252. spin_lock_irqsave(&priv->lock, flags);
  253. if (priv->write_urb_in_use) {
  254. spin_unlock_irqrestore(&priv->lock, flags);
  255. return;
  256. }
  257. count = pl2303_buf_get(priv->buf, port->write_urb->transfer_buffer,
  258. port->bulk_out_size);
  259. if (count == 0) {
  260. spin_unlock_irqrestore(&priv->lock, flags);
  261. return;
  262. }
  263. priv->write_urb_in_use = 1;
  264. spin_unlock_irqrestore(&priv->lock, flags);
  265. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, port->write_urb->transfer_buffer);
  266. port->write_urb->transfer_buffer_length = count;
  267. port->write_urb->dev = port->serial->dev;
  268. result = usb_submit_urb (port->write_urb, GFP_ATOMIC);
  269. if (result) {
  270. dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__, result);
  271. priv->write_urb_in_use = 0;
  272. // TODO: reschedule pl2303_send
  273. }
  274. usb_serial_port_softint(port);
  275. }
  276. static int pl2303_write_room(struct usb_serial_port *port)
  277. {
  278. struct pl2303_private *priv = usb_get_serial_port_data(port);
  279. int room = 0;
  280. unsigned long flags;
  281. dbg("%s - port %d", __FUNCTION__, port->number);
  282. spin_lock_irqsave(&priv->lock, flags);
  283. room = pl2303_buf_space_avail(priv->buf);
  284. spin_unlock_irqrestore(&priv->lock, flags);
  285. dbg("%s - returns %d", __FUNCTION__, room);
  286. return room;
  287. }
  288. static int pl2303_chars_in_buffer(struct usb_serial_port *port)
  289. {
  290. struct pl2303_private *priv = usb_get_serial_port_data(port);
  291. int chars = 0;
  292. unsigned long flags;
  293. dbg("%s - port %d", __FUNCTION__, port->number);
  294. spin_lock_irqsave(&priv->lock, flags);
  295. chars = pl2303_buf_data_avail(priv->buf);
  296. spin_unlock_irqrestore(&priv->lock, flags);
  297. dbg("%s - returns %d", __FUNCTION__, chars);
  298. return chars;
  299. }
  300. static void pl2303_set_termios (struct usb_serial_port *port, struct termios *old_termios)
  301. {
  302. struct usb_serial *serial = port->serial;
  303. struct pl2303_private *priv = usb_get_serial_port_data(port);
  304. unsigned long flags;
  305. unsigned int cflag;
  306. unsigned char *buf;
  307. int baud;
  308. int i;
  309. u8 control;
  310. dbg("%s - port %d", __FUNCTION__, port->number);
  311. if ((!port->tty) || (!port->tty->termios)) {
  312. dbg("%s - no tty structures", __FUNCTION__);
  313. return;
  314. }
  315. spin_lock_irqsave(&priv->lock, flags);
  316. if (!priv->termios_initialized) {
  317. *(port->tty->termios) = tty_std_termios;
  318. port->tty->termios->c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
  319. priv->termios_initialized = 1;
  320. }
  321. spin_unlock_irqrestore(&priv->lock, flags);
  322. cflag = port->tty->termios->c_cflag;
  323. /* check that they really want us to change something */
  324. if (old_termios) {
  325. if ((cflag == old_termios->c_cflag) &&
  326. (RELEVANT_IFLAG(port->tty->termios->c_iflag) == RELEVANT_IFLAG(old_termios->c_iflag))) {
  327. dbg("%s - nothing to change...", __FUNCTION__);
  328. return;
  329. }
  330. }
  331. buf = kzalloc (7, GFP_KERNEL);
  332. if (!buf) {
  333. dev_err(&port->dev, "%s - out of memory.\n", __FUNCTION__);
  334. return;
  335. }
  336. i = usb_control_msg (serial->dev, usb_rcvctrlpipe (serial->dev, 0),
  337. GET_LINE_REQUEST, GET_LINE_REQUEST_TYPE,
  338. 0, 0, buf, 7, 100);
  339. dbg ("0xa1:0x21:0:0 %d - %x %x %x %x %x %x %x", i,
  340. buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
  341. if (cflag & CSIZE) {
  342. switch (cflag & CSIZE) {
  343. case CS5: buf[6] = 5; break;
  344. case CS6: buf[6] = 6; break;
  345. case CS7: buf[6] = 7; break;
  346. default:
  347. case CS8: buf[6] = 8; break;
  348. }
  349. dbg("%s - data bits = %d", __FUNCTION__, buf[6]);
  350. }
  351. baud = 0;
  352. switch (cflag & CBAUD) {
  353. case B0: baud = 0; break;
  354. case B75: baud = 75; break;
  355. case B150: baud = 150; break;
  356. case B300: baud = 300; break;
  357. case B600: baud = 600; break;
  358. case B1200: baud = 1200; break;
  359. case B1800: baud = 1800; break;
  360. case B2400: baud = 2400; break;
  361. case B4800: baud = 4800; break;
  362. case B9600: baud = 9600; break;
  363. case B19200: baud = 19200; break;
  364. case B38400: baud = 38400; break;
  365. case B57600: baud = 57600; break;
  366. case B115200: baud = 115200; break;
  367. case B230400: baud = 230400; break;
  368. case B460800: baud = 460800; break;
  369. default:
  370. dev_err(&port->dev, "pl2303 driver does not support the baudrate requested (fix it)\n");
  371. break;
  372. }
  373. dbg("%s - baud = %d", __FUNCTION__, baud);
  374. if (baud) {
  375. buf[0] = baud & 0xff;
  376. buf[1] = (baud >> 8) & 0xff;
  377. buf[2] = (baud >> 16) & 0xff;
  378. buf[3] = (baud >> 24) & 0xff;
  379. }
  380. /* For reference buf[4]=0 is 1 stop bits */
  381. /* For reference buf[4]=1 is 1.5 stop bits */
  382. /* For reference buf[4]=2 is 2 stop bits */
  383. if (cflag & CSTOPB) {
  384. buf[4] = 2;
  385. dbg("%s - stop bits = 2", __FUNCTION__);
  386. } else {
  387. buf[4] = 0;
  388. dbg("%s - stop bits = 1", __FUNCTION__);
  389. }
  390. if (cflag & PARENB) {
  391. /* For reference buf[5]=0 is none parity */
  392. /* For reference buf[5]=1 is odd parity */
  393. /* For reference buf[5]=2 is even parity */
  394. /* For reference buf[5]=3 is mark parity */
  395. /* For reference buf[5]=4 is space parity */
  396. if (cflag & PARODD) {
  397. buf[5] = 1;
  398. dbg("%s - parity = odd", __FUNCTION__);
  399. } else {
  400. buf[5] = 2;
  401. dbg("%s - parity = even", __FUNCTION__);
  402. }
  403. } else {
  404. buf[5] = 0;
  405. dbg("%s - parity = none", __FUNCTION__);
  406. }
  407. i = usb_control_msg (serial->dev, usb_sndctrlpipe (serial->dev, 0),
  408. SET_LINE_REQUEST, SET_LINE_REQUEST_TYPE,
  409. 0, 0, buf, 7, 100);
  410. dbg ("0x21:0x20:0:0 %d", i);
  411. /* change control lines if we are switching to or from B0 */
  412. spin_lock_irqsave(&priv->lock, flags);
  413. control = priv->line_control;
  414. if ((cflag & CBAUD) == B0)
  415. priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
  416. else
  417. priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
  418. if (control != priv->line_control) {
  419. control = priv->line_control;
  420. spin_unlock_irqrestore(&priv->lock, flags);
  421. set_control_lines(serial->dev, control);
  422. } else {
  423. spin_unlock_irqrestore(&priv->lock, flags);
  424. }
  425. buf[0] = buf[1] = buf[2] = buf[3] = buf[4] = buf[5] = buf[6] = 0;
  426. i = usb_control_msg (serial->dev, usb_rcvctrlpipe (serial->dev, 0),
  427. GET_LINE_REQUEST, GET_LINE_REQUEST_TYPE,
  428. 0, 0, buf, 7, 100);
  429. dbg ("0xa1:0x21:0:0 %d - %x %x %x %x %x %x %x", i,
  430. buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
  431. if (cflag & CRTSCTS) {
  432. __u16 index;
  433. if (priv->type == HX)
  434. index = 0x61;
  435. else
  436. index = 0x41;
  437. i = usb_control_msg(serial->dev,
  438. usb_sndctrlpipe(serial->dev, 0),
  439. VENDOR_WRITE_REQUEST,
  440. VENDOR_WRITE_REQUEST_TYPE,
  441. 0x0, index, NULL, 0, 100);
  442. dbg ("0x40:0x1:0x0:0x%x %d", index, i);
  443. }
  444. kfree (buf);
  445. }
  446. static int pl2303_open (struct usb_serial_port *port, struct file *filp)
  447. {
  448. struct termios tmp_termios;
  449. struct usb_serial *serial = port->serial;
  450. struct pl2303_private *priv = usb_get_serial_port_data(port);
  451. unsigned char *buf;
  452. int result;
  453. dbg("%s - port %d", __FUNCTION__, port->number);
  454. if (priv->type != HX) {
  455. usb_clear_halt(serial->dev, port->write_urb->pipe);
  456. usb_clear_halt(serial->dev, port->read_urb->pipe);
  457. }
  458. buf = kmalloc(10, GFP_KERNEL);
  459. if (buf==NULL)
  460. return -ENOMEM;
  461. #define FISH(a,b,c,d) \
  462. result=usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev,0), \
  463. b, a, c, d, buf, 1, 100); \
  464. dbg("0x%x:0x%x:0x%x:0x%x %d - %x",a,b,c,d,result,buf[0]);
  465. #define SOUP(a,b,c,d) \
  466. result=usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev,0), \
  467. b, a, c, d, NULL, 0, 100); \
  468. dbg("0x%x:0x%x:0x%x:0x%x %d",a,b,c,d,result);
  469. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8484, 0);
  470. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 0x0404, 0);
  471. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8484, 0);
  472. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8383, 0);
  473. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8484, 0);
  474. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 0x0404, 1);
  475. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8484, 0);
  476. FISH (VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, 0x8383, 0);
  477. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 0, 1);
  478. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 1, 0);
  479. if (priv->type == HX) {
  480. /* HX chip */
  481. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 2, 0x44);
  482. /* reset upstream data pipes */
  483. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 8, 0);
  484. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 9, 0);
  485. } else {
  486. SOUP (VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, 2, 0x24);
  487. }
  488. kfree(buf);
  489. /* Setup termios */
  490. if (port->tty) {
  491. pl2303_set_termios (port, &tmp_termios);
  492. }
  493. //FIXME: need to assert RTS and DTR if CRTSCTS off
  494. dbg("%s - submitting read urb", __FUNCTION__);
  495. port->read_urb->dev = serial->dev;
  496. result = usb_submit_urb (port->read_urb, GFP_KERNEL);
  497. if (result) {
  498. dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __FUNCTION__, result);
  499. pl2303_close (port, NULL);
  500. return -EPROTO;
  501. }
  502. dbg("%s - submitting interrupt urb", __FUNCTION__);
  503. port->interrupt_in_urb->dev = serial->dev;
  504. result = usb_submit_urb (port->interrupt_in_urb, GFP_KERNEL);
  505. if (result) {
  506. dev_err(&port->dev, "%s - failed submitting interrupt urb, error %d\n", __FUNCTION__, result);
  507. pl2303_close (port, NULL);
  508. return -EPROTO;
  509. }
  510. return 0;
  511. }
  512. static void pl2303_close (struct usb_serial_port *port, struct file *filp)
  513. {
  514. struct pl2303_private *priv = usb_get_serial_port_data(port);
  515. unsigned long flags;
  516. unsigned int c_cflag;
  517. int bps;
  518. long timeout;
  519. wait_queue_t wait;
  520. dbg("%s - port %d", __FUNCTION__, port->number);
  521. /* wait for data to drain from the buffer */
  522. spin_lock_irqsave(&priv->lock, flags);
  523. timeout = PL2303_CLOSING_WAIT;
  524. init_waitqueue_entry(&wait, current);
  525. add_wait_queue(&port->tty->write_wait, &wait);
  526. for (;;) {
  527. set_current_state(TASK_INTERRUPTIBLE);
  528. if (pl2303_buf_data_avail(priv->buf) == 0
  529. || timeout == 0 || signal_pending(current)
  530. || !usb_get_intfdata(port->serial->interface)) /* disconnect */
  531. break;
  532. spin_unlock_irqrestore(&priv->lock, flags);
  533. timeout = schedule_timeout(timeout);
  534. spin_lock_irqsave(&priv->lock, flags);
  535. }
  536. set_current_state(TASK_RUNNING);
  537. remove_wait_queue(&port->tty->write_wait, &wait);
  538. /* clear out any remaining data in the buffer */
  539. pl2303_buf_clear(priv->buf);
  540. spin_unlock_irqrestore(&priv->lock, flags);
  541. /* wait for characters to drain from the device */
  542. /* (this is long enough for the entire 256 byte */
  543. /* pl2303 hardware buffer to drain with no flow */
  544. /* control for data rates of 1200 bps or more, */
  545. /* for lower rates we should really know how much */
  546. /* data is in the buffer to compute a delay */
  547. /* that is not unnecessarily long) */
  548. bps = tty_get_baud_rate(port->tty);
  549. if (bps > 1200)
  550. timeout = max((HZ*2560)/bps,HZ/10);
  551. else
  552. timeout = 2*HZ;
  553. schedule_timeout_interruptible(timeout);
  554. /* shutdown our urbs */
  555. dbg("%s - shutting down urbs", __FUNCTION__);
  556. usb_kill_urb(port->write_urb);
  557. usb_kill_urb(port->read_urb);
  558. usb_kill_urb(port->interrupt_in_urb);
  559. if (port->tty) {
  560. c_cflag = port->tty->termios->c_cflag;
  561. if (c_cflag & HUPCL) {
  562. /* drop DTR and RTS */
  563. spin_lock_irqsave(&priv->lock, flags);
  564. priv->line_control = 0;
  565. spin_unlock_irqrestore (&priv->lock, flags);
  566. set_control_lines (port->serial->dev, 0);
  567. }
  568. }
  569. }
  570. static int pl2303_tiocmset (struct usb_serial_port *port, struct file *file,
  571. unsigned int set, unsigned int clear)
  572. {
  573. struct pl2303_private *priv = usb_get_serial_port_data(port);
  574. unsigned long flags;
  575. u8 control;
  576. if (!usb_get_intfdata(port->serial->interface))
  577. return -ENODEV;
  578. spin_lock_irqsave (&priv->lock, flags);
  579. if (set & TIOCM_RTS)
  580. priv->line_control |= CONTROL_RTS;
  581. if (set & TIOCM_DTR)
  582. priv->line_control |= CONTROL_DTR;
  583. if (clear & TIOCM_RTS)
  584. priv->line_control &= ~CONTROL_RTS;
  585. if (clear & TIOCM_DTR)
  586. priv->line_control &= ~CONTROL_DTR;
  587. control = priv->line_control;
  588. spin_unlock_irqrestore (&priv->lock, flags);
  589. return set_control_lines (port->serial->dev, control);
  590. }
  591. static int pl2303_tiocmget (struct usb_serial_port *port, struct file *file)
  592. {
  593. struct pl2303_private *priv = usb_get_serial_port_data(port);
  594. unsigned long flags;
  595. unsigned int mcr;
  596. unsigned int status;
  597. unsigned int result;
  598. dbg("%s (%d)", __FUNCTION__, port->number);
  599. if (!usb_get_intfdata(port->serial->interface))
  600. return -ENODEV;
  601. spin_lock_irqsave (&priv->lock, flags);
  602. mcr = priv->line_control;
  603. status = priv->line_status;
  604. spin_unlock_irqrestore (&priv->lock, flags);
  605. result = ((mcr & CONTROL_DTR) ? TIOCM_DTR : 0)
  606. | ((mcr & CONTROL_RTS) ? TIOCM_RTS : 0)
  607. | ((status & UART_CTS) ? TIOCM_CTS : 0)
  608. | ((status & UART_DSR) ? TIOCM_DSR : 0)
  609. | ((status & UART_RING) ? TIOCM_RI : 0)
  610. | ((status & UART_DCD) ? TIOCM_CD : 0);
  611. dbg("%s - result = %x", __FUNCTION__, result);
  612. return result;
  613. }
  614. static int wait_modem_info(struct usb_serial_port *port, unsigned int arg)
  615. {
  616. struct pl2303_private *priv = usb_get_serial_port_data(port);
  617. unsigned long flags;
  618. unsigned int prevstatus;
  619. unsigned int status;
  620. unsigned int changed;
  621. spin_lock_irqsave (&priv->lock, flags);
  622. prevstatus = priv->line_status;
  623. spin_unlock_irqrestore (&priv->lock, flags);
  624. while (1) {
  625. interruptible_sleep_on(&priv->delta_msr_wait);
  626. /* see if a signal did it */
  627. if (signal_pending(current))
  628. return -ERESTARTSYS;
  629. spin_lock_irqsave (&priv->lock, flags);
  630. status = priv->line_status;
  631. spin_unlock_irqrestore (&priv->lock, flags);
  632. changed=prevstatus^status;
  633. if (((arg & TIOCM_RNG) && (changed & UART_RING)) ||
  634. ((arg & TIOCM_DSR) && (changed & UART_DSR)) ||
  635. ((arg & TIOCM_CD) && (changed & UART_DCD)) ||
  636. ((arg & TIOCM_CTS) && (changed & UART_CTS)) ) {
  637. return 0;
  638. }
  639. prevstatus = status;
  640. }
  641. /* NOTREACHED */
  642. return 0;
  643. }
  644. static int pl2303_ioctl (struct usb_serial_port *port, struct file *file, unsigned int cmd, unsigned long arg)
  645. {
  646. dbg("%s (%d) cmd = 0x%04x", __FUNCTION__, port->number, cmd);
  647. switch (cmd) {
  648. case TIOCMIWAIT:
  649. dbg("%s (%d) TIOCMIWAIT", __FUNCTION__, port->number);
  650. return wait_modem_info(port, arg);
  651. default:
  652. dbg("%s not supported = 0x%04x", __FUNCTION__, cmd);
  653. break;
  654. }
  655. return -ENOIOCTLCMD;
  656. }
  657. static void pl2303_break_ctl (struct usb_serial_port *port, int break_state)
  658. {
  659. struct usb_serial *serial = port->serial;
  660. u16 state;
  661. int result;
  662. dbg("%s - port %d", __FUNCTION__, port->number);
  663. if (break_state == 0)
  664. state = BREAK_OFF;
  665. else
  666. state = BREAK_ON;
  667. dbg("%s - turning break %s", __FUNCTION__, state==BREAK_OFF ? "off" : "on");
  668. result = usb_control_msg (serial->dev, usb_sndctrlpipe (serial->dev, 0),
  669. BREAK_REQUEST, BREAK_REQUEST_TYPE, state,
  670. 0, NULL, 0, 100);
  671. if (result)
  672. dbg("%s - error sending break = %d", __FUNCTION__, result);
  673. }
  674. static void pl2303_shutdown (struct usb_serial *serial)
  675. {
  676. int i;
  677. struct pl2303_private *priv;
  678. dbg("%s", __FUNCTION__);
  679. for (i = 0; i < serial->num_ports; ++i) {
  680. priv = usb_get_serial_port_data(serial->port[i]);
  681. if (priv) {
  682. pl2303_buf_free(priv->buf);
  683. kfree(priv);
  684. usb_set_serial_port_data(serial->port[i], NULL);
  685. }
  686. }
  687. }
  688. static void pl2303_update_line_status(struct usb_serial_port *port,
  689. unsigned char *data,
  690. unsigned int actual_length)
  691. {
  692. struct pl2303_private *priv = usb_get_serial_port_data(port);
  693. unsigned long flags;
  694. u8 status_idx = UART_STATE;
  695. u8 length = UART_STATE + 1;
  696. if ((le16_to_cpu(port->serial->dev->descriptor.idVendor) == SIEMENS_VENDOR_ID) &&
  697. (le16_to_cpu(port->serial->dev->descriptor.idProduct) == SIEMENS_PRODUCT_ID_X65 ||
  698. le16_to_cpu(port->serial->dev->descriptor.idProduct) == SIEMENS_PRODUCT_ID_SX1 ||
  699. le16_to_cpu(port->serial->dev->descriptor.idProduct) == SIEMENS_PRODUCT_ID_X75)) {
  700. length = 1;
  701. status_idx = 0;
  702. }
  703. if (actual_length < length)
  704. goto exit;
  705. /* Save off the uart status for others to look at */
  706. spin_lock_irqsave(&priv->lock, flags);
  707. priv->line_status = data[status_idx];
  708. spin_unlock_irqrestore(&priv->lock, flags);
  709. wake_up_interruptible (&priv->delta_msr_wait);
  710. exit:
  711. return;
  712. }
  713. static void pl2303_read_int_callback (struct urb *urb, struct pt_regs *regs)
  714. {
  715. struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
  716. unsigned char *data = urb->transfer_buffer;
  717. unsigned int actual_length = urb->actual_length;
  718. int status;
  719. dbg("%s (%d)", __FUNCTION__, port->number);
  720. switch (urb->status) {
  721. case 0:
  722. /* success */
  723. break;
  724. case -ECONNRESET:
  725. case -ENOENT:
  726. case -ESHUTDOWN:
  727. /* this urb is terminated, clean up */
  728. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  729. return;
  730. default:
  731. dbg("%s - nonzero urb status received: %d", __FUNCTION__, urb->status);
  732. goto exit;
  733. }
  734. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, urb->actual_length, urb->transfer_buffer);
  735. pl2303_update_line_status(port, data, actual_length);
  736. exit:
  737. status = usb_submit_urb (urb, GFP_ATOMIC);
  738. if (status)
  739. dev_err(&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n",
  740. __FUNCTION__, status);
  741. }
  742. static void pl2303_read_bulk_callback (struct urb *urb, struct pt_regs *regs)
  743. {
  744. struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
  745. struct pl2303_private *priv = usb_get_serial_port_data(port);
  746. struct tty_struct *tty;
  747. unsigned char *data = urb->transfer_buffer;
  748. unsigned long flags;
  749. int i;
  750. int result;
  751. u8 status;
  752. char tty_flag;
  753. dbg("%s - port %d", __FUNCTION__, port->number);
  754. if (urb->status) {
  755. dbg("%s - urb->status = %d", __FUNCTION__, urb->status);
  756. if (!port->open_count) {
  757. dbg("%s - port is closed, exiting.", __FUNCTION__);
  758. return;
  759. }
  760. if (urb->status == -EPROTO) {
  761. /* PL2303 mysteriously fails with -EPROTO reschedule the read */
  762. dbg("%s - caught -EPROTO, resubmitting the urb", __FUNCTION__);
  763. urb->status = 0;
  764. urb->dev = port->serial->dev;
  765. result = usb_submit_urb(urb, GFP_ATOMIC);
  766. if (result)
  767. dev_err(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n", __FUNCTION__, result);
  768. return;
  769. }
  770. dbg("%s - unable to handle the error, exiting.", __FUNCTION__);
  771. return;
  772. }
  773. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, urb->actual_length, data);
  774. /* get tty_flag from status */
  775. tty_flag = TTY_NORMAL;
  776. spin_lock_irqsave(&priv->lock, flags);
  777. status = priv->line_status;
  778. priv->line_status &= ~UART_STATE_TRANSIENT_MASK;
  779. spin_unlock_irqrestore(&priv->lock, flags);
  780. wake_up_interruptible (&priv->delta_msr_wait);
  781. /* break takes precedence over parity, */
  782. /* which takes precedence over framing errors */
  783. if (status & UART_BREAK_ERROR )
  784. tty_flag = TTY_BREAK;
  785. else if (status & UART_PARITY_ERROR)
  786. tty_flag = TTY_PARITY;
  787. else if (status & UART_FRAME_ERROR)
  788. tty_flag = TTY_FRAME;
  789. dbg("%s - tty_flag = %d", __FUNCTION__, tty_flag);
  790. tty = port->tty;
  791. if (tty && urb->actual_length) {
  792. tty_buffer_request_room(tty, urb->actual_length + 1);
  793. /* overrun is special, not associated with a char */
  794. if (status & UART_OVERRUN_ERROR)
  795. tty_insert_flip_char(tty, 0, TTY_OVERRUN);
  796. for (i = 0; i < urb->actual_length; ++i)
  797. tty_insert_flip_char (tty, data[i], tty_flag);
  798. tty_flip_buffer_push (tty);
  799. }
  800. /* Schedule the next read _if_ we are still open */
  801. if (port->open_count) {
  802. urb->dev = port->serial->dev;
  803. result = usb_submit_urb(urb, GFP_ATOMIC);
  804. if (result)
  805. dev_err(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n", __FUNCTION__, result);
  806. }
  807. return;
  808. }
  809. static void pl2303_write_bulk_callback (struct urb *urb, struct pt_regs *regs)
  810. {
  811. struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
  812. struct pl2303_private *priv = usb_get_serial_port_data(port);
  813. int result;
  814. dbg("%s - port %d", __FUNCTION__, port->number);
  815. switch (urb->status) {
  816. case 0:
  817. /* success */
  818. break;
  819. case -ECONNRESET:
  820. case -ENOENT:
  821. case -ESHUTDOWN:
  822. /* this urb is terminated, clean up */
  823. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  824. priv->write_urb_in_use = 0;
  825. return;
  826. default:
  827. /* error in the urb, so we have to resubmit it */
  828. dbg("%s - Overflow in write", __FUNCTION__);
  829. dbg("%s - nonzero write bulk status received: %d", __FUNCTION__, urb->status);
  830. port->write_urb->transfer_buffer_length = 1;
  831. port->write_urb->dev = port->serial->dev;
  832. result = usb_submit_urb (port->write_urb, GFP_ATOMIC);
  833. if (result)
  834. dev_err(&urb->dev->dev, "%s - failed resubmitting write urb, error %d\n", __FUNCTION__, result);
  835. else
  836. return;
  837. }
  838. priv->write_urb_in_use = 0;
  839. /* send any buffered data */
  840. pl2303_send(port);
  841. }
  842. /*
  843. * pl2303_buf_alloc
  844. *
  845. * Allocate a circular buffer and all associated memory.
  846. */
  847. static struct pl2303_buf *pl2303_buf_alloc(unsigned int size)
  848. {
  849. struct pl2303_buf *pb;
  850. if (size == 0)
  851. return NULL;
  852. pb = (struct pl2303_buf *)kmalloc(sizeof(struct pl2303_buf), GFP_KERNEL);
  853. if (pb == NULL)
  854. return NULL;
  855. pb->buf_buf = kmalloc(size, GFP_KERNEL);
  856. if (pb->buf_buf == NULL) {
  857. kfree(pb);
  858. return NULL;
  859. }
  860. pb->buf_size = size;
  861. pb->buf_get = pb->buf_put = pb->buf_buf;
  862. return pb;
  863. }
  864. /*
  865. * pl2303_buf_free
  866. *
  867. * Free the buffer and all associated memory.
  868. */
  869. static void pl2303_buf_free(struct pl2303_buf *pb)
  870. {
  871. if (pb) {
  872. kfree(pb->buf_buf);
  873. kfree(pb);
  874. }
  875. }
  876. /*
  877. * pl2303_buf_clear
  878. *
  879. * Clear out all data in the circular buffer.
  880. */
  881. static void pl2303_buf_clear(struct pl2303_buf *pb)
  882. {
  883. if (pb != NULL)
  884. pb->buf_get = pb->buf_put;
  885. /* equivalent to a get of all data available */
  886. }
  887. /*
  888. * pl2303_buf_data_avail
  889. *
  890. * Return the number of bytes of data available in the circular
  891. * buffer.
  892. */
  893. static unsigned int pl2303_buf_data_avail(struct pl2303_buf *pb)
  894. {
  895. if (pb != NULL)
  896. return ((pb->buf_size + pb->buf_put - pb->buf_get) % pb->buf_size);
  897. else
  898. return 0;
  899. }
  900. /*
  901. * pl2303_buf_space_avail
  902. *
  903. * Return the number of bytes of space available in the circular
  904. * buffer.
  905. */
  906. static unsigned int pl2303_buf_space_avail(struct pl2303_buf *pb)
  907. {
  908. if (pb != NULL)
  909. return ((pb->buf_size + pb->buf_get - pb->buf_put - 1) % pb->buf_size);
  910. else
  911. return 0;
  912. }
  913. /*
  914. * pl2303_buf_put
  915. *
  916. * Copy data data from a user buffer and put it into the circular buffer.
  917. * Restrict to the amount of space available.
  918. *
  919. * Return the number of bytes copied.
  920. */
  921. static unsigned int pl2303_buf_put(struct pl2303_buf *pb, const char *buf,
  922. unsigned int count)
  923. {
  924. unsigned int len;
  925. if (pb == NULL)
  926. return 0;
  927. len = pl2303_buf_space_avail(pb);
  928. if (count > len)
  929. count = len;
  930. if (count == 0)
  931. return 0;
  932. len = pb->buf_buf + pb->buf_size - pb->buf_put;
  933. if (count > len) {
  934. memcpy(pb->buf_put, buf, len);
  935. memcpy(pb->buf_buf, buf+len, count - len);
  936. pb->buf_put = pb->buf_buf + count - len;
  937. } else {
  938. memcpy(pb->buf_put, buf, count);
  939. if (count < len)
  940. pb->buf_put += count;
  941. else /* count == len */
  942. pb->buf_put = pb->buf_buf;
  943. }
  944. return count;
  945. }
  946. /*
  947. * pl2303_buf_get
  948. *
  949. * Get data from the circular buffer and copy to the given buffer.
  950. * Restrict to the amount of data available.
  951. *
  952. * Return the number of bytes copied.
  953. */
  954. static unsigned int pl2303_buf_get(struct pl2303_buf *pb, char *buf,
  955. unsigned int count)
  956. {
  957. unsigned int len;
  958. if (pb == NULL)
  959. return 0;
  960. len = pl2303_buf_data_avail(pb);
  961. if (count > len)
  962. count = len;
  963. if (count == 0)
  964. return 0;
  965. len = pb->buf_buf + pb->buf_size - pb->buf_get;
  966. if (count > len) {
  967. memcpy(buf, pb->buf_get, len);
  968. memcpy(buf+len, pb->buf_buf, count - len);
  969. pb->buf_get = pb->buf_buf + count - len;
  970. } else {
  971. memcpy(buf, pb->buf_get, count);
  972. if (count < len)
  973. pb->buf_get += count;
  974. else /* count == len */
  975. pb->buf_get = pb->buf_buf;
  976. }
  977. return count;
  978. }
  979. static int __init pl2303_init (void)
  980. {
  981. int retval;
  982. retval = usb_serial_register(&pl2303_device);
  983. if (retval)
  984. goto failed_usb_serial_register;
  985. retval = usb_register(&pl2303_driver);
  986. if (retval)
  987. goto failed_usb_register;
  988. info(DRIVER_DESC);
  989. return 0;
  990. failed_usb_register:
  991. usb_serial_deregister(&pl2303_device);
  992. failed_usb_serial_register:
  993. return retval;
  994. }
  995. static void __exit pl2303_exit (void)
  996. {
  997. usb_deregister (&pl2303_driver);
  998. usb_serial_deregister (&pl2303_device);
  999. }
  1000. module_init(pl2303_init);
  1001. module_exit(pl2303_exit);
  1002. MODULE_DESCRIPTION(DRIVER_DESC);
  1003. MODULE_LICENSE("GPL");
  1004. module_param(debug, bool, S_IRUGO | S_IWUSR);
  1005. MODULE_PARM_DESC(debug, "Debug enabled or not");