sierra.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779
  1. /*
  2. USB Driver for Sierra Wireless
  3. Copyright (C) 2006, 2007, 2008 Kevin Lloyd <linux@sierrawireless.com>
  4. IMPORTANT DISCLAIMER: This driver is not commercially supported by
  5. Sierra Wireless. Use at your own risk.
  6. This driver is free software; you can redistribute it and/or modify
  7. it under the terms of Version 2 of the GNU General Public License as
  8. published by the Free Software Foundation.
  9. Portions based on the option driver by Matthias Urlichs <smurf@smurf.noris.de>
  10. Whom based his on the Keyspan driver by Hugh Blemings <hugh@blemings.org>
  11. */
  12. #define DRIVER_VERSION "v.1.2.8"
  13. #define DRIVER_AUTHOR "Kevin Lloyd <linux@sierrawireless.com>"
  14. #define DRIVER_DESC "USB Driver for Sierra Wireless USB modems"
  15. #include <linux/kernel.h>
  16. #include <linux/jiffies.h>
  17. #include <linux/errno.h>
  18. #include <linux/tty.h>
  19. #include <linux/tty_flip.h>
  20. #include <linux/module.h>
  21. #include <linux/usb.h>
  22. #include <linux/usb/serial.h>
  23. #include <linux/usb/ch9.h>
  24. #define SWIMS_USB_REQUEST_SetPower 0x00
  25. #define SWIMS_USB_REQUEST_SetNmea 0x07
  26. #define SWIMS_USB_REQUEST_SetMode 0x0B
  27. #define SWIMS_USB_REQUEST_TYPE_VSC_SET 0x40
  28. #define SWIMS_SET_MODE_Modem 0x0001
  29. /* per port private data */
  30. #define N_IN_URB 4
  31. #define N_OUT_URB 4
  32. #define IN_BUFLEN 4096
  33. static int debug;
  34. static int nmea;
  35. static int truinstall = 1;
  36. enum devicetype {
  37. DEVICE_3_PORT = 0,
  38. DEVICE_1_PORT = 1,
  39. DEVICE_INSTALLER = 2,
  40. };
  41. static int sierra_set_power_state(struct usb_device *udev, __u16 swiState)
  42. {
  43. int result;
  44. dev_dbg(&udev->dev, "%s", "SET POWER STATE\n");
  45. result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
  46. SWIMS_USB_REQUEST_SetPower, /* __u8 request */
  47. SWIMS_USB_REQUEST_TYPE_VSC_SET, /* __u8 request type */
  48. swiState, /* __u16 value */
  49. 0, /* __u16 index */
  50. NULL, /* void *data */
  51. 0, /* __u16 size */
  52. USB_CTRL_SET_TIMEOUT); /* int timeout */
  53. return result;
  54. }
  55. static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
  56. {
  57. int result;
  58. dev_dbg(&udev->dev, "%s", "DEVICE MODE SWITCH\n");
  59. result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
  60. SWIMS_USB_REQUEST_SetMode, /* __u8 request */
  61. SWIMS_USB_REQUEST_TYPE_VSC_SET, /* __u8 request type */
  62. eSWocMode, /* __u16 value */
  63. 0x0000, /* __u16 index */
  64. NULL, /* void *data */
  65. 0, /* __u16 size */
  66. USB_CTRL_SET_TIMEOUT); /* int timeout */
  67. return result;
  68. }
  69. static int sierra_vsc_set_nmea(struct usb_device *udev, __u16 enable)
  70. {
  71. int result;
  72. dev_dbg(&udev->dev, "%s", "NMEA Enable sent\n");
  73. result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
  74. SWIMS_USB_REQUEST_SetNmea, /* __u8 request */
  75. SWIMS_USB_REQUEST_TYPE_VSC_SET, /* __u8 request type */
  76. enable, /* __u16 value */
  77. 0x0000, /* __u16 index */
  78. NULL, /* void *data */
  79. 0, /* __u16 size */
  80. USB_CTRL_SET_TIMEOUT); /* int timeout */
  81. return result;
  82. }
  83. static int sierra_calc_num_ports(struct usb_serial *serial)
  84. {
  85. int result;
  86. int *num_ports = usb_get_serial_data(serial);
  87. result = *num_ports;
  88. if (result) {
  89. kfree(num_ports);
  90. usb_set_serial_data(serial, NULL);
  91. }
  92. return result;
  93. }
  94. static int sierra_probe(struct usb_serial *serial,
  95. const struct usb_device_id *id)
  96. {
  97. int result = 0;
  98. struct usb_device *udev;
  99. int *num_ports;
  100. u8 ifnum;
  101. num_ports = kmalloc(sizeof(*num_ports), GFP_KERNEL);
  102. if (!num_ports)
  103. return -ENOMEM;
  104. ifnum = serial->interface->cur_altsetting->desc.bInterfaceNumber;
  105. udev = serial->dev;
  106. /* Check if in installer mode */
  107. if (truinstall && id->driver_info == DEVICE_INSTALLER) {
  108. dev_dbg(&udev->dev, "%s", "FOUND TRU-INSTALL DEVICE(SW)\n");
  109. result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
  110. /* Don't bind to the device when in installer mode */
  111. kfree(num_ports);
  112. return -EIO;
  113. } else if (id->driver_info == DEVICE_1_PORT)
  114. *num_ports = 1;
  115. else if (ifnum == 0x99)
  116. *num_ports = 0;
  117. else
  118. *num_ports = 3;
  119. /*
  120. * save off our num_ports info so that we can use it in the
  121. * calc_num_ports callback
  122. */
  123. usb_set_serial_data(serial, (void *)num_ports);
  124. return result;
  125. }
  126. static struct usb_device_id id_table [] = {
  127. { USB_DEVICE(0x1199, 0x0017) }, /* Sierra Wireless EM5625 */
  128. { USB_DEVICE(0x1199, 0x0018) }, /* Sierra Wireless MC5720 */
  129. { USB_DEVICE(0x1199, 0x0218) }, /* Sierra Wireless MC5720 */
  130. { USB_DEVICE(0x0f30, 0x1b1d) }, /* Sierra Wireless MC5720 */
  131. { USB_DEVICE(0x1199, 0x0020) }, /* Sierra Wireless MC5725 */
  132. { USB_DEVICE(0x1199, 0x0220) }, /* Sierra Wireless MC5725 */
  133. { USB_DEVICE(0x1199, 0x0019) }, /* Sierra Wireless AirCard 595 */
  134. { USB_DEVICE(0x1199, 0x0021) }, /* Sierra Wireless AirCard 597E */
  135. { USB_DEVICE(0x1199, 0x0120) }, /* Sierra Wireless USB Dongle 595U */
  136. { USB_DEVICE(0x1199, 0x0023) }, /* Sierra Wireless AirCard */
  137. { USB_DEVICE(0x1199, 0x6802) }, /* Sierra Wireless MC8755 */
  138. { USB_DEVICE(0x1199, 0x6804) }, /* Sierra Wireless MC8755 */
  139. { USB_DEVICE(0x1199, 0x6803) }, /* Sierra Wireless MC8765 */
  140. { USB_DEVICE(0x1199, 0x6812) }, /* Sierra Wireless MC8775 & AC 875U */
  141. { USB_DEVICE(0x1199, 0x6813) }, /* Sierra Wireless MC8775 (Thinkpad internal) */
  142. { USB_DEVICE(0x1199, 0x6815) }, /* Sierra Wireless MC8775 */
  143. { USB_DEVICE(0x03f0, 0x1e1d) }, /* HP hs2300 a.k.a MC8775 */
  144. { USB_DEVICE(0x1199, 0x6820) }, /* Sierra Wireless AirCard 875 */
  145. { USB_DEVICE(0x1199, 0x6832) }, /* Sierra Wireless MC8780*/
  146. { USB_DEVICE(0x1199, 0x6833) }, /* Sierra Wireless MC8781*/
  147. { USB_DEVICE(0x1199, 0x6850) }, /* Sierra Wireless AirCard 880 */
  148. { USB_DEVICE(0x1199, 0x6851) }, /* Sierra Wireless AirCard 881 */
  149. { USB_DEVICE(0x1199, 0x6852) }, /* Sierra Wireless AirCard 880 E */
  150. { USB_DEVICE(0x1199, 0x6853) }, /* Sierra Wireless AirCard 881 E */
  151. { USB_DEVICE(0x1199, 0x6855) }, /* Sierra Wireless AirCard 880 U */
  152. { USB_DEVICE(0x1199, 0x6856) }, /* Sierra Wireless AirCard 881 U */
  153. { USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */
  154. { USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */
  155. { USB_DEVICE(0x1199, 0x0112), .driver_info = DEVICE_1_PORT }, /* Sierra Wireless AirCard 580 */
  156. { USB_DEVICE(0x0F3D, 0x0112), .driver_info = DEVICE_1_PORT }, /* Airprime/Sierra PC 5220 */
  157. { USB_DEVICE(0x1199, 0x0FFF), .driver_info = DEVICE_INSTALLER},
  158. { }
  159. };
  160. MODULE_DEVICE_TABLE(usb, id_table);
  161. static struct usb_driver sierra_driver = {
  162. .name = "sierra",
  163. .probe = usb_serial_probe,
  164. .disconnect = usb_serial_disconnect,
  165. .id_table = id_table,
  166. .no_dynamic_id = 1,
  167. };
  168. struct sierra_port_private {
  169. spinlock_t lock; /* lock the structure */
  170. int outstanding_urbs; /* number of out urbs in flight */
  171. /* Input endpoints and buffers for this port */
  172. struct urb *in_urbs[N_IN_URB];
  173. char *in_buffer[N_IN_URB];
  174. /* Settings for the port */
  175. int rts_state; /* Handshaking pins (outputs) */
  176. int dtr_state;
  177. int cts_state; /* Handshaking pins (inputs) */
  178. int dsr_state;
  179. int dcd_state;
  180. int ri_state;
  181. };
  182. static int sierra_send_setup(struct usb_serial_port *port)
  183. {
  184. struct usb_serial *serial = port->serial;
  185. struct sierra_port_private *portdata;
  186. __u16 interface = 0;
  187. dbg("%s", __FUNCTION__);
  188. portdata = usb_get_serial_port_data(port);
  189. if (port->tty) {
  190. int val = 0;
  191. if (portdata->dtr_state)
  192. val |= 0x01;
  193. if (portdata->rts_state)
  194. val |= 0x02;
  195. /* Determine which port is targeted */
  196. if (port->bulk_out_endpointAddress == 2)
  197. interface = 0;
  198. else if (port->bulk_out_endpointAddress == 4)
  199. interface = 1;
  200. else if (port->bulk_out_endpointAddress == 5)
  201. interface = 2;
  202. return usb_control_msg(serial->dev,
  203. usb_rcvctrlpipe(serial->dev, 0),
  204. 0x22, 0x21, val, interface,
  205. NULL, 0, USB_CTRL_SET_TIMEOUT);
  206. }
  207. return 0;
  208. }
  209. static void sierra_rx_throttle(struct usb_serial_port *port)
  210. {
  211. dbg("%s", __FUNCTION__);
  212. }
  213. static void sierra_rx_unthrottle(struct usb_serial_port *port)
  214. {
  215. dbg("%s", __FUNCTION__);
  216. }
  217. static void sierra_break_ctl(struct usb_serial_port *port, int break_state)
  218. {
  219. /* Unfortunately, I don't know how to send a break */
  220. dbg("%s", __FUNCTION__);
  221. }
  222. static void sierra_set_termios(struct usb_serial_port *port,
  223. struct ktermios *old_termios)
  224. {
  225. dbg("%s", __FUNCTION__);
  226. tty_termios_copy_hw(port->tty->termios, old_termios);
  227. sierra_send_setup(port);
  228. }
  229. static int sierra_tiocmget(struct usb_serial_port *port, struct file *file)
  230. {
  231. unsigned int value;
  232. struct sierra_port_private *portdata;
  233. portdata = usb_get_serial_port_data(port);
  234. value = ((portdata->rts_state) ? TIOCM_RTS : 0) |
  235. ((portdata->dtr_state) ? TIOCM_DTR : 0) |
  236. ((portdata->cts_state) ? TIOCM_CTS : 0) |
  237. ((portdata->dsr_state) ? TIOCM_DSR : 0) |
  238. ((portdata->dcd_state) ? TIOCM_CAR : 0) |
  239. ((portdata->ri_state) ? TIOCM_RNG : 0);
  240. return value;
  241. }
  242. static int sierra_tiocmset(struct usb_serial_port *port, struct file *file,
  243. unsigned int set, unsigned int clear)
  244. {
  245. struct sierra_port_private *portdata;
  246. portdata = usb_get_serial_port_data(port);
  247. if (set & TIOCM_RTS)
  248. portdata->rts_state = 1;
  249. if (set & TIOCM_DTR)
  250. portdata->dtr_state = 1;
  251. if (clear & TIOCM_RTS)
  252. portdata->rts_state = 0;
  253. if (clear & TIOCM_DTR)
  254. portdata->dtr_state = 0;
  255. return sierra_send_setup(port);
  256. }
  257. static int sierra_ioctl(struct usb_serial_port *port, struct file *file,
  258. unsigned int cmd, unsigned long arg)
  259. {
  260. return -ENOIOCTLCMD;
  261. }
  262. static void sierra_outdat_callback(struct urb *urb)
  263. {
  264. struct usb_serial_port *port = urb->context;
  265. struct sierra_port_private *portdata = usb_get_serial_port_data(port);
  266. int status = urb->status;
  267. unsigned long flags;
  268. dbg("%s - port %d", __FUNCTION__, port->number);
  269. /* free up the transfer buffer, as usb_free_urb() does not do this */
  270. kfree(urb->transfer_buffer);
  271. if (status)
  272. dbg("%s - nonzero write bulk status received: %d",
  273. __FUNCTION__, status);
  274. spin_lock_irqsave(&portdata->lock, flags);
  275. --portdata->outstanding_urbs;
  276. spin_unlock_irqrestore(&portdata->lock, flags);
  277. usb_serial_port_softint(port);
  278. }
  279. /* Write */
  280. static int sierra_write(struct usb_serial_port *port,
  281. const unsigned char *buf, int count)
  282. {
  283. struct sierra_port_private *portdata = usb_get_serial_port_data(port);
  284. struct usb_serial *serial = port->serial;
  285. unsigned long flags;
  286. unsigned char *buffer;
  287. struct urb *urb;
  288. int status;
  289. portdata = usb_get_serial_port_data(port);
  290. dbg("%s: write (%d chars)", __FUNCTION__, count);
  291. spin_lock_irqsave(&portdata->lock, flags);
  292. if (portdata->outstanding_urbs > N_OUT_URB) {
  293. spin_unlock_irqrestore(&portdata->lock, flags);
  294. dbg("%s - write limit hit\n", __FUNCTION__);
  295. return 0;
  296. }
  297. portdata->outstanding_urbs++;
  298. spin_unlock_irqrestore(&portdata->lock, flags);
  299. buffer = kmalloc(count, GFP_ATOMIC);
  300. if (!buffer) {
  301. dev_err(&port->dev, "out of memory\n");
  302. count = -ENOMEM;
  303. goto error_no_buffer;
  304. }
  305. urb = usb_alloc_urb(0, GFP_ATOMIC);
  306. if (!urb) {
  307. dev_err(&port->dev, "no more free urbs\n");
  308. count = -ENOMEM;
  309. goto error_no_urb;
  310. }
  311. memcpy(buffer, buf, count);
  312. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, buffer);
  313. usb_fill_bulk_urb(urb, serial->dev,
  314. usb_sndbulkpipe(serial->dev,
  315. port->bulk_out_endpointAddress),
  316. buffer, count, sierra_outdat_callback, port);
  317. /* send it down the pipe */
  318. status = usb_submit_urb(urb, GFP_ATOMIC);
  319. if (status) {
  320. dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed "
  321. "with status = %d\n", __FUNCTION__, status);
  322. count = status;
  323. goto error;
  324. }
  325. /* we are done with this urb, so let the host driver
  326. * really free it when it is finished with it */
  327. usb_free_urb(urb);
  328. return count;
  329. error:
  330. usb_free_urb(urb);
  331. error_no_urb:
  332. kfree(buffer);
  333. error_no_buffer:
  334. spin_lock_irqsave(&portdata->lock, flags);
  335. --portdata->outstanding_urbs;
  336. spin_unlock_irqrestore(&portdata->lock, flags);
  337. return count;
  338. }
  339. static void sierra_indat_callback(struct urb *urb)
  340. {
  341. int err;
  342. int endpoint;
  343. struct usb_serial_port *port;
  344. struct tty_struct *tty;
  345. unsigned char *data = urb->transfer_buffer;
  346. int status = urb->status;
  347. dbg("%s: %p", __FUNCTION__, urb);
  348. endpoint = usb_pipeendpoint(urb->pipe);
  349. port = (struct usb_serial_port *) urb->context;
  350. if (status) {
  351. dbg("%s: nonzero status: %d on endpoint %02x.",
  352. __FUNCTION__, status, endpoint);
  353. } else {
  354. tty = port->tty;
  355. if (urb->actual_length) {
  356. tty_buffer_request_room(tty, urb->actual_length);
  357. tty_insert_flip_string(tty, data, urb->actual_length);
  358. tty_flip_buffer_push(tty);
  359. } else {
  360. dbg("%s: empty read urb received", __FUNCTION__);
  361. }
  362. /* Resubmit urb so we continue receiving */
  363. if (port->open_count && status != -ESHUTDOWN) {
  364. err = usb_submit_urb(urb, GFP_ATOMIC);
  365. if (err)
  366. dev_err(&port->dev, "resubmit read urb failed."
  367. "(%d)\n", err);
  368. }
  369. }
  370. return;
  371. }
  372. static void sierra_instat_callback(struct urb *urb)
  373. {
  374. int err;
  375. int status = urb->status;
  376. struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
  377. struct sierra_port_private *portdata = usb_get_serial_port_data(port);
  378. struct usb_serial *serial = port->serial;
  379. dbg("%s", __FUNCTION__);
  380. dbg("%s: urb %p port %p has data %p", __FUNCTION__,urb,port,portdata);
  381. if (status == 0) {
  382. struct usb_ctrlrequest *req_pkt =
  383. (struct usb_ctrlrequest *)urb->transfer_buffer;
  384. if (!req_pkt) {
  385. dbg("%s: NULL req_pkt\n", __FUNCTION__);
  386. return;
  387. }
  388. if ((req_pkt->bRequestType == 0xA1) &&
  389. (req_pkt->bRequest == 0x20)) {
  390. int old_dcd_state;
  391. unsigned char signals = *((unsigned char *)
  392. urb->transfer_buffer +
  393. sizeof(struct usb_ctrlrequest));
  394. dbg("%s: signal x%x", __FUNCTION__, signals);
  395. old_dcd_state = portdata->dcd_state;
  396. portdata->cts_state = 1;
  397. portdata->dcd_state = ((signals & 0x01) ? 1 : 0);
  398. portdata->dsr_state = ((signals & 0x02) ? 1 : 0);
  399. portdata->ri_state = ((signals & 0x08) ? 1 : 0);
  400. if (port->tty && !C_CLOCAL(port->tty) &&
  401. old_dcd_state && !portdata->dcd_state)
  402. tty_hangup(port->tty);
  403. } else {
  404. dbg("%s: type %x req %x", __FUNCTION__,
  405. req_pkt->bRequestType,req_pkt->bRequest);
  406. }
  407. } else
  408. dbg("%s: error %d", __FUNCTION__, status);
  409. /* Resubmit urb so we continue receiving IRQ data */
  410. if (status != -ESHUTDOWN) {
  411. urb->dev = serial->dev;
  412. err = usb_submit_urb(urb, GFP_ATOMIC);
  413. if (err)
  414. dbg("%s: resubmit intr urb failed. (%d)",
  415. __FUNCTION__, err);
  416. }
  417. }
  418. static int sierra_write_room(struct usb_serial_port *port)
  419. {
  420. struct sierra_port_private *portdata = usb_get_serial_port_data(port);
  421. unsigned long flags;
  422. dbg("%s - port %d", __FUNCTION__, port->number);
  423. /* try to give a good number back based on if we have any free urbs at
  424. * this point in time */
  425. spin_lock_irqsave(&portdata->lock, flags);
  426. if (portdata->outstanding_urbs > N_OUT_URB * 2 / 3) {
  427. spin_unlock_irqrestore(&portdata->lock, flags);
  428. dbg("%s - write limit hit\n", __FUNCTION__);
  429. return 0;
  430. }
  431. spin_unlock_irqrestore(&portdata->lock, flags);
  432. return 2048;
  433. }
  434. static int sierra_chars_in_buffer(struct usb_serial_port *port)
  435. {
  436. dbg("%s - port %d", __FUNCTION__, port->number);
  437. /*
  438. * We can't really account for how much data we
  439. * have sent out, but hasn't made it through to the
  440. * device as we can't see the backend here, so just
  441. * tell the tty layer that everything is flushed.
  442. */
  443. return 0;
  444. }
  445. static int sierra_open(struct usb_serial_port *port, struct file *filp)
  446. {
  447. struct sierra_port_private *portdata;
  448. struct usb_serial *serial = port->serial;
  449. int i;
  450. struct urb *urb;
  451. int result;
  452. portdata = usb_get_serial_port_data(port);
  453. dbg("%s", __FUNCTION__);
  454. /* Set some sane defaults */
  455. portdata->rts_state = 1;
  456. portdata->dtr_state = 1;
  457. /* Reset low level data toggle and start reading from endpoints */
  458. for (i = 0; i < N_IN_URB; i++) {
  459. urb = portdata->in_urbs[i];
  460. if (!urb)
  461. continue;
  462. if (urb->dev != serial->dev) {
  463. dbg("%s: dev %p != %p", __FUNCTION__,
  464. urb->dev, serial->dev);
  465. continue;
  466. }
  467. /*
  468. * make sure endpoint data toggle is synchronized with the
  469. * device
  470. */
  471. usb_clear_halt(urb->dev, urb->pipe);
  472. result = usb_submit_urb(urb, GFP_KERNEL);
  473. if (result) {
  474. dev_err(&port->dev, "submit urb %d failed (%d) %d\n",
  475. i, result, urb->transfer_buffer_length);
  476. }
  477. }
  478. port->tty->low_latency = 1;
  479. sierra_send_setup(port);
  480. /* start up the interrupt endpoint if we have one */
  481. if (port->interrupt_in_urb) {
  482. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  483. if (result)
  484. dev_err(&port->dev, "submit irq_in urb failed %d\n",
  485. result);
  486. }
  487. return 0;
  488. }
  489. static void sierra_close(struct usb_serial_port *port, struct file *filp)
  490. {
  491. int i;
  492. struct usb_serial *serial = port->serial;
  493. struct sierra_port_private *portdata;
  494. dbg("%s", __FUNCTION__);
  495. portdata = usb_get_serial_port_data(port);
  496. portdata->rts_state = 0;
  497. portdata->dtr_state = 0;
  498. if (serial->dev) {
  499. mutex_lock(&serial->disc_mutex);
  500. if (!serial->disconnected)
  501. sierra_send_setup(port);
  502. mutex_unlock(&serial->disc_mutex);
  503. /* Stop reading/writing urbs */
  504. for (i = 0; i < N_IN_URB; i++)
  505. usb_kill_urb(portdata->in_urbs[i]);
  506. }
  507. usb_kill_urb(port->interrupt_in_urb);
  508. port->tty = NULL;
  509. }
  510. static int sierra_startup(struct usb_serial *serial)
  511. {
  512. struct usb_serial_port *port;
  513. struct sierra_port_private *portdata;
  514. struct urb *urb;
  515. int i;
  516. int j;
  517. dbg("%s", __FUNCTION__);
  518. /* Set Device mode to D0 */
  519. sierra_set_power_state(serial->dev, 0x0000);
  520. /* Check NMEA and set */
  521. if (nmea)
  522. sierra_vsc_set_nmea(serial->dev, 1);
  523. /* Now setup per port private data */
  524. for (i = 0; i < serial->num_ports; i++) {
  525. port = serial->port[i];
  526. portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
  527. if (!portdata) {
  528. dbg("%s: kmalloc for sierra_port_private (%d) failed!.",
  529. __FUNCTION__, i);
  530. return -ENOMEM;
  531. }
  532. spin_lock_init(&portdata->lock);
  533. for (j = 0; j < N_IN_URB; j++) {
  534. portdata->in_buffer[j] = kmalloc(IN_BUFLEN, GFP_KERNEL);
  535. if (!portdata->in_buffer[j]) {
  536. for (--j; j >= 0; j--)
  537. kfree(portdata->in_buffer[j]);
  538. kfree(portdata);
  539. return -ENOMEM;
  540. }
  541. }
  542. usb_set_serial_port_data(port, portdata);
  543. /* initialize the in urbs */
  544. for (j = 0; j < N_IN_URB; ++j) {
  545. urb = usb_alloc_urb(0, GFP_KERNEL);
  546. if (urb == NULL) {
  547. dbg("%s: alloc for in port failed.",
  548. __FUNCTION__);
  549. continue;
  550. }
  551. /* Fill URB using supplied data. */
  552. usb_fill_bulk_urb(urb, serial->dev,
  553. usb_rcvbulkpipe(serial->dev,
  554. port->bulk_in_endpointAddress),
  555. portdata->in_buffer[j], IN_BUFLEN,
  556. sierra_indat_callback, port);
  557. portdata->in_urbs[j] = urb;
  558. }
  559. }
  560. return 0;
  561. }
  562. static void sierra_shutdown(struct usb_serial *serial)
  563. {
  564. int i, j;
  565. struct usb_serial_port *port;
  566. struct sierra_port_private *portdata;
  567. dbg("%s", __FUNCTION__);
  568. for (i = 0; i < serial->num_ports; ++i) {
  569. port = serial->port[i];
  570. if (!port)
  571. continue;
  572. portdata = usb_get_serial_port_data(port);
  573. if (!portdata)
  574. continue;
  575. for (j = 0; j < N_IN_URB; j++) {
  576. usb_kill_urb(portdata->in_urbs[j]);
  577. usb_free_urb(portdata->in_urbs[j]);
  578. kfree(portdata->in_buffer[j]);
  579. }
  580. kfree(portdata);
  581. usb_set_serial_port_data(port, NULL);
  582. }
  583. }
  584. static struct usb_serial_driver sierra_device = {
  585. .driver = {
  586. .owner = THIS_MODULE,
  587. .name = "sierra1",
  588. },
  589. .description = "Sierra USB modem",
  590. .id_table = id_table,
  591. .usb_driver = &sierra_driver,
  592. .num_interrupt_in = NUM_DONT_CARE,
  593. .num_bulk_in = NUM_DONT_CARE,
  594. .num_bulk_out = NUM_DONT_CARE,
  595. .calc_num_ports = sierra_calc_num_ports,
  596. .probe = sierra_probe,
  597. .open = sierra_open,
  598. .close = sierra_close,
  599. .write = sierra_write,
  600. .write_room = sierra_write_room,
  601. .chars_in_buffer = sierra_chars_in_buffer,
  602. .throttle = sierra_rx_throttle,
  603. .unthrottle = sierra_rx_unthrottle,
  604. .ioctl = sierra_ioctl,
  605. .set_termios = sierra_set_termios,
  606. .break_ctl = sierra_break_ctl,
  607. .tiocmget = sierra_tiocmget,
  608. .tiocmset = sierra_tiocmset,
  609. .attach = sierra_startup,
  610. .shutdown = sierra_shutdown,
  611. .read_int_callback = sierra_instat_callback,
  612. };
  613. /* Functions used by new usb-serial code. */
  614. static int __init sierra_init(void)
  615. {
  616. int retval;
  617. retval = usb_serial_register(&sierra_device);
  618. if (retval)
  619. goto failed_device_register;
  620. retval = usb_register(&sierra_driver);
  621. if (retval)
  622. goto failed_driver_register;
  623. info(DRIVER_DESC ": " DRIVER_VERSION);
  624. return 0;
  625. failed_driver_register:
  626. usb_serial_deregister(&sierra_device);
  627. failed_device_register:
  628. return retval;
  629. }
  630. static void __exit sierra_exit(void)
  631. {
  632. usb_deregister (&sierra_driver);
  633. usb_serial_deregister(&sierra_device);
  634. }
  635. module_init(sierra_init);
  636. module_exit(sierra_exit);
  637. MODULE_AUTHOR(DRIVER_AUTHOR);
  638. MODULE_DESCRIPTION(DRIVER_DESC);
  639. MODULE_VERSION(DRIVER_VERSION);
  640. MODULE_LICENSE("GPL");
  641. module_param(truinstall, bool, 0);
  642. MODULE_PARM_DESC(truinstall, "TRU-Install support");
  643. module_param(nmea, bool, 0);
  644. MODULE_PARM_DESC(nmea, "NMEA streaming");
  645. #ifdef CONFIG_USB_DEBUG
  646. module_param(debug, bool, S_IRUGO | S_IWUSR);
  647. MODULE_PARM_DESC(debug, "Debug messages");
  648. #endif