cypress_m8.c 49 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724
  1. /*
  2. * USB Cypress M8 driver
  3. *
  4. * Copyright (C) 2004
  5. * Lonnie Mendez (dignome@gmail.com)
  6. * Copyright (C) 2003,2004
  7. * Neil Whelchel (koyama@firstlight.net)
  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, or
  12. * (at your option) any later version.
  13. *
  14. * See Documentation/usb/usb-serial.txt for more information on using this driver
  15. *
  16. * See http://geocities.com/i0xox0i for information on this driver and the
  17. * earthmate usb device.
  18. *
  19. * Lonnie Mendez <dignome@gmail.com>
  20. * 4-29-2005
  21. * Fixed problem where setting or retreiving the serial config would fail with
  22. * EPIPE. Removed CRTS toggling so the driver behaves more like other usbserial
  23. * adapters. Issued new interval of 1ms instead of the default 10ms. As a
  24. * result, transfer speed has been substantially increased. From avg. 850bps to
  25. * avg. 3300bps. initial termios has also been modified. Cleaned up code and
  26. * formatting issues so it is more readable. Replaced the C++ style comments.
  27. *
  28. * Lonnie Mendez <dignome@gmail.com>
  29. * 12-15-2004
  30. * Incorporated write buffering from pl2303 driver. Fixed bug with line
  31. * handling so both lines are raised in cypress_open. (was dropping rts)
  32. * Various code cleanups made as well along with other misc bug fixes.
  33. *
  34. * Lonnie Mendez <dignome@gmail.com>
  35. * 04-10-2004
  36. * Driver modified to support dynamic line settings. Various improvments
  37. * and features.
  38. *
  39. * Neil Whelchel
  40. * 10-2003
  41. * Driver first released.
  42. *
  43. */
  44. /* Thanks to Neil Whelchel for writing the first cypress m8 implementation for linux. */
  45. /* Thanks to cypress for providing references for the hid reports. */
  46. /* Thanks to Jiang Zhang for providing links and for general help. */
  47. /* Code originates and was built up from ftdi_sio, belkin, pl2303 and others. */
  48. #include <linux/kernel.h>
  49. #include <linux/errno.h>
  50. #include <linux/init.h>
  51. #include <linux/slab.h>
  52. #include <linux/tty.h>
  53. #include <linux/tty_driver.h>
  54. #include <linux/tty_flip.h>
  55. #include <linux/module.h>
  56. #include <linux/moduleparam.h>
  57. #include <linux/spinlock.h>
  58. #include <linux/usb.h>
  59. #include <linux/usb/serial.h>
  60. #include <linux/serial.h>
  61. #include <linux/delay.h>
  62. #include <asm/uaccess.h>
  63. #include "cypress_m8.h"
  64. #ifdef CONFIG_USB_SERIAL_DEBUG
  65. static int debug = 1;
  66. #else
  67. static int debug;
  68. #endif
  69. static int stats;
  70. static int interval;
  71. /*
  72. * Version Information
  73. */
  74. #define DRIVER_VERSION "v1.09"
  75. #define DRIVER_AUTHOR "Lonnie Mendez <dignome@gmail.com>, Neil Whelchel <koyama@firstlight.net>"
  76. #define DRIVER_DESC "Cypress USB to Serial Driver"
  77. /* write buffer size defines */
  78. #define CYPRESS_BUF_SIZE 1024
  79. #define CYPRESS_CLOSING_WAIT (30*HZ)
  80. static struct usb_device_id id_table_earthmate [] = {
  81. { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) },
  82. { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) },
  83. { } /* Terminating entry */
  84. };
  85. static struct usb_device_id id_table_cyphidcomrs232 [] = {
  86. { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) },
  87. { } /* Terminating entry */
  88. };
  89. static struct usb_device_id id_table_nokiaca42v2 [] = {
  90. { USB_DEVICE(VENDOR_ID_DAZZLE, PRODUCT_ID_CA42) },
  91. { } /* Terminating entry */
  92. };
  93. static struct usb_device_id id_table_combined [] = {
  94. { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) },
  95. { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) },
  96. { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) },
  97. { USB_DEVICE(VENDOR_ID_DAZZLE, PRODUCT_ID_CA42) },
  98. { } /* Terminating entry */
  99. };
  100. MODULE_DEVICE_TABLE (usb, id_table_combined);
  101. static struct usb_driver cypress_driver = {
  102. .name = "cypress",
  103. .probe = usb_serial_probe,
  104. .disconnect = usb_serial_disconnect,
  105. .id_table = id_table_combined,
  106. .no_dynamic_id = 1,
  107. };
  108. struct cypress_private {
  109. spinlock_t lock; /* private lock */
  110. int chiptype; /* identifier of device, for quirks/etc */
  111. int bytes_in; /* used for statistics */
  112. int bytes_out; /* used for statistics */
  113. int cmd_count; /* used for statistics */
  114. int cmd_ctrl; /* always set this to 1 before issuing a command */
  115. struct cypress_buf *buf; /* write buffer */
  116. int write_urb_in_use; /* write urb in use indicator */
  117. int write_urb_interval; /* interval to use for write urb */
  118. int read_urb_interval; /* interval to use for read urb */
  119. int comm_is_ok; /* true if communication is (still) ok */
  120. int termios_initialized;
  121. __u8 line_control; /* holds dtr / rts value */
  122. __u8 current_status; /* received from last read - info on dsr,cts,cd,ri,etc */
  123. __u8 current_config; /* stores the current configuration byte */
  124. __u8 rx_flags; /* throttling - used from whiteheat/ftdi_sio */
  125. int baud_rate; /* stores current baud rate in integer form */
  126. int cbr_mask; /* stores current baud rate in masked form */
  127. int isthrottled; /* if throttled, discard reads */
  128. wait_queue_head_t delta_msr_wait; /* used for TIOCMIWAIT */
  129. char prev_status, diff_status; /* used for TIOCMIWAIT */
  130. /* we pass a pointer to this as the arguement sent to cypress_set_termios old_termios */
  131. struct termios tmp_termios; /* stores the old termios settings */
  132. };
  133. /* write buffer structure */
  134. struct cypress_buf {
  135. unsigned int buf_size;
  136. char *buf_buf;
  137. char *buf_get;
  138. char *buf_put;
  139. };
  140. /* function prototypes for the Cypress USB to serial device */
  141. static int cypress_earthmate_startup (struct usb_serial *serial);
  142. static int cypress_hidcom_startup (struct usb_serial *serial);
  143. static int cypress_ca42v2_startup (struct usb_serial *serial);
  144. static void cypress_shutdown (struct usb_serial *serial);
  145. static int cypress_open (struct usb_serial_port *port, struct file *filp);
  146. static void cypress_close (struct usb_serial_port *port, struct file *filp);
  147. static int cypress_write (struct usb_serial_port *port, const unsigned char *buf, int count);
  148. static void cypress_send (struct usb_serial_port *port);
  149. static int cypress_write_room (struct usb_serial_port *port);
  150. static int cypress_ioctl (struct usb_serial_port *port, struct file * file, unsigned int cmd, unsigned long arg);
  151. static void cypress_set_termios (struct usb_serial_port *port, struct termios * old);
  152. static int cypress_tiocmget (struct usb_serial_port *port, struct file *file);
  153. static int cypress_tiocmset (struct usb_serial_port *port, struct file *file, unsigned int set, unsigned int clear);
  154. static int cypress_chars_in_buffer (struct usb_serial_port *port);
  155. static void cypress_throttle (struct usb_serial_port *port);
  156. static void cypress_unthrottle (struct usb_serial_port *port);
  157. static void cypress_set_dead (struct usb_serial_port *port);
  158. static void cypress_read_int_callback (struct urb *urb);
  159. static void cypress_write_int_callback (struct urb *urb);
  160. /* baud helper functions */
  161. static int mask_to_rate (unsigned mask);
  162. static unsigned rate_to_mask (int rate);
  163. /* write buffer functions */
  164. static struct cypress_buf *cypress_buf_alloc(unsigned int size);
  165. static void cypress_buf_free(struct cypress_buf *cb);
  166. static void cypress_buf_clear(struct cypress_buf *cb);
  167. static unsigned int cypress_buf_data_avail(struct cypress_buf *cb);
  168. static unsigned int cypress_buf_space_avail(struct cypress_buf *cb);
  169. static unsigned int cypress_buf_put(struct cypress_buf *cb, const char *buf, unsigned int count);
  170. static unsigned int cypress_buf_get(struct cypress_buf *cb, char *buf, unsigned int count);
  171. static struct usb_serial_driver cypress_earthmate_device = {
  172. .driver = {
  173. .owner = THIS_MODULE,
  174. .name = "earthmate",
  175. },
  176. .description = "DeLorme Earthmate USB",
  177. .id_table = id_table_earthmate,
  178. .num_interrupt_in = 1,
  179. .num_interrupt_out = 1,
  180. .num_bulk_in = NUM_DONT_CARE,
  181. .num_bulk_out = NUM_DONT_CARE,
  182. .num_ports = 1,
  183. .attach = cypress_earthmate_startup,
  184. .shutdown = cypress_shutdown,
  185. .open = cypress_open,
  186. .close = cypress_close,
  187. .write = cypress_write,
  188. .write_room = cypress_write_room,
  189. .ioctl = cypress_ioctl,
  190. .set_termios = cypress_set_termios,
  191. .tiocmget = cypress_tiocmget,
  192. .tiocmset = cypress_tiocmset,
  193. .chars_in_buffer = cypress_chars_in_buffer,
  194. .throttle = cypress_throttle,
  195. .unthrottle = cypress_unthrottle,
  196. .read_int_callback = cypress_read_int_callback,
  197. .write_int_callback = cypress_write_int_callback,
  198. };
  199. static struct usb_serial_driver cypress_hidcom_device = {
  200. .driver = {
  201. .owner = THIS_MODULE,
  202. .name = "cyphidcom",
  203. },
  204. .description = "HID->COM RS232 Adapter",
  205. .id_table = id_table_cyphidcomrs232,
  206. .num_interrupt_in = 1,
  207. .num_interrupt_out = 1,
  208. .num_bulk_in = NUM_DONT_CARE,
  209. .num_bulk_out = NUM_DONT_CARE,
  210. .num_ports = 1,
  211. .attach = cypress_hidcom_startup,
  212. .shutdown = cypress_shutdown,
  213. .open = cypress_open,
  214. .close = cypress_close,
  215. .write = cypress_write,
  216. .write_room = cypress_write_room,
  217. .ioctl = cypress_ioctl,
  218. .set_termios = cypress_set_termios,
  219. .tiocmget = cypress_tiocmget,
  220. .tiocmset = cypress_tiocmset,
  221. .chars_in_buffer = cypress_chars_in_buffer,
  222. .throttle = cypress_throttle,
  223. .unthrottle = cypress_unthrottle,
  224. .read_int_callback = cypress_read_int_callback,
  225. .write_int_callback = cypress_write_int_callback,
  226. };
  227. static struct usb_serial_driver cypress_ca42v2_device = {
  228. .driver = {
  229. .owner = THIS_MODULE,
  230. .name = "nokiaca42v2",
  231. },
  232. .description = "Nokia CA-42 V2 Adapter",
  233. .id_table = id_table_nokiaca42v2,
  234. .num_interrupt_in = 1,
  235. .num_interrupt_out = 1,
  236. .num_bulk_in = NUM_DONT_CARE,
  237. .num_bulk_out = NUM_DONT_CARE,
  238. .num_ports = 1,
  239. .attach = cypress_ca42v2_startup,
  240. .shutdown = cypress_shutdown,
  241. .open = cypress_open,
  242. .close = cypress_close,
  243. .write = cypress_write,
  244. .write_room = cypress_write_room,
  245. .ioctl = cypress_ioctl,
  246. .set_termios = cypress_set_termios,
  247. .tiocmget = cypress_tiocmget,
  248. .tiocmset = cypress_tiocmset,
  249. .chars_in_buffer = cypress_chars_in_buffer,
  250. .throttle = cypress_throttle,
  251. .unthrottle = cypress_unthrottle,
  252. .read_int_callback = cypress_read_int_callback,
  253. .write_int_callback = cypress_write_int_callback,
  254. };
  255. /*****************************************************************************
  256. * Cypress serial helper functions
  257. *****************************************************************************/
  258. /* This function can either set or retrieve the current serial line settings */
  259. static int cypress_serial_control (struct usb_serial_port *port, unsigned baud_mask, int data_bits, int stop_bits,
  260. int parity_enable, int parity_type, int reset, int cypress_request_type)
  261. {
  262. int new_baudrate = 0, retval = 0, tries = 0;
  263. struct cypress_private *priv;
  264. __u8 feature_buffer[8];
  265. unsigned long flags;
  266. dbg("%s", __FUNCTION__);
  267. priv = usb_get_serial_port_data(port);
  268. if (!priv->comm_is_ok)
  269. return -ENODEV;
  270. switch(cypress_request_type) {
  271. case CYPRESS_SET_CONFIG:
  272. /*
  273. * The general purpose firmware for the Cypress M8 allows for a maximum speed
  274. * of 57600bps (I have no idea whether DeLorme chose to use the general purpose
  275. * firmware or not), if you need to modify this speed setting for your own
  276. * project please add your own chiptype and modify the code likewise. The
  277. * Cypress HID->COM device will work successfully up to 115200bps (but the
  278. * actual throughput is around 3kBps).
  279. */
  280. if (baud_mask != priv->cbr_mask) {
  281. dbg("%s - baud rate is changing", __FUNCTION__);
  282. if ( priv->chiptype == CT_EARTHMATE ) {
  283. /* 300 and 600 baud rates are supported under the generic firmware,
  284. * but are not used with NMEA and SiRF protocols */
  285. if ( (baud_mask == B300) || (baud_mask == B600) ) {
  286. err("%s - failed setting baud rate, unsupported speed",
  287. __FUNCTION__);
  288. new_baudrate = priv->baud_rate;
  289. } else if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
  290. err("%s - failed setting baud rate, unsupported speed",
  291. __FUNCTION__);
  292. new_baudrate = priv->baud_rate;
  293. }
  294. } else if (priv->chiptype == CT_CYPHIDCOM) {
  295. if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
  296. err("%s - failed setting baud rate, unsupported speed",
  297. __FUNCTION__);
  298. new_baudrate = priv->baud_rate;
  299. }
  300. } else if (priv->chiptype == CT_CA42V2) {
  301. if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
  302. err("%s - failed setting baud rate, unsupported speed",
  303. __FUNCTION__);
  304. new_baudrate = priv->baud_rate;
  305. }
  306. } else if (priv->chiptype == CT_GENERIC) {
  307. if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
  308. err("%s - failed setting baud rate, unsupported speed",
  309. __FUNCTION__);
  310. new_baudrate = priv->baud_rate;
  311. }
  312. } else {
  313. info("%s - please define your chiptype", __FUNCTION__);
  314. new_baudrate = priv->baud_rate;
  315. }
  316. } else { /* baud rate not changing, keep the old */
  317. new_baudrate = priv->baud_rate;
  318. }
  319. dbg("%s - baud rate is being sent as %d", __FUNCTION__, new_baudrate);
  320. memset(feature_buffer, 0, 8);
  321. /* fill the feature_buffer with new configuration */
  322. *((u_int32_t *)feature_buffer) = new_baudrate;
  323. feature_buffer[4] |= data_bits; /* assign data bits in 2 bit space ( max 3 ) */
  324. /* 1 bit gap */
  325. feature_buffer[4] |= (stop_bits << 3); /* assign stop bits in 1 bit space */
  326. feature_buffer[4] |= (parity_enable << 4); /* assign parity flag in 1 bit space */
  327. feature_buffer[4] |= (parity_type << 5); /* assign parity type in 1 bit space */
  328. /* 1 bit gap */
  329. feature_buffer[4] |= (reset << 7); /* assign reset at end of byte, 1 bit space */
  330. dbg("%s - device is being sent this feature report:", __FUNCTION__);
  331. dbg("%s - %02X - %02X - %02X - %02X - %02X", __FUNCTION__, feature_buffer[0], feature_buffer[1],
  332. feature_buffer[2], feature_buffer[3], feature_buffer[4]);
  333. do {
  334. retval = usb_control_msg (port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
  335. HID_REQ_SET_REPORT, USB_DIR_OUT | USB_RECIP_INTERFACE | USB_TYPE_CLASS,
  336. 0x0300, 0, feature_buffer, 8, 500);
  337. if (tries++ >= 3)
  338. break;
  339. } while (retval != 8 && retval != -ENODEV);
  340. if (retval != 8) {
  341. err("%s - failed sending serial line settings - %d", __FUNCTION__, retval);
  342. cypress_set_dead(port);
  343. } else {
  344. spin_lock_irqsave(&priv->lock, flags);
  345. priv->baud_rate = new_baudrate;
  346. priv->cbr_mask = baud_mask;
  347. priv->current_config = feature_buffer[4];
  348. spin_unlock_irqrestore(&priv->lock, flags);
  349. }
  350. break;
  351. case CYPRESS_GET_CONFIG:
  352. dbg("%s - retreiving serial line settings", __FUNCTION__);
  353. /* set initial values in feature buffer */
  354. memset(feature_buffer, 0, 8);
  355. do {
  356. retval = usb_control_msg (port->serial->dev, usb_rcvctrlpipe(port->serial->dev, 0),
  357. HID_REQ_GET_REPORT, USB_DIR_IN | USB_RECIP_INTERFACE | USB_TYPE_CLASS,
  358. 0x0300, 0, feature_buffer, 8, 500);
  359. if (tries++ >= 3)
  360. break;
  361. } while (retval != 5 && retval != -ENODEV);
  362. if (retval != 5) {
  363. err("%s - failed to retrieve serial line settings - %d", __FUNCTION__, retval);
  364. cypress_set_dead(port);
  365. return retval;
  366. } else {
  367. spin_lock_irqsave(&priv->lock, flags);
  368. /* store the config in one byte, and later use bit masks to check values */
  369. priv->current_config = feature_buffer[4];
  370. priv->baud_rate = *((u_int32_t *)feature_buffer);
  371. if ( (priv->cbr_mask = rate_to_mask(priv->baud_rate)) == 0x40)
  372. dbg("%s - failed setting the baud mask (not defined)", __FUNCTION__);
  373. spin_unlock_irqrestore(&priv->lock, flags);
  374. }
  375. }
  376. spin_lock_irqsave(&priv->lock, flags);
  377. ++priv->cmd_count;
  378. spin_unlock_irqrestore(&priv->lock, flags);
  379. return retval;
  380. } /* cypress_serial_control */
  381. static void cypress_set_dead(struct usb_serial_port *port)
  382. {
  383. struct cypress_private *priv = usb_get_serial_port_data(port);
  384. unsigned long flags;
  385. spin_lock_irqsave(&priv->lock, flags);
  386. if (!priv->comm_is_ok) {
  387. spin_unlock_irqrestore(&priv->lock, flags);
  388. return;
  389. }
  390. priv->comm_is_ok = 0;
  391. spin_unlock_irqrestore(&priv->lock, flags);
  392. err("cypress_m8 suspending failing port %d - interval might be too short",
  393. port->number);
  394. }
  395. /* given a baud mask, it will return integer baud on success */
  396. static int mask_to_rate (unsigned mask)
  397. {
  398. int rate;
  399. switch (mask) {
  400. case B0: rate = 0; break;
  401. case B300: rate = 300; break;
  402. case B600: rate = 600; break;
  403. case B1200: rate = 1200; break;
  404. case B2400: rate = 2400; break;
  405. case B4800: rate = 4800; break;
  406. case B9600: rate = 9600; break;
  407. case B19200: rate = 19200; break;
  408. case B38400: rate = 38400; break;
  409. case B57600: rate = 57600; break;
  410. case B115200: rate = 115200; break;
  411. default: rate = -1;
  412. }
  413. return rate;
  414. }
  415. static unsigned rate_to_mask (int rate)
  416. {
  417. unsigned mask;
  418. switch (rate) {
  419. case 0: mask = B0; break;
  420. case 300: mask = B300; break;
  421. case 600: mask = B600; break;
  422. case 1200: mask = B1200; break;
  423. case 2400: mask = B2400; break;
  424. case 4800: mask = B4800; break;
  425. case 9600: mask = B9600; break;
  426. case 19200: mask = B19200; break;
  427. case 38400: mask = B38400; break;
  428. case 57600: mask = B57600; break;
  429. case 115200: mask = B115200; break;
  430. default: mask = 0x40;
  431. }
  432. return mask;
  433. }
  434. /*****************************************************************************
  435. * Cypress serial driver functions
  436. *****************************************************************************/
  437. static int generic_startup (struct usb_serial *serial)
  438. {
  439. struct cypress_private *priv;
  440. struct usb_serial_port *port = serial->port[0];
  441. dbg("%s - port %d", __FUNCTION__, port->number);
  442. priv = kzalloc(sizeof (struct cypress_private), GFP_KERNEL);
  443. if (!priv)
  444. return -ENOMEM;
  445. priv->comm_is_ok = !0;
  446. spin_lock_init(&priv->lock);
  447. priv->buf = cypress_buf_alloc(CYPRESS_BUF_SIZE);
  448. if (priv->buf == NULL) {
  449. kfree(priv);
  450. return -ENOMEM;
  451. }
  452. init_waitqueue_head(&priv->delta_msr_wait);
  453. usb_reset_configuration (serial->dev);
  454. priv->cmd_ctrl = 0;
  455. priv->line_control = 0;
  456. priv->termios_initialized = 0;
  457. priv->rx_flags = 0;
  458. priv->cbr_mask = B300;
  459. if (interval > 0) {
  460. priv->write_urb_interval = interval;
  461. priv->read_urb_interval = interval;
  462. dbg("%s - port %d read & write intervals forced to %d",
  463. __FUNCTION__,port->number,interval);
  464. } else {
  465. priv->write_urb_interval = port->interrupt_out_urb->interval;
  466. priv->read_urb_interval = port->interrupt_in_urb->interval;
  467. dbg("%s - port %d intervals: read=%d write=%d",
  468. __FUNCTION__,port->number,
  469. priv->read_urb_interval,priv->write_urb_interval);
  470. }
  471. usb_set_serial_port_data(port, priv);
  472. return 0;
  473. }
  474. static int cypress_earthmate_startup (struct usb_serial *serial)
  475. {
  476. struct cypress_private *priv;
  477. dbg("%s", __FUNCTION__);
  478. if (generic_startup(serial)) {
  479. dbg("%s - Failed setting up port %d", __FUNCTION__,
  480. serial->port[0]->number);
  481. return 1;
  482. }
  483. priv = usb_get_serial_port_data(serial->port[0]);
  484. priv->chiptype = CT_EARTHMATE;
  485. return 0;
  486. } /* cypress_earthmate_startup */
  487. static int cypress_hidcom_startup (struct usb_serial *serial)
  488. {
  489. struct cypress_private *priv;
  490. dbg("%s", __FUNCTION__);
  491. if (generic_startup(serial)) {
  492. dbg("%s - Failed setting up port %d", __FUNCTION__,
  493. serial->port[0]->number);
  494. return 1;
  495. }
  496. priv = usb_get_serial_port_data(serial->port[0]);
  497. priv->chiptype = CT_CYPHIDCOM;
  498. return 0;
  499. } /* cypress_hidcom_startup */
  500. static int cypress_ca42v2_startup (struct usb_serial *serial)
  501. {
  502. struct cypress_private *priv;
  503. dbg("%s", __FUNCTION__);
  504. if (generic_startup(serial)) {
  505. dbg("%s - Failed setting up port %d", __FUNCTION__,
  506. serial->port[0]->number);
  507. return 1;
  508. }
  509. priv = usb_get_serial_port_data(serial->port[0]);
  510. priv->chiptype = CT_CA42V2;
  511. return 0;
  512. } /* cypress_ca42v2_startup */
  513. static void cypress_shutdown (struct usb_serial *serial)
  514. {
  515. struct cypress_private *priv;
  516. dbg ("%s - port %d", __FUNCTION__, serial->port[0]->number);
  517. /* all open ports are closed at this point */
  518. priv = usb_get_serial_port_data(serial->port[0]);
  519. if (priv) {
  520. cypress_buf_free(priv->buf);
  521. kfree(priv);
  522. usb_set_serial_port_data(serial->port[0], NULL);
  523. }
  524. }
  525. static int cypress_open (struct usb_serial_port *port, struct file *filp)
  526. {
  527. struct cypress_private *priv = usb_get_serial_port_data(port);
  528. struct usb_serial *serial = port->serial;
  529. unsigned long flags;
  530. int result = 0;
  531. dbg("%s - port %d", __FUNCTION__, port->number);
  532. if (!priv->comm_is_ok)
  533. return -EIO;
  534. /* clear halts before open */
  535. usb_clear_halt(serial->dev, 0x81);
  536. usb_clear_halt(serial->dev, 0x02);
  537. spin_lock_irqsave(&priv->lock, flags);
  538. /* reset read/write statistics */
  539. priv->bytes_in = 0;
  540. priv->bytes_out = 0;
  541. priv->cmd_count = 0;
  542. priv->rx_flags = 0;
  543. spin_unlock_irqrestore(&priv->lock, flags);
  544. /* setting to zero could cause data loss */
  545. port->tty->low_latency = 1;
  546. /* raise both lines and set termios */
  547. spin_lock_irqsave(&priv->lock, flags);
  548. priv->line_control = CONTROL_DTR | CONTROL_RTS;
  549. priv->cmd_ctrl = 1;
  550. spin_unlock_irqrestore(&priv->lock, flags);
  551. result = cypress_write(port, NULL, 0);
  552. if (result) {
  553. dev_err(&port->dev, "%s - failed setting the control lines - error %d\n", __FUNCTION__, result);
  554. return result;
  555. } else
  556. dbg("%s - success setting the control lines", __FUNCTION__);
  557. cypress_set_termios(port, &priv->tmp_termios);
  558. /* setup the port and start reading from the device */
  559. if(!port->interrupt_in_urb){
  560. err("%s - interrupt_in_urb is empty!", __FUNCTION__);
  561. return(-1);
  562. }
  563. usb_fill_int_urb(port->interrupt_in_urb, serial->dev,
  564. usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress),
  565. port->interrupt_in_urb->transfer_buffer, port->interrupt_in_urb->transfer_buffer_length,
  566. cypress_read_int_callback, port, priv->read_urb_interval);
  567. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  568. if (result){
  569. dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __FUNCTION__, result);
  570. cypress_set_dead(port);
  571. }
  572. return result;
  573. } /* cypress_open */
  574. static void cypress_close(struct usb_serial_port *port, struct file * filp)
  575. {
  576. struct cypress_private *priv = usb_get_serial_port_data(port);
  577. unsigned int c_cflag;
  578. unsigned long flags;
  579. int bps;
  580. long timeout;
  581. wait_queue_t wait;
  582. dbg("%s - port %d", __FUNCTION__, port->number);
  583. /* wait for data to drain from buffer */
  584. spin_lock_irqsave(&priv->lock, flags);
  585. timeout = CYPRESS_CLOSING_WAIT;
  586. init_waitqueue_entry(&wait, current);
  587. add_wait_queue(&port->tty->write_wait, &wait);
  588. for (;;) {
  589. set_current_state(TASK_INTERRUPTIBLE);
  590. if (cypress_buf_data_avail(priv->buf) == 0
  591. || timeout == 0 || signal_pending(current)
  592. || !usb_get_intfdata(port->serial->interface))
  593. break;
  594. spin_unlock_irqrestore(&priv->lock, flags);
  595. timeout = schedule_timeout(timeout);
  596. spin_lock_irqsave(&priv->lock, flags);
  597. }
  598. set_current_state(TASK_RUNNING);
  599. remove_wait_queue(&port->tty->write_wait, &wait);
  600. /* clear out any remaining data in the buffer */
  601. cypress_buf_clear(priv->buf);
  602. spin_unlock_irqrestore(&priv->lock, flags);
  603. /* wait for characters to drain from device */
  604. bps = tty_get_baud_rate(port->tty);
  605. if (bps > 1200)
  606. timeout = max((HZ*2560)/bps,HZ/10);
  607. else
  608. timeout = 2*HZ;
  609. schedule_timeout_interruptible(timeout);
  610. dbg("%s - stopping urbs", __FUNCTION__);
  611. usb_kill_urb (port->interrupt_in_urb);
  612. usb_kill_urb (port->interrupt_out_urb);
  613. if (port->tty) {
  614. c_cflag = port->tty->termios->c_cflag;
  615. if (c_cflag & HUPCL) {
  616. /* drop dtr and rts */
  617. priv = usb_get_serial_port_data(port);
  618. spin_lock_irqsave(&priv->lock, flags);
  619. priv->line_control = 0;
  620. priv->cmd_ctrl = 1;
  621. spin_unlock_irqrestore(&priv->lock, flags);
  622. cypress_write(port, NULL, 0);
  623. }
  624. }
  625. if (stats)
  626. dev_info (&port->dev, "Statistics: %d Bytes In | %d Bytes Out | %d Commands Issued\n",
  627. priv->bytes_in, priv->bytes_out, priv->cmd_count);
  628. } /* cypress_close */
  629. static int cypress_write(struct usb_serial_port *port, const unsigned char *buf, int count)
  630. {
  631. struct cypress_private *priv = usb_get_serial_port_data(port);
  632. unsigned long flags;
  633. dbg("%s - port %d, %d bytes", __FUNCTION__, port->number, count);
  634. /* line control commands, which need to be executed immediately,
  635. are not put into the buffer for obvious reasons.
  636. */
  637. if (priv->cmd_ctrl) {
  638. count = 0;
  639. goto finish;
  640. }
  641. if (!count)
  642. return count;
  643. spin_lock_irqsave(&priv->lock, flags);
  644. count = cypress_buf_put(priv->buf, buf, count);
  645. spin_unlock_irqrestore(&priv->lock, flags);
  646. finish:
  647. cypress_send(port);
  648. return count;
  649. } /* cypress_write */
  650. static void cypress_send(struct usb_serial_port *port)
  651. {
  652. int count = 0, result, offset, actual_size;
  653. struct cypress_private *priv = usb_get_serial_port_data(port);
  654. unsigned long flags;
  655. if (!priv->comm_is_ok)
  656. return;
  657. dbg("%s - port %d", __FUNCTION__, port->number);
  658. dbg("%s - interrupt out size is %d", __FUNCTION__, port->interrupt_out_size);
  659. spin_lock_irqsave(&priv->lock, flags);
  660. if (priv->write_urb_in_use) {
  661. dbg("%s - can't write, urb in use", __FUNCTION__);
  662. spin_unlock_irqrestore(&priv->lock, flags);
  663. return;
  664. }
  665. spin_unlock_irqrestore(&priv->lock, flags);
  666. /* clear buffer */
  667. memset(port->interrupt_out_urb->transfer_buffer, 0, port->interrupt_out_size);
  668. spin_lock_irqsave(&priv->lock, flags);
  669. switch (port->interrupt_out_size) {
  670. case 32:
  671. /* this is for the CY7C64013... */
  672. offset = 2;
  673. port->interrupt_out_buffer[0] = priv->line_control;
  674. break;
  675. case 8:
  676. /* this is for the CY7C63743... */
  677. offset = 1;
  678. port->interrupt_out_buffer[0] = priv->line_control;
  679. break;
  680. default:
  681. dbg("%s - wrong packet size", __FUNCTION__);
  682. spin_unlock_irqrestore(&priv->lock, flags);
  683. return;
  684. }
  685. if (priv->line_control & CONTROL_RESET)
  686. priv->line_control &= ~CONTROL_RESET;
  687. if (priv->cmd_ctrl) {
  688. priv->cmd_count++;
  689. dbg("%s - line control command being issued", __FUNCTION__);
  690. spin_unlock_irqrestore(&priv->lock, flags);
  691. goto send;
  692. } else
  693. spin_unlock_irqrestore(&priv->lock, flags);
  694. count = cypress_buf_get(priv->buf, &port->interrupt_out_buffer[offset],
  695. port->interrupt_out_size-offset);
  696. if (count == 0) {
  697. return;
  698. }
  699. switch (port->interrupt_out_size) {
  700. case 32:
  701. port->interrupt_out_buffer[1] = count;
  702. break;
  703. case 8:
  704. port->interrupt_out_buffer[0] |= count;
  705. }
  706. dbg("%s - count is %d", __FUNCTION__, count);
  707. send:
  708. spin_lock_irqsave(&priv->lock, flags);
  709. priv->write_urb_in_use = 1;
  710. spin_unlock_irqrestore(&priv->lock, flags);
  711. if (priv->cmd_ctrl)
  712. actual_size = 1;
  713. else
  714. actual_size = count + (port->interrupt_out_size == 32 ? 2 : 1);
  715. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, port->interrupt_out_size,
  716. port->interrupt_out_urb->transfer_buffer);
  717. usb_fill_int_urb(port->interrupt_out_urb, port->serial->dev,
  718. usb_sndintpipe(port->serial->dev, port->interrupt_out_endpointAddress),
  719. port->interrupt_out_buffer, port->interrupt_out_size,
  720. cypress_write_int_callback, port, priv->write_urb_interval);
  721. result = usb_submit_urb (port->interrupt_out_urb, GFP_ATOMIC);
  722. if (result) {
  723. dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__,
  724. result);
  725. priv->write_urb_in_use = 0;
  726. cypress_set_dead(port);
  727. }
  728. spin_lock_irqsave(&priv->lock, flags);
  729. if (priv->cmd_ctrl) {
  730. priv->cmd_ctrl = 0;
  731. }
  732. priv->bytes_out += count; /* do not count the line control and size bytes */
  733. spin_unlock_irqrestore(&priv->lock, flags);
  734. usb_serial_port_softint(port);
  735. } /* cypress_send */
  736. /* returns how much space is available in the soft buffer */
  737. static int cypress_write_room(struct usb_serial_port *port)
  738. {
  739. struct cypress_private *priv = usb_get_serial_port_data(port);
  740. int room = 0;
  741. unsigned long flags;
  742. dbg("%s - port %d", __FUNCTION__, port->number);
  743. spin_lock_irqsave(&priv->lock, flags);
  744. room = cypress_buf_space_avail(priv->buf);
  745. spin_unlock_irqrestore(&priv->lock, flags);
  746. dbg("%s - returns %d", __FUNCTION__, room);
  747. return room;
  748. }
  749. static int cypress_tiocmget (struct usb_serial_port *port, struct file *file)
  750. {
  751. struct cypress_private *priv = usb_get_serial_port_data(port);
  752. __u8 status, control;
  753. unsigned int result = 0;
  754. unsigned long flags;
  755. dbg("%s - port %d", __FUNCTION__, port->number);
  756. spin_lock_irqsave(&priv->lock, flags);
  757. control = priv->line_control;
  758. status = priv->current_status;
  759. spin_unlock_irqrestore(&priv->lock, flags);
  760. result = ((control & CONTROL_DTR) ? TIOCM_DTR : 0)
  761. | ((control & CONTROL_RTS) ? TIOCM_RTS : 0)
  762. | ((status & UART_CTS) ? TIOCM_CTS : 0)
  763. | ((status & UART_DSR) ? TIOCM_DSR : 0)
  764. | ((status & UART_RI) ? TIOCM_RI : 0)
  765. | ((status & UART_CD) ? TIOCM_CD : 0);
  766. dbg("%s - result = %x", __FUNCTION__, result);
  767. return result;
  768. }
  769. static int cypress_tiocmset (struct usb_serial_port *port, struct file *file,
  770. unsigned int set, unsigned int clear)
  771. {
  772. struct cypress_private *priv = usb_get_serial_port_data(port);
  773. unsigned long flags;
  774. dbg("%s - port %d", __FUNCTION__, port->number);
  775. spin_lock_irqsave(&priv->lock, flags);
  776. if (set & TIOCM_RTS)
  777. priv->line_control |= CONTROL_RTS;
  778. if (set & TIOCM_DTR)
  779. priv->line_control |= CONTROL_DTR;
  780. if (clear & TIOCM_RTS)
  781. priv->line_control &= ~CONTROL_RTS;
  782. if (clear & TIOCM_DTR)
  783. priv->line_control &= ~CONTROL_DTR;
  784. spin_unlock_irqrestore(&priv->lock, flags);
  785. priv->cmd_ctrl = 1;
  786. return cypress_write(port, NULL, 0);
  787. }
  788. static int cypress_ioctl (struct usb_serial_port *port, struct file * file, unsigned int cmd, unsigned long arg)
  789. {
  790. struct cypress_private *priv = usb_get_serial_port_data(port);
  791. dbg("%s - port %d, cmd 0x%.4x", __FUNCTION__, port->number, cmd);
  792. switch (cmd) {
  793. case TIOCGSERIAL:
  794. if (copy_to_user((void __user *)arg, port->tty->termios, sizeof(struct termios))) {
  795. return -EFAULT;
  796. }
  797. return (0);
  798. break;
  799. case TIOCSSERIAL:
  800. if (copy_from_user(port->tty->termios, (void __user *)arg, sizeof(struct termios))) {
  801. return -EFAULT;
  802. }
  803. /* here we need to call cypress_set_termios to invoke the new settings */
  804. cypress_set_termios(port, &priv->tmp_termios);
  805. return (0);
  806. break;
  807. /* these are called when setting baud rate from gpsd */
  808. case TCGETS:
  809. if (copy_to_user((void __user *)arg, port->tty->termios, sizeof(struct termios))) {
  810. return -EFAULT;
  811. }
  812. return (0);
  813. break;
  814. case TCSETS:
  815. if (copy_from_user(port->tty->termios, (void __user *)arg, sizeof(struct termios))) {
  816. return -EFAULT;
  817. }
  818. /* here we need to call cypress_set_termios to invoke the new settings */
  819. cypress_set_termios(port, &priv->tmp_termios);
  820. return (0);
  821. break;
  822. /* This code comes from drivers/char/serial.c and ftdi_sio.c */
  823. case TIOCMIWAIT:
  824. while (priv != NULL) {
  825. interruptible_sleep_on(&priv->delta_msr_wait);
  826. /* see if a signal did it */
  827. if (signal_pending(current))
  828. return -ERESTARTSYS;
  829. else {
  830. char diff = priv->diff_status;
  831. if (diff == 0) {
  832. return -EIO; /* no change => error */
  833. }
  834. /* consume all events */
  835. priv->diff_status = 0;
  836. /* return 0 if caller wanted to know about these bits */
  837. if ( ((arg & TIOCM_RNG) && (diff & UART_RI)) ||
  838. ((arg & TIOCM_DSR) && (diff & UART_DSR)) ||
  839. ((arg & TIOCM_CD) && (diff & UART_CD)) ||
  840. ((arg & TIOCM_CTS) && (diff & UART_CTS)) ) {
  841. return 0;
  842. }
  843. /* otherwise caller can't care less about what happened,
  844. * and so we continue to wait for more events.
  845. */
  846. }
  847. }
  848. return 0;
  849. break;
  850. default:
  851. break;
  852. }
  853. dbg("%s - arg not supported - it was 0x%04x - check include/asm/ioctls.h", __FUNCTION__, cmd);
  854. return -ENOIOCTLCMD;
  855. } /* cypress_ioctl */
  856. static void cypress_set_termios (struct usb_serial_port *port,
  857. struct termios *old_termios)
  858. {
  859. struct cypress_private *priv = usb_get_serial_port_data(port);
  860. struct tty_struct *tty;
  861. int data_bits, stop_bits, parity_type, parity_enable;
  862. unsigned cflag, iflag, baud_mask;
  863. unsigned long flags;
  864. __u8 oldlines;
  865. int linechange = 0;
  866. dbg("%s - port %d", __FUNCTION__, port->number);
  867. tty = port->tty;
  868. if ((!tty) || (!tty->termios)) {
  869. dbg("%s - no tty structures", __FUNCTION__);
  870. return;
  871. }
  872. spin_lock_irqsave(&priv->lock, flags);
  873. if (!priv->termios_initialized) {
  874. if (priv->chiptype == CT_EARTHMATE) {
  875. *(tty->termios) = tty_std_termios;
  876. tty->termios->c_cflag = B4800 | CS8 | CREAD | HUPCL |
  877. CLOCAL;
  878. } else if (priv->chiptype == CT_CYPHIDCOM) {
  879. *(tty->termios) = tty_std_termios;
  880. tty->termios->c_cflag = B9600 | CS8 | CREAD | HUPCL |
  881. CLOCAL;
  882. } else if (priv->chiptype == CT_CA42V2) {
  883. *(tty->termios) = tty_std_termios;
  884. tty->termios->c_cflag = B9600 | CS8 | CREAD | HUPCL |
  885. CLOCAL;
  886. }
  887. priv->termios_initialized = 1;
  888. }
  889. spin_unlock_irqrestore(&priv->lock, flags);
  890. cflag = tty->termios->c_cflag;
  891. iflag = tty->termios->c_iflag;
  892. /* check if there are new settings */
  893. if (old_termios) {
  894. if ((cflag != old_termios->c_cflag) ||
  895. (RELEVANT_IFLAG(iflag) !=
  896. RELEVANT_IFLAG(old_termios->c_iflag))) {
  897. dbg("%s - attempting to set new termios settings",
  898. __FUNCTION__);
  899. /* should make a copy of this in case something goes
  900. * wrong in the function, we can restore it */
  901. spin_lock_irqsave(&priv->lock, flags);
  902. priv->tmp_termios = *(tty->termios);
  903. spin_unlock_irqrestore(&priv->lock, flags);
  904. } else {
  905. dbg("%s - nothing to do, exiting", __FUNCTION__);
  906. return;
  907. }
  908. } else
  909. return;
  910. /* set number of data bits, parity, stop bits */
  911. /* when parity is disabled the parity type bit is ignored */
  912. /* 1 means 2 stop bits, 0 means 1 stop bit */
  913. stop_bits = cflag & CSTOPB ? 1 : 0;
  914. if (cflag & PARENB) {
  915. parity_enable = 1;
  916. /* 1 means odd parity, 0 means even parity */
  917. parity_type = cflag & PARODD ? 1 : 0;
  918. } else
  919. parity_enable = parity_type = 0;
  920. if (cflag & CSIZE) {
  921. switch (cflag & CSIZE) {
  922. case CS5:
  923. data_bits = 0;
  924. break;
  925. case CS6:
  926. data_bits = 1;
  927. break;
  928. case CS7:
  929. data_bits = 2;
  930. break;
  931. case CS8:
  932. data_bits = 3;
  933. break;
  934. default:
  935. err("%s - CSIZE was set, but not CS5-CS8",
  936. __FUNCTION__);
  937. data_bits = 3;
  938. }
  939. } else
  940. data_bits = 3;
  941. spin_lock_irqsave(&priv->lock, flags);
  942. oldlines = priv->line_control;
  943. if ((cflag & CBAUD) == B0) {
  944. /* drop dtr and rts */
  945. dbg("%s - dropping the lines, baud rate 0bps", __FUNCTION__);
  946. baud_mask = B0;
  947. priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
  948. } else {
  949. baud_mask = (cflag & CBAUD);
  950. switch(baud_mask) {
  951. case B300:
  952. dbg("%s - setting baud 300bps", __FUNCTION__);
  953. break;
  954. case B600:
  955. dbg("%s - setting baud 600bps", __FUNCTION__);
  956. break;
  957. case B1200:
  958. dbg("%s - setting baud 1200bps", __FUNCTION__);
  959. break;
  960. case B2400:
  961. dbg("%s - setting baud 2400bps", __FUNCTION__);
  962. break;
  963. case B4800:
  964. dbg("%s - setting baud 4800bps", __FUNCTION__);
  965. break;
  966. case B9600:
  967. dbg("%s - setting baud 9600bps", __FUNCTION__);
  968. break;
  969. case B19200:
  970. dbg("%s - setting baud 19200bps", __FUNCTION__);
  971. break;
  972. case B38400:
  973. dbg("%s - setting baud 38400bps", __FUNCTION__);
  974. break;
  975. case B57600:
  976. dbg("%s - setting baud 57600bps", __FUNCTION__);
  977. break;
  978. case B115200:
  979. dbg("%s - setting baud 115200bps", __FUNCTION__);
  980. break;
  981. default:
  982. dbg("%s - unknown masked baud rate", __FUNCTION__);
  983. }
  984. priv->line_control = (CONTROL_DTR | CONTROL_RTS);
  985. }
  986. spin_unlock_irqrestore(&priv->lock, flags);
  987. dbg("%s - sending %d stop_bits, %d parity_enable, %d parity_type, "
  988. "%d data_bits (+5)", __FUNCTION__, stop_bits,
  989. parity_enable, parity_type, data_bits);
  990. cypress_serial_control(port, baud_mask, data_bits, stop_bits,
  991. parity_enable, parity_type, 0, CYPRESS_SET_CONFIG);
  992. /* we perform a CYPRESS_GET_CONFIG so that the current settings are
  993. * filled into the private structure this should confirm that all is
  994. * working if it returns what we just set */
  995. cypress_serial_control(port, 0, 0, 0, 0, 0, 0, CYPRESS_GET_CONFIG);
  996. /* Here we can define custom tty settings for devices; the main tty
  997. * termios flag base comes from empeg.c */
  998. spin_lock_irqsave(&priv->lock, flags);
  999. if ( (priv->chiptype == CT_EARTHMATE) && (priv->baud_rate == 4800) ) {
  1000. dbg("Using custom termios settings for a baud rate of "
  1001. "4800bps.");
  1002. /* define custom termios settings for NMEA protocol */
  1003. tty->termios->c_iflag /* input modes - */
  1004. &= ~(IGNBRK /* disable ignore break */
  1005. | BRKINT /* disable break causes interrupt */
  1006. | PARMRK /* disable mark parity errors */
  1007. | ISTRIP /* disable clear high bit of input char */
  1008. | INLCR /* disable translate NL to CR */
  1009. | IGNCR /* disable ignore CR */
  1010. | ICRNL /* disable translate CR to NL */
  1011. | IXON); /* disable enable XON/XOFF flow control */
  1012. tty->termios->c_oflag /* output modes */
  1013. &= ~OPOST; /* disable postprocess output char */
  1014. tty->termios->c_lflag /* line discipline modes */
  1015. &= ~(ECHO /* disable echo input characters */
  1016. | ECHONL /* disable echo new line */
  1017. | ICANON /* disable erase, kill, werase, and rprnt
  1018. special characters */
  1019. | ISIG /* disable interrupt, quit, and suspend
  1020. special characters */
  1021. | IEXTEN); /* disable non-POSIX special characters */
  1022. } /* CT_CYPHIDCOM: Application should handle this for device */
  1023. linechange = (priv->line_control != oldlines);
  1024. spin_unlock_irqrestore(&priv->lock, flags);
  1025. /* if necessary, set lines */
  1026. if (linechange) {
  1027. priv->cmd_ctrl = 1;
  1028. cypress_write(port, NULL, 0);
  1029. }
  1030. } /* cypress_set_termios */
  1031. /* returns amount of data still left in soft buffer */
  1032. static int cypress_chars_in_buffer(struct usb_serial_port *port)
  1033. {
  1034. struct cypress_private *priv = usb_get_serial_port_data(port);
  1035. int chars = 0;
  1036. unsigned long flags;
  1037. dbg("%s - port %d", __FUNCTION__, port->number);
  1038. spin_lock_irqsave(&priv->lock, flags);
  1039. chars = cypress_buf_data_avail(priv->buf);
  1040. spin_unlock_irqrestore(&priv->lock, flags);
  1041. dbg("%s - returns %d", __FUNCTION__, chars);
  1042. return chars;
  1043. }
  1044. static void cypress_throttle (struct usb_serial_port *port)
  1045. {
  1046. struct cypress_private *priv = usb_get_serial_port_data(port);
  1047. unsigned long flags;
  1048. dbg("%s - port %d", __FUNCTION__, port->number);
  1049. spin_lock_irqsave(&priv->lock, flags);
  1050. priv->rx_flags = THROTTLED;
  1051. spin_unlock_irqrestore(&priv->lock, flags);
  1052. }
  1053. static void cypress_unthrottle (struct usb_serial_port *port)
  1054. {
  1055. struct cypress_private *priv = usb_get_serial_port_data(port);
  1056. int actually_throttled, result;
  1057. unsigned long flags;
  1058. dbg("%s - port %d", __FUNCTION__, port->number);
  1059. spin_lock_irqsave(&priv->lock, flags);
  1060. actually_throttled = priv->rx_flags & ACTUALLY_THROTTLED;
  1061. priv->rx_flags = 0;
  1062. spin_unlock_irqrestore(&priv->lock, flags);
  1063. if (!priv->comm_is_ok)
  1064. return;
  1065. if (actually_throttled) {
  1066. port->interrupt_in_urb->dev = port->serial->dev;
  1067. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  1068. if (result) {
  1069. dev_err(&port->dev, "%s - failed submitting read urb, "
  1070. "error %d\n", __FUNCTION__, result);
  1071. cypress_set_dead(port);
  1072. }
  1073. }
  1074. }
  1075. static void cypress_read_int_callback(struct urb *urb)
  1076. {
  1077. struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
  1078. struct cypress_private *priv = usb_get_serial_port_data(port);
  1079. struct tty_struct *tty;
  1080. unsigned char *data = urb->transfer_buffer;
  1081. unsigned long flags;
  1082. char tty_flag = TTY_NORMAL;
  1083. int havedata = 0;
  1084. int bytes = 0;
  1085. int result;
  1086. int i = 0;
  1087. dbg("%s - port %d", __FUNCTION__, port->number);
  1088. switch (urb->status) {
  1089. case 0: /* success */
  1090. break;
  1091. case -ECONNRESET:
  1092. case -ENOENT:
  1093. case -ESHUTDOWN:
  1094. /* precursor to disconnect so just go away */
  1095. return;
  1096. case -EPIPE:
  1097. usb_clear_halt(port->serial->dev,0x81);
  1098. break;
  1099. default:
  1100. /* something ugly is going on... */
  1101. dev_err(&urb->dev->dev,"%s - unexpected nonzero read status received: %d\n",
  1102. __FUNCTION__,urb->status);
  1103. cypress_set_dead(port);
  1104. return;
  1105. }
  1106. spin_lock_irqsave(&priv->lock, flags);
  1107. if (priv->rx_flags & THROTTLED) {
  1108. dbg("%s - now throttling", __FUNCTION__);
  1109. priv->rx_flags |= ACTUALLY_THROTTLED;
  1110. spin_unlock_irqrestore(&priv->lock, flags);
  1111. return;
  1112. }
  1113. spin_unlock_irqrestore(&priv->lock, flags);
  1114. tty = port->tty;
  1115. if (!tty) {
  1116. dbg("%s - bad tty pointer - exiting", __FUNCTION__);
  1117. return;
  1118. }
  1119. spin_lock_irqsave(&priv->lock, flags);
  1120. switch(urb->actual_length) {
  1121. case 32:
  1122. /* This is for the CY7C64013... */
  1123. priv->current_status = data[0] & 0xF8;
  1124. bytes = data[1] + 2;
  1125. i = 2;
  1126. if (bytes > 2)
  1127. havedata = 1;
  1128. break;
  1129. case 8:
  1130. /* This is for the CY7C63743... */
  1131. priv->current_status = data[0] & 0xF8;
  1132. bytes = (data[0] & 0x07) + 1;
  1133. i = 1;
  1134. if (bytes > 1)
  1135. havedata = 1;
  1136. break;
  1137. default:
  1138. dbg("%s - wrong packet size - received %d bytes",
  1139. __FUNCTION__, urb->actual_length);
  1140. spin_unlock_irqrestore(&priv->lock, flags);
  1141. goto continue_read;
  1142. }
  1143. spin_unlock_irqrestore(&priv->lock, flags);
  1144. usb_serial_debug_data (debug, &port->dev, __FUNCTION__,
  1145. urb->actual_length, data);
  1146. spin_lock_irqsave(&priv->lock, flags);
  1147. /* check to see if status has changed */
  1148. if (priv != NULL) {
  1149. if (priv->current_status != priv->prev_status) {
  1150. priv->diff_status |= priv->current_status ^
  1151. priv->prev_status;
  1152. wake_up_interruptible(&priv->delta_msr_wait);
  1153. priv->prev_status = priv->current_status;
  1154. }
  1155. }
  1156. spin_unlock_irqrestore(&priv->lock, flags);
  1157. /* hangup, as defined in acm.c... this might be a bad place for it
  1158. * though */
  1159. if (tty && !(tty->termios->c_cflag & CLOCAL) &&
  1160. !(priv->current_status & UART_CD)) {
  1161. dbg("%s - calling hangup", __FUNCTION__);
  1162. tty_hangup(tty);
  1163. goto continue_read;
  1164. }
  1165. /* There is one error bit... I'm assuming it is a parity error
  1166. * indicator as the generic firmware will set this bit to 1 if a
  1167. * parity error occurs.
  1168. * I can not find reference to any other error events. */
  1169. spin_lock_irqsave(&priv->lock, flags);
  1170. if (priv->current_status & CYP_ERROR) {
  1171. spin_unlock_irqrestore(&priv->lock, flags);
  1172. tty_flag = TTY_PARITY;
  1173. dbg("%s - Parity Error detected", __FUNCTION__);
  1174. } else
  1175. spin_unlock_irqrestore(&priv->lock, flags);
  1176. /* process read if there is data other than line status */
  1177. if (tty && (bytes > i)) {
  1178. bytes = tty_buffer_request_room(tty, bytes);
  1179. for (; i < bytes ; ++i) {
  1180. dbg("pushing byte number %d - %d - %c", i, data[i],
  1181. data[i]);
  1182. tty_insert_flip_char(tty, data[i], tty_flag);
  1183. }
  1184. tty_flip_buffer_push(port->tty);
  1185. }
  1186. spin_lock_irqsave(&priv->lock, flags);
  1187. /* control and status byte(s) are also counted */
  1188. priv->bytes_in += bytes;
  1189. spin_unlock_irqrestore(&priv->lock, flags);
  1190. continue_read:
  1191. /* Continue trying to always read... unless the port has closed. */
  1192. if (port->open_count > 0 && priv->comm_is_ok) {
  1193. usb_fill_int_urb(port->interrupt_in_urb, port->serial->dev,
  1194. usb_rcvintpipe(port->serial->dev,
  1195. port->interrupt_in_endpointAddress),
  1196. port->interrupt_in_urb->transfer_buffer,
  1197. port->interrupt_in_urb->transfer_buffer_length,
  1198. cypress_read_int_callback, port, priv->read_urb_interval);
  1199. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  1200. if (result) {
  1201. dev_err(&urb->dev->dev, "%s - failed resubmitting "
  1202. "read urb, error %d\n", __FUNCTION__,
  1203. result);
  1204. cypress_set_dead(port);
  1205. }
  1206. }
  1207. return;
  1208. } /* cypress_read_int_callback */
  1209. static void cypress_write_int_callback(struct urb *urb)
  1210. {
  1211. struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
  1212. struct cypress_private *priv = usb_get_serial_port_data(port);
  1213. int result;
  1214. dbg("%s - port %d", __FUNCTION__, port->number);
  1215. switch (urb->status) {
  1216. case 0:
  1217. /* success */
  1218. break;
  1219. case -ECONNRESET:
  1220. case -ENOENT:
  1221. case -ESHUTDOWN:
  1222. /* this urb is terminated, clean up */
  1223. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  1224. priv->write_urb_in_use = 0;
  1225. return;
  1226. case -EPIPE: /* no break needed; clear halt and resubmit */
  1227. if (!priv->comm_is_ok)
  1228. break;
  1229. usb_clear_halt(port->serial->dev, 0x02);
  1230. /* error in the urb, so we have to resubmit it */
  1231. dbg("%s - nonzero write bulk status received: %d", __FUNCTION__, urb->status);
  1232. port->interrupt_out_urb->transfer_buffer_length = 1;
  1233. port->interrupt_out_urb->dev = port->serial->dev;
  1234. result = usb_submit_urb(port->interrupt_out_urb, GFP_ATOMIC);
  1235. if (!result)
  1236. return;
  1237. dev_err(&urb->dev->dev, "%s - failed resubmitting write urb, error %d\n",
  1238. __FUNCTION__, result);
  1239. cypress_set_dead(port);
  1240. break;
  1241. default:
  1242. dev_err(&urb->dev->dev,"%s - unexpected nonzero write status received: %d\n",
  1243. __FUNCTION__,urb->status);
  1244. cypress_set_dead(port);
  1245. break;
  1246. }
  1247. priv->write_urb_in_use = 0;
  1248. /* send any buffered data */
  1249. cypress_send(port);
  1250. }
  1251. /*****************************************************************************
  1252. * Write buffer functions - buffering code from pl2303 used
  1253. *****************************************************************************/
  1254. /*
  1255. * cypress_buf_alloc
  1256. *
  1257. * Allocate a circular buffer and all associated memory.
  1258. */
  1259. static struct cypress_buf *cypress_buf_alloc(unsigned int size)
  1260. {
  1261. struct cypress_buf *cb;
  1262. if (size == 0)
  1263. return NULL;
  1264. cb = (struct cypress_buf *)kmalloc(sizeof(struct cypress_buf), GFP_KERNEL);
  1265. if (cb == NULL)
  1266. return NULL;
  1267. cb->buf_buf = kmalloc(size, GFP_KERNEL);
  1268. if (cb->buf_buf == NULL) {
  1269. kfree(cb);
  1270. return NULL;
  1271. }
  1272. cb->buf_size = size;
  1273. cb->buf_get = cb->buf_put = cb->buf_buf;
  1274. return cb;
  1275. }
  1276. /*
  1277. * cypress_buf_free
  1278. *
  1279. * Free the buffer and all associated memory.
  1280. */
  1281. static void cypress_buf_free(struct cypress_buf *cb)
  1282. {
  1283. if (cb) {
  1284. kfree(cb->buf_buf);
  1285. kfree(cb);
  1286. }
  1287. }
  1288. /*
  1289. * cypress_buf_clear
  1290. *
  1291. * Clear out all data in the circular buffer.
  1292. */
  1293. static void cypress_buf_clear(struct cypress_buf *cb)
  1294. {
  1295. if (cb != NULL)
  1296. cb->buf_get = cb->buf_put;
  1297. /* equivalent to a get of all data available */
  1298. }
  1299. /*
  1300. * cypress_buf_data_avail
  1301. *
  1302. * Return the number of bytes of data available in the circular
  1303. * buffer.
  1304. */
  1305. static unsigned int cypress_buf_data_avail(struct cypress_buf *cb)
  1306. {
  1307. if (cb != NULL)
  1308. return ((cb->buf_size + cb->buf_put - cb->buf_get) % cb->buf_size);
  1309. else
  1310. return 0;
  1311. }
  1312. /*
  1313. * cypress_buf_space_avail
  1314. *
  1315. * Return the number of bytes of space available in the circular
  1316. * buffer.
  1317. */
  1318. static unsigned int cypress_buf_space_avail(struct cypress_buf *cb)
  1319. {
  1320. if (cb != NULL)
  1321. return ((cb->buf_size + cb->buf_get - cb->buf_put - 1) % cb->buf_size);
  1322. else
  1323. return 0;
  1324. }
  1325. /*
  1326. * cypress_buf_put
  1327. *
  1328. * Copy data data from a user buffer and put it into the circular buffer.
  1329. * Restrict to the amount of space available.
  1330. *
  1331. * Return the number of bytes copied.
  1332. */
  1333. static unsigned int cypress_buf_put(struct cypress_buf *cb, const char *buf,
  1334. unsigned int count)
  1335. {
  1336. unsigned int len;
  1337. if (cb == NULL)
  1338. return 0;
  1339. len = cypress_buf_space_avail(cb);
  1340. if (count > len)
  1341. count = len;
  1342. if (count == 0)
  1343. return 0;
  1344. len = cb->buf_buf + cb->buf_size - cb->buf_put;
  1345. if (count > len) {
  1346. memcpy(cb->buf_put, buf, len);
  1347. memcpy(cb->buf_buf, buf+len, count - len);
  1348. cb->buf_put = cb->buf_buf + count - len;
  1349. } else {
  1350. memcpy(cb->buf_put, buf, count);
  1351. if (count < len)
  1352. cb->buf_put += count;
  1353. else /* count == len */
  1354. cb->buf_put = cb->buf_buf;
  1355. }
  1356. return count;
  1357. }
  1358. /*
  1359. * cypress_buf_get
  1360. *
  1361. * Get data from the circular buffer and copy to the given buffer.
  1362. * Restrict to the amount of data available.
  1363. *
  1364. * Return the number of bytes copied.
  1365. */
  1366. static unsigned int cypress_buf_get(struct cypress_buf *cb, char *buf,
  1367. unsigned int count)
  1368. {
  1369. unsigned int len;
  1370. if (cb == NULL)
  1371. return 0;
  1372. len = cypress_buf_data_avail(cb);
  1373. if (count > len)
  1374. count = len;
  1375. if (count == 0)
  1376. return 0;
  1377. len = cb->buf_buf + cb->buf_size - cb->buf_get;
  1378. if (count > len) {
  1379. memcpy(buf, cb->buf_get, len);
  1380. memcpy(buf+len, cb->buf_buf, count - len);
  1381. cb->buf_get = cb->buf_buf + count - len;
  1382. } else {
  1383. memcpy(buf, cb->buf_get, count);
  1384. if (count < len)
  1385. cb->buf_get += count;
  1386. else /* count == len */
  1387. cb->buf_get = cb->buf_buf;
  1388. }
  1389. return count;
  1390. }
  1391. /*****************************************************************************
  1392. * Module functions
  1393. *****************************************************************************/
  1394. static int __init cypress_init(void)
  1395. {
  1396. int retval;
  1397. dbg("%s", __FUNCTION__);
  1398. retval = usb_serial_register(&cypress_earthmate_device);
  1399. if (retval)
  1400. goto failed_em_register;
  1401. retval = usb_serial_register(&cypress_hidcom_device);
  1402. if (retval)
  1403. goto failed_hidcom_register;
  1404. retval = usb_serial_register(&cypress_ca42v2_device);
  1405. if (retval)
  1406. goto failed_ca42v2_register;
  1407. retval = usb_register(&cypress_driver);
  1408. if (retval)
  1409. goto failed_usb_register;
  1410. info(DRIVER_DESC " " DRIVER_VERSION);
  1411. return 0;
  1412. failed_usb_register:
  1413. usb_deregister(&cypress_driver);
  1414. failed_ca42v2_register:
  1415. usb_serial_deregister(&cypress_ca42v2_device);
  1416. failed_hidcom_register:
  1417. usb_serial_deregister(&cypress_hidcom_device);
  1418. failed_em_register:
  1419. usb_serial_deregister(&cypress_earthmate_device);
  1420. return retval;
  1421. }
  1422. static void __exit cypress_exit (void)
  1423. {
  1424. dbg("%s", __FUNCTION__);
  1425. usb_deregister (&cypress_driver);
  1426. usb_serial_deregister (&cypress_earthmate_device);
  1427. usb_serial_deregister (&cypress_hidcom_device);
  1428. usb_serial_deregister (&cypress_ca42v2_device);
  1429. }
  1430. module_init(cypress_init);
  1431. module_exit(cypress_exit);
  1432. MODULE_AUTHOR( DRIVER_AUTHOR );
  1433. MODULE_DESCRIPTION( DRIVER_DESC );
  1434. MODULE_VERSION( DRIVER_VERSION );
  1435. MODULE_LICENSE("GPL");
  1436. module_param(debug, bool, S_IRUGO | S_IWUSR);
  1437. MODULE_PARM_DESC(debug, "Debug enabled or not");
  1438. module_param(stats, bool, S_IRUGO | S_IWUSR);
  1439. MODULE_PARM_DESC(stats, "Enable statistics or not");
  1440. module_param(interval, int, S_IRUGO | S_IWUSR);
  1441. MODULE_PARM_DESC(interval, "Overrides interrupt interval");