ircomm_tty.c 40 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402
  1. /*********************************************************************
  2. *
  3. * Filename: ircomm_tty.c
  4. * Version: 1.0
  5. * Description: IrCOMM serial TTY driver
  6. * Status: Experimental.
  7. * Author: Dag Brattli <dagb@cs.uit.no>
  8. * Created at: Sun Jun 6 21:00:56 1999
  9. * Modified at: Wed Feb 23 00:09:02 2000
  10. * Modified by: Dag Brattli <dagb@cs.uit.no>
  11. * Sources: serial.c and previous IrCOMM work by Takahide Higuchi
  12. *
  13. * Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved.
  14. * Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com>
  15. *
  16. * This program is free software; you can redistribute it and/or
  17. * modify it under the terms of the GNU General Public License as
  18. * published by the Free Software Foundation; either version 2 of
  19. * the License, or (at your option) any later version.
  20. *
  21. * This program is distributed in the hope that it will be useful,
  22. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  24. * GNU General Public License for more details.
  25. *
  26. * You should have received a copy of the GNU General Public License
  27. * along with this program; if not, write to the Free Software
  28. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  29. * MA 02111-1307 USA
  30. *
  31. ********************************************************************/
  32. #include <linux/config.h>
  33. #include <linux/init.h>
  34. #include <linux/module.h>
  35. #include <linux/fs.h>
  36. #include <linux/sched.h>
  37. #include <linux/termios.h>
  38. #include <linux/tty.h>
  39. #include <linux/interrupt.h>
  40. #include <linux/device.h> /* for MODULE_ALIAS_CHARDEV_MAJOR */
  41. #include <asm/uaccess.h>
  42. #include <net/irda/irda.h>
  43. #include <net/irda/irmod.h>
  44. #include <net/irda/ircomm_core.h>
  45. #include <net/irda/ircomm_param.h>
  46. #include <net/irda/ircomm_tty_attach.h>
  47. #include <net/irda/ircomm_tty.h>
  48. static int ircomm_tty_open(struct tty_struct *tty, struct file *filp);
  49. static void ircomm_tty_close(struct tty_struct * tty, struct file *filp);
  50. static int ircomm_tty_write(struct tty_struct * tty,
  51. const unsigned char *buf, int count);
  52. static int ircomm_tty_write_room(struct tty_struct *tty);
  53. static void ircomm_tty_throttle(struct tty_struct *tty);
  54. static void ircomm_tty_unthrottle(struct tty_struct *tty);
  55. static int ircomm_tty_chars_in_buffer(struct tty_struct *tty);
  56. static void ircomm_tty_flush_buffer(struct tty_struct *tty);
  57. static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch);
  58. static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout);
  59. static void ircomm_tty_hangup(struct tty_struct *tty);
  60. static void ircomm_tty_do_softint(void *private_);
  61. static void ircomm_tty_shutdown(struct ircomm_tty_cb *self);
  62. static void ircomm_tty_stop(struct tty_struct *tty);
  63. static int ircomm_tty_data_indication(void *instance, void *sap,
  64. struct sk_buff *skb);
  65. static int ircomm_tty_control_indication(void *instance, void *sap,
  66. struct sk_buff *skb);
  67. static void ircomm_tty_flow_indication(void *instance, void *sap,
  68. LOCAL_FLOW cmd);
  69. #ifdef CONFIG_PROC_FS
  70. static int ircomm_tty_read_proc(char *buf, char **start, off_t offset, int len,
  71. int *eof, void *unused);
  72. #endif /* CONFIG_PROC_FS */
  73. static struct tty_driver *driver;
  74. hashbin_t *ircomm_tty = NULL;
  75. static struct tty_operations ops = {
  76. .open = ircomm_tty_open,
  77. .close = ircomm_tty_close,
  78. .write = ircomm_tty_write,
  79. .write_room = ircomm_tty_write_room,
  80. .chars_in_buffer = ircomm_tty_chars_in_buffer,
  81. .flush_buffer = ircomm_tty_flush_buffer,
  82. .ioctl = ircomm_tty_ioctl, /* ircomm_tty_ioctl.c */
  83. .tiocmget = ircomm_tty_tiocmget, /* ircomm_tty_ioctl.c */
  84. .tiocmset = ircomm_tty_tiocmset, /* ircomm_tty_ioctl.c */
  85. .throttle = ircomm_tty_throttle,
  86. .unthrottle = ircomm_tty_unthrottle,
  87. .send_xchar = ircomm_tty_send_xchar,
  88. .set_termios = ircomm_tty_set_termios,
  89. .stop = ircomm_tty_stop,
  90. .start = ircomm_tty_start,
  91. .hangup = ircomm_tty_hangup,
  92. .wait_until_sent = ircomm_tty_wait_until_sent,
  93. #ifdef CONFIG_PROC_FS
  94. .read_proc = ircomm_tty_read_proc,
  95. #endif /* CONFIG_PROC_FS */
  96. };
  97. /*
  98. * Function ircomm_tty_init()
  99. *
  100. * Init IrCOMM TTY layer/driver
  101. *
  102. */
  103. static int __init ircomm_tty_init(void)
  104. {
  105. driver = alloc_tty_driver(IRCOMM_TTY_PORTS);
  106. if (!driver)
  107. return -ENOMEM;
  108. ircomm_tty = hashbin_new(HB_LOCK);
  109. if (ircomm_tty == NULL) {
  110. IRDA_ERROR("%s(), can't allocate hashbin!\n", __FUNCTION__);
  111. put_tty_driver(driver);
  112. return -ENOMEM;
  113. }
  114. driver->owner = THIS_MODULE;
  115. driver->driver_name = "ircomm";
  116. driver->name = "ircomm";
  117. driver->devfs_name = "ircomm";
  118. driver->major = IRCOMM_TTY_MAJOR;
  119. driver->minor_start = IRCOMM_TTY_MINOR;
  120. driver->type = TTY_DRIVER_TYPE_SERIAL;
  121. driver->subtype = SERIAL_TYPE_NORMAL;
  122. driver->init_termios = tty_std_termios;
  123. driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
  124. driver->flags = TTY_DRIVER_REAL_RAW;
  125. tty_set_operations(driver, &ops);
  126. if (tty_register_driver(driver)) {
  127. IRDA_ERROR("%s(): Couldn't register serial driver\n",
  128. __FUNCTION__);
  129. put_tty_driver(driver);
  130. return -1;
  131. }
  132. return 0;
  133. }
  134. static void __exit __ircomm_tty_cleanup(struct ircomm_tty_cb *self)
  135. {
  136. IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
  137. IRDA_ASSERT(self != NULL, return;);
  138. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  139. ircomm_tty_shutdown(self);
  140. self->magic = 0;
  141. kfree(self);
  142. }
  143. /*
  144. * Function ircomm_tty_cleanup ()
  145. *
  146. * Remove IrCOMM TTY layer/driver
  147. *
  148. */
  149. static void __exit ircomm_tty_cleanup(void)
  150. {
  151. int ret;
  152. IRDA_DEBUG(4, "%s()\n", __FUNCTION__ );
  153. ret = tty_unregister_driver(driver);
  154. if (ret) {
  155. IRDA_ERROR("%s(), failed to unregister driver\n",
  156. __FUNCTION__);
  157. return;
  158. }
  159. hashbin_delete(ircomm_tty, (FREE_FUNC) __ircomm_tty_cleanup);
  160. put_tty_driver(driver);
  161. }
  162. /*
  163. * Function ircomm_startup (self)
  164. *
  165. *
  166. *
  167. */
  168. static int ircomm_tty_startup(struct ircomm_tty_cb *self)
  169. {
  170. notify_t notify;
  171. int ret = -ENODEV;
  172. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  173. IRDA_ASSERT(self != NULL, return -1;);
  174. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  175. /* Check if already open */
  176. if (test_and_set_bit(ASYNC_B_INITIALIZED, &self->flags)) {
  177. IRDA_DEBUG(2, "%s(), already open so break out!\n", __FUNCTION__ );
  178. return 0;
  179. }
  180. /* Register with IrCOMM */
  181. irda_notify_init(&notify);
  182. /* These callbacks we must handle ourselves */
  183. notify.data_indication = ircomm_tty_data_indication;
  184. notify.udata_indication = ircomm_tty_control_indication;
  185. notify.flow_indication = ircomm_tty_flow_indication;
  186. /* Use the ircomm_tty interface for these ones */
  187. notify.disconnect_indication = ircomm_tty_disconnect_indication;
  188. notify.connect_confirm = ircomm_tty_connect_confirm;
  189. notify.connect_indication = ircomm_tty_connect_indication;
  190. strlcpy(notify.name, "ircomm_tty", sizeof(notify.name));
  191. notify.instance = self;
  192. if (!self->ircomm) {
  193. self->ircomm = ircomm_open(&notify, self->service_type,
  194. self->line);
  195. }
  196. if (!self->ircomm)
  197. goto err;
  198. self->slsap_sel = self->ircomm->slsap_sel;
  199. /* Connect IrCOMM link with remote device */
  200. ret = ircomm_tty_attach_cable(self);
  201. if (ret < 0) {
  202. IRDA_ERROR("%s(), error attaching cable!\n", __FUNCTION__);
  203. goto err;
  204. }
  205. return 0;
  206. err:
  207. clear_bit(ASYNC_B_INITIALIZED, &self->flags);
  208. return ret;
  209. }
  210. /*
  211. * Function ircomm_block_til_ready (self, filp)
  212. *
  213. *
  214. *
  215. */
  216. static int ircomm_tty_block_til_ready(struct ircomm_tty_cb *self,
  217. struct file *filp)
  218. {
  219. DECLARE_WAITQUEUE(wait, current);
  220. int retval;
  221. int do_clocal = 0, extra_count = 0;
  222. unsigned long flags;
  223. struct tty_struct *tty;
  224. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  225. tty = self->tty;
  226. /*
  227. * If non-blocking mode is set, or the port is not enabled,
  228. * then make the check up front and then exit.
  229. */
  230. if (filp->f_flags & O_NONBLOCK || tty->flags & (1 << TTY_IO_ERROR)){
  231. /* nonblock mode is set or port is not enabled */
  232. self->flags |= ASYNC_NORMAL_ACTIVE;
  233. IRDA_DEBUG(1, "%s(), O_NONBLOCK requested!\n", __FUNCTION__ );
  234. return 0;
  235. }
  236. if (tty->termios->c_cflag & CLOCAL) {
  237. IRDA_DEBUG(1, "%s(), doing CLOCAL!\n", __FUNCTION__ );
  238. do_clocal = 1;
  239. }
  240. /* Wait for carrier detect and the line to become
  241. * free (i.e., not in use by the callout). While we are in
  242. * this loop, self->open_count is dropped by one, so that
  243. * mgsl_close() knows when to free things. We restore it upon
  244. * exit, either normal or abnormal.
  245. */
  246. retval = 0;
  247. add_wait_queue(&self->open_wait, &wait);
  248. IRDA_DEBUG(2, "%s(%d):block_til_ready before block on %s open_count=%d\n",
  249. __FILE__,__LINE__, tty->driver->name, self->open_count );
  250. /* As far as I can see, we protect open_count - Jean II */
  251. spin_lock_irqsave(&self->spinlock, flags);
  252. if (!tty_hung_up_p(filp)) {
  253. extra_count = 1;
  254. self->open_count--;
  255. }
  256. spin_unlock_irqrestore(&self->spinlock, flags);
  257. self->blocked_open++;
  258. while (1) {
  259. if (tty->termios->c_cflag & CBAUD) {
  260. /* Here, we use to lock those two guys, but
  261. * as ircomm_param_request() does it itself,
  262. * I don't see the point (and I see the deadlock).
  263. * Jean II */
  264. self->settings.dte |= IRCOMM_RTS + IRCOMM_DTR;
  265. ircomm_param_request(self, IRCOMM_DTE, TRUE);
  266. }
  267. current->state = TASK_INTERRUPTIBLE;
  268. if (tty_hung_up_p(filp) ||
  269. !test_bit(ASYNC_B_INITIALIZED, &self->flags)) {
  270. retval = (self->flags & ASYNC_HUP_NOTIFY) ?
  271. -EAGAIN : -ERESTARTSYS;
  272. break;
  273. }
  274. /*
  275. * Check if link is ready now. Even if CLOCAL is
  276. * specified, we cannot return before the IrCOMM link is
  277. * ready
  278. */
  279. if (!test_bit(ASYNC_B_CLOSING, &self->flags) &&
  280. (do_clocal || (self->settings.dce & IRCOMM_CD)) &&
  281. self->state == IRCOMM_TTY_READY)
  282. {
  283. break;
  284. }
  285. if (signal_pending(current)) {
  286. retval = -ERESTARTSYS;
  287. break;
  288. }
  289. IRDA_DEBUG(1, "%s(%d):block_til_ready blocking on %s open_count=%d\n",
  290. __FILE__,__LINE__, tty->driver->name, self->open_count );
  291. schedule();
  292. }
  293. __set_current_state(TASK_RUNNING);
  294. remove_wait_queue(&self->open_wait, &wait);
  295. if (extra_count) {
  296. /* ++ is not atomic, so this should be protected - Jean II */
  297. spin_lock_irqsave(&self->spinlock, flags);
  298. self->open_count++;
  299. spin_unlock_irqrestore(&self->spinlock, flags);
  300. }
  301. self->blocked_open--;
  302. IRDA_DEBUG(1, "%s(%d):block_til_ready after blocking on %s open_count=%d\n",
  303. __FILE__,__LINE__, tty->driver->name, self->open_count);
  304. if (!retval)
  305. self->flags |= ASYNC_NORMAL_ACTIVE;
  306. return retval;
  307. }
  308. /*
  309. * Function ircomm_tty_open (tty, filp)
  310. *
  311. * This routine is called when a particular tty device is opened. This
  312. * routine is mandatory; if this routine is not filled in, the attempted
  313. * open will fail with ENODEV.
  314. */
  315. static int ircomm_tty_open(struct tty_struct *tty, struct file *filp)
  316. {
  317. struct ircomm_tty_cb *self;
  318. unsigned int line;
  319. unsigned long flags;
  320. int ret;
  321. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  322. line = tty->index;
  323. if ((line < 0) || (line >= IRCOMM_TTY_PORTS)) {
  324. return -ENODEV;
  325. }
  326. /* Check if instance already exists */
  327. self = hashbin_lock_find(ircomm_tty, line, NULL);
  328. if (!self) {
  329. /* No, so make new instance */
  330. self = kmalloc(sizeof(struct ircomm_tty_cb), GFP_KERNEL);
  331. if (self == NULL) {
  332. IRDA_ERROR("%s(), kmalloc failed!\n", __FUNCTION__);
  333. return -ENOMEM;
  334. }
  335. memset(self, 0, sizeof(struct ircomm_tty_cb));
  336. self->magic = IRCOMM_TTY_MAGIC;
  337. self->flow = FLOW_STOP;
  338. self->line = line;
  339. INIT_WORK(&self->tqueue, ircomm_tty_do_softint, self);
  340. self->max_header_size = IRCOMM_TTY_HDR_UNINITIALISED;
  341. self->max_data_size = IRCOMM_TTY_DATA_UNINITIALISED;
  342. self->close_delay = 5*HZ/10;
  343. self->closing_wait = 30*HZ;
  344. /* Init some important stuff */
  345. init_timer(&self->watchdog_timer);
  346. init_waitqueue_head(&self->open_wait);
  347. init_waitqueue_head(&self->close_wait);
  348. spin_lock_init(&self->spinlock);
  349. /*
  350. * Force TTY into raw mode by default which is usually what
  351. * we want for IrCOMM and IrLPT. This way applications will
  352. * not have to twiddle with printcap etc.
  353. */
  354. tty->termios->c_iflag = 0;
  355. tty->termios->c_oflag = 0;
  356. /* Insert into hash */
  357. hashbin_insert(ircomm_tty, (irda_queue_t *) self, line, NULL);
  358. }
  359. /* ++ is not atomic, so this should be protected - Jean II */
  360. spin_lock_irqsave(&self->spinlock, flags);
  361. self->open_count++;
  362. tty->driver_data = self;
  363. self->tty = tty;
  364. spin_unlock_irqrestore(&self->spinlock, flags);
  365. IRDA_DEBUG(1, "%s(), %s%d, count = %d\n", __FUNCTION__ , tty->driver->name,
  366. self->line, self->open_count);
  367. /* Not really used by us, but lets do it anyway */
  368. self->tty->low_latency = (self->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
  369. /*
  370. * If the port is the middle of closing, bail out now
  371. */
  372. if (tty_hung_up_p(filp) ||
  373. test_bit(ASYNC_B_CLOSING, &self->flags)) {
  374. /* Hm, why are we blocking on ASYNC_CLOSING if we
  375. * do return -EAGAIN/-ERESTARTSYS below anyway?
  376. * IMHO it's either not needed in the first place
  377. * or for some reason we need to make sure the async
  378. * closing has been finished - if so, wouldn't we
  379. * probably better sleep uninterruptible?
  380. */
  381. if (wait_event_interruptible(self->close_wait, !test_bit(ASYNC_B_CLOSING, &self->flags))) {
  382. IRDA_WARNING("%s - got signal while blocking on ASYNC_CLOSING!\n",
  383. __FUNCTION__);
  384. return -ERESTARTSYS;
  385. }
  386. #ifdef SERIAL_DO_RESTART
  387. return ((self->flags & ASYNC_HUP_NOTIFY) ?
  388. -EAGAIN : -ERESTARTSYS);
  389. #else
  390. return -EAGAIN;
  391. #endif
  392. }
  393. /* Check if this is a "normal" ircomm device, or an irlpt device */
  394. if (line < 0x10) {
  395. self->service_type = IRCOMM_3_WIRE | IRCOMM_9_WIRE;
  396. self->settings.service_type = IRCOMM_9_WIRE; /* 9 wire as default */
  397. /* Jan Kiszka -> add DSR/RI -> Conform to IrCOMM spec */
  398. self->settings.dce = IRCOMM_CTS | IRCOMM_CD | IRCOMM_DSR | IRCOMM_RI; /* Default line settings */
  399. IRDA_DEBUG(2, "%s(), IrCOMM device\n", __FUNCTION__ );
  400. } else {
  401. IRDA_DEBUG(2, "%s(), IrLPT device\n", __FUNCTION__ );
  402. self->service_type = IRCOMM_3_WIRE_RAW;
  403. self->settings.service_type = IRCOMM_3_WIRE_RAW; /* Default */
  404. }
  405. ret = ircomm_tty_startup(self);
  406. if (ret)
  407. return ret;
  408. ret = ircomm_tty_block_til_ready(self, filp);
  409. if (ret) {
  410. IRDA_DEBUG(2,
  411. "%s(), returning after block_til_ready with %d\n", __FUNCTION__ ,
  412. ret);
  413. return ret;
  414. }
  415. return 0;
  416. }
  417. /*
  418. * Function ircomm_tty_close (tty, filp)
  419. *
  420. * This routine is called when a particular tty device is closed.
  421. *
  422. */
  423. static void ircomm_tty_close(struct tty_struct *tty, struct file *filp)
  424. {
  425. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  426. unsigned long flags;
  427. IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
  428. if (!tty)
  429. return;
  430. IRDA_ASSERT(self != NULL, return;);
  431. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  432. spin_lock_irqsave(&self->spinlock, flags);
  433. if (tty_hung_up_p(filp)) {
  434. spin_unlock_irqrestore(&self->spinlock, flags);
  435. IRDA_DEBUG(0, "%s(), returning 1\n", __FUNCTION__ );
  436. return;
  437. }
  438. if ((tty->count == 1) && (self->open_count != 1)) {
  439. /*
  440. * Uh, oh. tty->count is 1, which means that the tty
  441. * structure will be freed. state->count should always
  442. * be one in these conditions. If it's greater than
  443. * one, we've got real problems, since it means the
  444. * serial port won't be shutdown.
  445. */
  446. IRDA_DEBUG(0, "%s(), bad serial port count; "
  447. "tty->count is 1, state->count is %d\n", __FUNCTION__ ,
  448. self->open_count);
  449. self->open_count = 1;
  450. }
  451. if (--self->open_count < 0) {
  452. IRDA_ERROR("%s(), bad serial port count for ttys%d: %d\n",
  453. __FUNCTION__, self->line, self->open_count);
  454. self->open_count = 0;
  455. }
  456. if (self->open_count) {
  457. spin_unlock_irqrestore(&self->spinlock, flags);
  458. IRDA_DEBUG(0, "%s(), open count > 0\n", __FUNCTION__ );
  459. return;
  460. }
  461. /* Hum... Should be test_and_set_bit ??? - Jean II */
  462. set_bit(ASYNC_B_CLOSING, &self->flags);
  463. /* We need to unlock here (we were unlocking at the end of this
  464. * function), because tty_wait_until_sent() may schedule.
  465. * I don't know if the rest should be protected somehow,
  466. * so someone should check. - Jean II */
  467. spin_unlock_irqrestore(&self->spinlock, flags);
  468. /*
  469. * Now we wait for the transmit buffer to clear; and we notify
  470. * the line discipline to only process XON/XOFF characters.
  471. */
  472. tty->closing = 1;
  473. if (self->closing_wait != ASYNC_CLOSING_WAIT_NONE)
  474. tty_wait_until_sent(tty, self->closing_wait);
  475. ircomm_tty_shutdown(self);
  476. if (tty->driver->flush_buffer)
  477. tty->driver->flush_buffer(tty);
  478. if (tty->ldisc.flush_buffer)
  479. tty->ldisc.flush_buffer(tty);
  480. tty->closing = 0;
  481. self->tty = NULL;
  482. if (self->blocked_open) {
  483. if (self->close_delay)
  484. schedule_timeout_interruptible(self->close_delay);
  485. wake_up_interruptible(&self->open_wait);
  486. }
  487. self->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
  488. wake_up_interruptible(&self->close_wait);
  489. }
  490. /*
  491. * Function ircomm_tty_flush_buffer (tty)
  492. *
  493. *
  494. *
  495. */
  496. static void ircomm_tty_flush_buffer(struct tty_struct *tty)
  497. {
  498. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  499. IRDA_ASSERT(self != NULL, return;);
  500. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  501. /*
  502. * Let do_softint() do this to avoid race condition with
  503. * do_softint() ;-)
  504. */
  505. schedule_work(&self->tqueue);
  506. }
  507. /*
  508. * Function ircomm_tty_do_softint (private_)
  509. *
  510. * We use this routine to give the write wakeup to the user at at a
  511. * safe time (as fast as possible after write have completed). This
  512. * can be compared to the Tx interrupt.
  513. */
  514. static void ircomm_tty_do_softint(void *private_)
  515. {
  516. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) private_;
  517. struct tty_struct *tty;
  518. unsigned long flags;
  519. struct sk_buff *skb, *ctrl_skb;
  520. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  521. if (!self || self->magic != IRCOMM_TTY_MAGIC)
  522. return;
  523. tty = self->tty;
  524. if (!tty)
  525. return;
  526. /* Unlink control buffer */
  527. spin_lock_irqsave(&self->spinlock, flags);
  528. ctrl_skb = self->ctrl_skb;
  529. self->ctrl_skb = NULL;
  530. spin_unlock_irqrestore(&self->spinlock, flags);
  531. /* Flush control buffer if any */
  532. if(ctrl_skb) {
  533. if(self->flow == FLOW_START)
  534. ircomm_control_request(self->ircomm, ctrl_skb);
  535. /* Drop reference count - see ircomm_ttp_data_request(). */
  536. dev_kfree_skb(ctrl_skb);
  537. }
  538. if (tty->hw_stopped)
  539. return;
  540. /* Unlink transmit buffer */
  541. spin_lock_irqsave(&self->spinlock, flags);
  542. skb = self->tx_skb;
  543. self->tx_skb = NULL;
  544. spin_unlock_irqrestore(&self->spinlock, flags);
  545. /* Flush transmit buffer if any */
  546. if (skb) {
  547. ircomm_tty_do_event(self, IRCOMM_TTY_DATA_REQUEST, skb, NULL);
  548. /* Drop reference count - see ircomm_ttp_data_request(). */
  549. dev_kfree_skb(skb);
  550. }
  551. /* Check if user (still) wants to be waken up */
  552. if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
  553. tty->ldisc.write_wakeup)
  554. {
  555. (tty->ldisc.write_wakeup)(tty);
  556. }
  557. wake_up_interruptible(&tty->write_wait);
  558. }
  559. /*
  560. * Function ircomm_tty_write (tty, buf, count)
  561. *
  562. * This routine is called by the kernel to write a series of characters
  563. * to the tty device. The characters may come from user space or kernel
  564. * space. This routine will return the number of characters actually
  565. * accepted for writing. This routine is mandatory.
  566. */
  567. static int ircomm_tty_write(struct tty_struct *tty,
  568. const unsigned char *buf, int count)
  569. {
  570. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  571. unsigned long flags;
  572. struct sk_buff *skb;
  573. int tailroom = 0;
  574. int len = 0;
  575. int size;
  576. IRDA_DEBUG(2, "%s(), count=%d, hw_stopped=%d\n", __FUNCTION__ , count,
  577. tty->hw_stopped);
  578. IRDA_ASSERT(self != NULL, return -1;);
  579. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  580. /* We may receive packets from the TTY even before we have finished
  581. * our setup. Not cool.
  582. * The problem is that we don't know the final header and data size
  583. * to create the proper skb, so any skb we would create would have
  584. * bogus header and data size, so need care.
  585. * We use a bogus header size to safely detect this condition.
  586. * Another problem is that hw_stopped was set to 0 way before it
  587. * should be, so we would drop this skb. It should now be fixed.
  588. * One option is to not accept data until we are properly setup.
  589. * But, I suspect that when it happens, the ppp line discipline
  590. * just "drops" the data, which might screw up connect scripts.
  591. * The second option is to create a "safe skb", with large header
  592. * and small size (see ircomm_tty_open() for values).
  593. * We just need to make sure that when the real values get filled,
  594. * we don't mess up the original "safe skb" (see tx_data_size).
  595. * Jean II */
  596. if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED) {
  597. IRDA_DEBUG(1, "%s() : not initialised\n", __FUNCTION__);
  598. #ifdef IRCOMM_NO_TX_BEFORE_INIT
  599. /* We didn't consume anything, TTY will retry */
  600. return 0;
  601. #endif
  602. }
  603. if (count < 1)
  604. return 0;
  605. /* Protect our manipulation of self->tx_skb and related */
  606. spin_lock_irqsave(&self->spinlock, flags);
  607. /* Fetch current transmit buffer */
  608. skb = self->tx_skb;
  609. /*
  610. * Send out all the data we get, possibly as multiple fragmented
  611. * frames, but this will only happen if the data is larger than the
  612. * max data size. The normal case however is just the opposite, and
  613. * this function may be called multiple times, and will then actually
  614. * defragment the data and send it out as one packet as soon as
  615. * possible, but at a safer point in time
  616. */
  617. while (count) {
  618. size = count;
  619. /* Adjust data size to the max data size */
  620. if (size > self->max_data_size)
  621. size = self->max_data_size;
  622. /*
  623. * Do we already have a buffer ready for transmit, or do
  624. * we need to allocate a new frame
  625. */
  626. if (skb) {
  627. /*
  628. * Any room for more data at the end of the current
  629. * transmit buffer? Cannot use skb_tailroom, since
  630. * dev_alloc_skb gives us a larger skb than we
  631. * requested
  632. * Note : use tx_data_size, because max_data_size
  633. * may have changed and we don't want to overwrite
  634. * the skb. - Jean II
  635. */
  636. if ((tailroom = (self->tx_data_size - skb->len)) > 0) {
  637. /* Adjust data to tailroom */
  638. if (size > tailroom)
  639. size = tailroom;
  640. } else {
  641. /*
  642. * Current transmit frame is full, so break
  643. * out, so we can send it as soon as possible
  644. */
  645. break;
  646. }
  647. } else {
  648. /* Prepare a full sized frame */
  649. skb = dev_alloc_skb(self->max_data_size+
  650. self->max_header_size);
  651. if (!skb) {
  652. spin_unlock_irqrestore(&self->spinlock, flags);
  653. return -ENOBUFS;
  654. }
  655. skb_reserve(skb, self->max_header_size);
  656. self->tx_skb = skb;
  657. /* Remember skb size because max_data_size may
  658. * change later on - Jean II */
  659. self->tx_data_size = self->max_data_size;
  660. }
  661. /* Copy data */
  662. memcpy(skb_put(skb,size), buf + len, size);
  663. count -= size;
  664. len += size;
  665. }
  666. spin_unlock_irqrestore(&self->spinlock, flags);
  667. /*
  668. * Schedule a new thread which will transmit the frame as soon
  669. * as possible, but at a safe point in time. We do this so the
  670. * "user" can give us data multiple times, as PPP does (because of
  671. * its 256 byte tx buffer). We will then defragment and send out
  672. * all this data as one single packet.
  673. */
  674. schedule_work(&self->tqueue);
  675. return len;
  676. }
  677. /*
  678. * Function ircomm_tty_write_room (tty)
  679. *
  680. * This routine returns the numbers of characters the tty driver will
  681. * accept for queuing to be written. This number is subject to change as
  682. * output buffers get emptied, or if the output flow control is acted.
  683. */
  684. static int ircomm_tty_write_room(struct tty_struct *tty)
  685. {
  686. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  687. unsigned long flags;
  688. int ret;
  689. IRDA_ASSERT(self != NULL, return -1;);
  690. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  691. #ifdef IRCOMM_NO_TX_BEFORE_INIT
  692. /* max_header_size tells us if the channel is initialised or not. */
  693. if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED)
  694. /* Don't bother us yet */
  695. return 0;
  696. #endif
  697. /* Check if we are allowed to transmit any data.
  698. * hw_stopped is the regular flow control.
  699. * Jean II */
  700. if (tty->hw_stopped)
  701. ret = 0;
  702. else {
  703. spin_lock_irqsave(&self->spinlock, flags);
  704. if (self->tx_skb)
  705. ret = self->tx_data_size - self->tx_skb->len;
  706. else
  707. ret = self->max_data_size;
  708. spin_unlock_irqrestore(&self->spinlock, flags);
  709. }
  710. IRDA_DEBUG(2, "%s(), ret=%d\n", __FUNCTION__ , ret);
  711. return ret;
  712. }
  713. /*
  714. * Function ircomm_tty_wait_until_sent (tty, timeout)
  715. *
  716. * This routine waits until the device has written out all of the
  717. * characters in its transmitter FIFO.
  718. */
  719. static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout)
  720. {
  721. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  722. unsigned long orig_jiffies, poll_time;
  723. unsigned long flags;
  724. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  725. IRDA_ASSERT(self != NULL, return;);
  726. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  727. orig_jiffies = jiffies;
  728. /* Set poll time to 200 ms */
  729. poll_time = IRDA_MIN(timeout, msecs_to_jiffies(200));
  730. spin_lock_irqsave(&self->spinlock, flags);
  731. while (self->tx_skb && self->tx_skb->len) {
  732. spin_unlock_irqrestore(&self->spinlock, flags);
  733. schedule_timeout_interruptible(poll_time);
  734. spin_lock_irqsave(&self->spinlock, flags);
  735. if (signal_pending(current))
  736. break;
  737. if (timeout && time_after(jiffies, orig_jiffies + timeout))
  738. break;
  739. }
  740. spin_unlock_irqrestore(&self->spinlock, flags);
  741. current->state = TASK_RUNNING;
  742. }
  743. /*
  744. * Function ircomm_tty_throttle (tty)
  745. *
  746. * This routine notifies the tty driver that input buffers for the line
  747. * discipline are close to full, and it should somehow signal that no
  748. * more characters should be sent to the tty.
  749. */
  750. static void ircomm_tty_throttle(struct tty_struct *tty)
  751. {
  752. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  753. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  754. IRDA_ASSERT(self != NULL, return;);
  755. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  756. /* Software flow control? */
  757. if (I_IXOFF(tty))
  758. ircomm_tty_send_xchar(tty, STOP_CHAR(tty));
  759. /* Hardware flow control? */
  760. if (tty->termios->c_cflag & CRTSCTS) {
  761. self->settings.dte &= ~IRCOMM_RTS;
  762. self->settings.dte |= IRCOMM_DELTA_RTS;
  763. ircomm_param_request(self, IRCOMM_DTE, TRUE);
  764. }
  765. ircomm_flow_request(self->ircomm, FLOW_STOP);
  766. }
  767. /*
  768. * Function ircomm_tty_unthrottle (tty)
  769. *
  770. * This routine notifies the tty drivers that it should signals that
  771. * characters can now be sent to the tty without fear of overrunning the
  772. * input buffers of the line disciplines.
  773. */
  774. static void ircomm_tty_unthrottle(struct tty_struct *tty)
  775. {
  776. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  777. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  778. IRDA_ASSERT(self != NULL, return;);
  779. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  780. /* Using software flow control? */
  781. if (I_IXOFF(tty)) {
  782. ircomm_tty_send_xchar(tty, START_CHAR(tty));
  783. }
  784. /* Using hardware flow control? */
  785. if (tty->termios->c_cflag & CRTSCTS) {
  786. self->settings.dte |= (IRCOMM_RTS|IRCOMM_DELTA_RTS);
  787. ircomm_param_request(self, IRCOMM_DTE, TRUE);
  788. IRDA_DEBUG(1, "%s(), FLOW_START\n", __FUNCTION__ );
  789. }
  790. ircomm_flow_request(self->ircomm, FLOW_START);
  791. }
  792. /*
  793. * Function ircomm_tty_chars_in_buffer (tty)
  794. *
  795. * Indicates if there are any data in the buffer
  796. *
  797. */
  798. static int ircomm_tty_chars_in_buffer(struct tty_struct *tty)
  799. {
  800. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  801. unsigned long flags;
  802. int len = 0;
  803. IRDA_ASSERT(self != NULL, return -1;);
  804. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  805. spin_lock_irqsave(&self->spinlock, flags);
  806. if (self->tx_skb)
  807. len = self->tx_skb->len;
  808. spin_unlock_irqrestore(&self->spinlock, flags);
  809. return len;
  810. }
  811. static void ircomm_tty_shutdown(struct ircomm_tty_cb *self)
  812. {
  813. unsigned long flags;
  814. IRDA_ASSERT(self != NULL, return;);
  815. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  816. IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
  817. if (!test_and_clear_bit(ASYNC_B_INITIALIZED, &self->flags))
  818. return;
  819. ircomm_tty_detach_cable(self);
  820. spin_lock_irqsave(&self->spinlock, flags);
  821. del_timer(&self->watchdog_timer);
  822. /* Free parameter buffer */
  823. if (self->ctrl_skb) {
  824. dev_kfree_skb(self->ctrl_skb);
  825. self->ctrl_skb = NULL;
  826. }
  827. /* Free transmit buffer */
  828. if (self->tx_skb) {
  829. dev_kfree_skb(self->tx_skb);
  830. self->tx_skb = NULL;
  831. }
  832. if (self->ircomm) {
  833. ircomm_close(self->ircomm);
  834. self->ircomm = NULL;
  835. }
  836. spin_unlock_irqrestore(&self->spinlock, flags);
  837. }
  838. /*
  839. * Function ircomm_tty_hangup (tty)
  840. *
  841. * This routine notifies the tty driver that it should hangup the tty
  842. * device.
  843. *
  844. */
  845. static void ircomm_tty_hangup(struct tty_struct *tty)
  846. {
  847. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  848. unsigned long flags;
  849. IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
  850. IRDA_ASSERT(self != NULL, return;);
  851. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  852. if (!tty)
  853. return;
  854. /* ircomm_tty_flush_buffer(tty); */
  855. ircomm_tty_shutdown(self);
  856. /* I guess we need to lock here - Jean II */
  857. spin_lock_irqsave(&self->spinlock, flags);
  858. self->flags &= ~ASYNC_NORMAL_ACTIVE;
  859. self->tty = NULL;
  860. self->open_count = 0;
  861. spin_unlock_irqrestore(&self->spinlock, flags);
  862. wake_up_interruptible(&self->open_wait);
  863. }
  864. /*
  865. * Function ircomm_tty_send_xchar (tty, ch)
  866. *
  867. * This routine is used to send a high-priority XON/XOFF character to
  868. * the device.
  869. */
  870. static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch)
  871. {
  872. IRDA_DEBUG(0, "%s(), not impl\n", __FUNCTION__ );
  873. }
  874. /*
  875. * Function ircomm_tty_start (tty)
  876. *
  877. * This routine notifies the tty driver that it resume sending
  878. * characters to the tty device.
  879. */
  880. void ircomm_tty_start(struct tty_struct *tty)
  881. {
  882. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  883. ircomm_flow_request(self->ircomm, FLOW_START);
  884. }
  885. /*
  886. * Function ircomm_tty_stop (tty)
  887. *
  888. * This routine notifies the tty driver that it should stop outputting
  889. * characters to the tty device.
  890. */
  891. static void ircomm_tty_stop(struct tty_struct *tty)
  892. {
  893. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
  894. IRDA_ASSERT(self != NULL, return;);
  895. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  896. ircomm_flow_request(self->ircomm, FLOW_STOP);
  897. }
  898. /*
  899. * Function ircomm_check_modem_status (self)
  900. *
  901. * Check for any changes in the DCE's line settings. This function should
  902. * be called whenever the dce parameter settings changes, to update the
  903. * flow control settings and other things
  904. */
  905. void ircomm_tty_check_modem_status(struct ircomm_tty_cb *self)
  906. {
  907. struct tty_struct *tty;
  908. int status;
  909. IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
  910. IRDA_ASSERT(self != NULL, return;);
  911. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  912. tty = self->tty;
  913. status = self->settings.dce;
  914. if (status & IRCOMM_DCE_DELTA_ANY) {
  915. /*wake_up_interruptible(&self->delta_msr_wait);*/
  916. }
  917. if ((self->flags & ASYNC_CHECK_CD) && (status & IRCOMM_DELTA_CD)) {
  918. IRDA_DEBUG(2,
  919. "%s(), ircomm%d CD now %s...\n", __FUNCTION__ , self->line,
  920. (status & IRCOMM_CD) ? "on" : "off");
  921. if (status & IRCOMM_CD) {
  922. wake_up_interruptible(&self->open_wait);
  923. } else {
  924. IRDA_DEBUG(2,
  925. "%s(), Doing serial hangup..\n", __FUNCTION__ );
  926. if (tty)
  927. tty_hangup(tty);
  928. /* Hangup will remote the tty, so better break out */
  929. return;
  930. }
  931. }
  932. if (self->flags & ASYNC_CTS_FLOW) {
  933. if (tty->hw_stopped) {
  934. if (status & IRCOMM_CTS) {
  935. IRDA_DEBUG(2,
  936. "%s(), CTS tx start...\n", __FUNCTION__ );
  937. tty->hw_stopped = 0;
  938. /* Wake up processes blocked on open */
  939. wake_up_interruptible(&self->open_wait);
  940. schedule_work(&self->tqueue);
  941. return;
  942. }
  943. } else {
  944. if (!(status & IRCOMM_CTS)) {
  945. IRDA_DEBUG(2,
  946. "%s(), CTS tx stop...\n", __FUNCTION__ );
  947. tty->hw_stopped = 1;
  948. }
  949. }
  950. }
  951. }
  952. /*
  953. * Function ircomm_tty_data_indication (instance, sap, skb)
  954. *
  955. * Handle incoming data, and deliver it to the line discipline
  956. *
  957. */
  958. static int ircomm_tty_data_indication(void *instance, void *sap,
  959. struct sk_buff *skb)
  960. {
  961. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
  962. IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
  963. IRDA_ASSERT(self != NULL, return -1;);
  964. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  965. IRDA_ASSERT(skb != NULL, return -1;);
  966. if (!self->tty) {
  967. IRDA_DEBUG(0, "%s(), no tty!\n", __FUNCTION__ );
  968. return 0;
  969. }
  970. /*
  971. * If we receive data when hardware is stopped then something is wrong.
  972. * We try to poll the peers line settings to check if we are up todate.
  973. * Devices like WinCE can do this, and since they don't send any
  974. * params, we can just as well declare the hardware for running.
  975. */
  976. if (self->tty->hw_stopped && (self->flow == FLOW_START)) {
  977. IRDA_DEBUG(0, "%s(), polling for line settings!\n", __FUNCTION__ );
  978. ircomm_param_request(self, IRCOMM_POLL, TRUE);
  979. /* We can just as well declare the hardware for running */
  980. ircomm_tty_send_initial_parameters(self);
  981. ircomm_tty_link_established(self);
  982. }
  983. /*
  984. * Just give it over to the line discipline. There is no need to
  985. * involve the flip buffers, since we are not running in an interrupt
  986. * handler
  987. */
  988. self->tty->ldisc.receive_buf(self->tty, skb->data, NULL, skb->len);
  989. /* No need to kfree_skb - see ircomm_ttp_data_indication() */
  990. return 0;
  991. }
  992. /*
  993. * Function ircomm_tty_control_indication (instance, sap, skb)
  994. *
  995. * Parse all incoming parameters (easy!)
  996. *
  997. */
  998. static int ircomm_tty_control_indication(void *instance, void *sap,
  999. struct sk_buff *skb)
  1000. {
  1001. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
  1002. int clen;
  1003. IRDA_DEBUG(4, "%s()\n", __FUNCTION__ );
  1004. IRDA_ASSERT(self != NULL, return -1;);
  1005. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
  1006. IRDA_ASSERT(skb != NULL, return -1;);
  1007. clen = skb->data[0];
  1008. irda_param_extract_all(self, skb->data+1, IRDA_MIN(skb->len-1, clen),
  1009. &ircomm_param_info);
  1010. /* No need to kfree_skb - see ircomm_control_indication() */
  1011. return 0;
  1012. }
  1013. /*
  1014. * Function ircomm_tty_flow_indication (instance, sap, cmd)
  1015. *
  1016. * This function is called by IrTTP when it wants us to slow down the
  1017. * transmission of data. We just mark the hardware as stopped, and wait
  1018. * for IrTTP to notify us that things are OK again.
  1019. */
  1020. static void ircomm_tty_flow_indication(void *instance, void *sap,
  1021. LOCAL_FLOW cmd)
  1022. {
  1023. struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
  1024. struct tty_struct *tty;
  1025. IRDA_ASSERT(self != NULL, return;);
  1026. IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
  1027. tty = self->tty;
  1028. switch (cmd) {
  1029. case FLOW_START:
  1030. IRDA_DEBUG(2, "%s(), hw start!\n", __FUNCTION__ );
  1031. tty->hw_stopped = 0;
  1032. /* ircomm_tty_do_softint will take care of the rest */
  1033. schedule_work(&self->tqueue);
  1034. break;
  1035. default: /* If we get here, something is very wrong, better stop */
  1036. case FLOW_STOP:
  1037. IRDA_DEBUG(2, "%s(), hw stopped!\n", __FUNCTION__ );
  1038. tty->hw_stopped = 1;
  1039. break;
  1040. }
  1041. self->flow = cmd;
  1042. }
  1043. static int ircomm_tty_line_info(struct ircomm_tty_cb *self, char *buf)
  1044. {
  1045. int ret=0;
  1046. ret += sprintf(buf+ret, "State: %s\n", ircomm_tty_state[self->state]);
  1047. ret += sprintf(buf+ret, "Service type: ");
  1048. if (self->service_type & IRCOMM_9_WIRE)
  1049. ret += sprintf(buf+ret, "9_WIRE");
  1050. else if (self->service_type & IRCOMM_3_WIRE)
  1051. ret += sprintf(buf+ret, "3_WIRE");
  1052. else if (self->service_type & IRCOMM_3_WIRE_RAW)
  1053. ret += sprintf(buf+ret, "3_WIRE_RAW");
  1054. else
  1055. ret += sprintf(buf+ret, "No common service type!\n");
  1056. ret += sprintf(buf+ret, "\n");
  1057. ret += sprintf(buf+ret, "Port name: %s\n", self->settings.port_name);
  1058. ret += sprintf(buf+ret, "DTE status: ");
  1059. if (self->settings.dte & IRCOMM_RTS)
  1060. ret += sprintf(buf+ret, "RTS|");
  1061. if (self->settings.dte & IRCOMM_DTR)
  1062. ret += sprintf(buf+ret, "DTR|");
  1063. if (self->settings.dte)
  1064. ret--; /* remove the last | */
  1065. ret += sprintf(buf+ret, "\n");
  1066. ret += sprintf(buf+ret, "DCE status: ");
  1067. if (self->settings.dce & IRCOMM_CTS)
  1068. ret += sprintf(buf+ret, "CTS|");
  1069. if (self->settings.dce & IRCOMM_DSR)
  1070. ret += sprintf(buf+ret, "DSR|");
  1071. if (self->settings.dce & IRCOMM_CD)
  1072. ret += sprintf(buf+ret, "CD|");
  1073. if (self->settings.dce & IRCOMM_RI)
  1074. ret += sprintf(buf+ret, "RI|");
  1075. if (self->settings.dce)
  1076. ret--; /* remove the last | */
  1077. ret += sprintf(buf+ret, "\n");
  1078. ret += sprintf(buf+ret, "Configuration: ");
  1079. if (!self->settings.null_modem)
  1080. ret += sprintf(buf+ret, "DTE <-> DCE\n");
  1081. else
  1082. ret += sprintf(buf+ret,
  1083. "DTE <-> DTE (null modem emulation)\n");
  1084. ret += sprintf(buf+ret, "Data rate: %d\n", self->settings.data_rate);
  1085. ret += sprintf(buf+ret, "Flow control: ");
  1086. if (self->settings.flow_control & IRCOMM_XON_XOFF_IN)
  1087. ret += sprintf(buf+ret, "XON_XOFF_IN|");
  1088. if (self->settings.flow_control & IRCOMM_XON_XOFF_OUT)
  1089. ret += sprintf(buf+ret, "XON_XOFF_OUT|");
  1090. if (self->settings.flow_control & IRCOMM_RTS_CTS_IN)
  1091. ret += sprintf(buf+ret, "RTS_CTS_IN|");
  1092. if (self->settings.flow_control & IRCOMM_RTS_CTS_OUT)
  1093. ret += sprintf(buf+ret, "RTS_CTS_OUT|");
  1094. if (self->settings.flow_control & IRCOMM_DSR_DTR_IN)
  1095. ret += sprintf(buf+ret, "DSR_DTR_IN|");
  1096. if (self->settings.flow_control & IRCOMM_DSR_DTR_OUT)
  1097. ret += sprintf(buf+ret, "DSR_DTR_OUT|");
  1098. if (self->settings.flow_control & IRCOMM_ENQ_ACK_IN)
  1099. ret += sprintf(buf+ret, "ENQ_ACK_IN|");
  1100. if (self->settings.flow_control & IRCOMM_ENQ_ACK_OUT)
  1101. ret += sprintf(buf+ret, "ENQ_ACK_OUT|");
  1102. if (self->settings.flow_control)
  1103. ret--; /* remove the last | */
  1104. ret += sprintf(buf+ret, "\n");
  1105. ret += sprintf(buf+ret, "Flags: ");
  1106. if (self->flags & ASYNC_CTS_FLOW)
  1107. ret += sprintf(buf+ret, "ASYNC_CTS_FLOW|");
  1108. if (self->flags & ASYNC_CHECK_CD)
  1109. ret += sprintf(buf+ret, "ASYNC_CHECK_CD|");
  1110. if (self->flags & ASYNC_INITIALIZED)
  1111. ret += sprintf(buf+ret, "ASYNC_INITIALIZED|");
  1112. if (self->flags & ASYNC_LOW_LATENCY)
  1113. ret += sprintf(buf+ret, "ASYNC_LOW_LATENCY|");
  1114. if (self->flags & ASYNC_CLOSING)
  1115. ret += sprintf(buf+ret, "ASYNC_CLOSING|");
  1116. if (self->flags & ASYNC_NORMAL_ACTIVE)
  1117. ret += sprintf(buf+ret, "ASYNC_NORMAL_ACTIVE|");
  1118. if (self->flags)
  1119. ret--; /* remove the last | */
  1120. ret += sprintf(buf+ret, "\n");
  1121. ret += sprintf(buf+ret, "Role: %s\n", self->client ?
  1122. "client" : "server");
  1123. ret += sprintf(buf+ret, "Open count: %d\n", self->open_count);
  1124. ret += sprintf(buf+ret, "Max data size: %d\n", self->max_data_size);
  1125. ret += sprintf(buf+ret, "Max header size: %d\n", self->max_header_size);
  1126. if (self->tty)
  1127. ret += sprintf(buf+ret, "Hardware: %s\n",
  1128. self->tty->hw_stopped ? "Stopped" : "Running");
  1129. ret += sprintf(buf+ret, "\n");
  1130. return ret;
  1131. }
  1132. /*
  1133. * Function ircomm_tty_read_proc (buf, start, offset, len, eof, unused)
  1134. *
  1135. *
  1136. *
  1137. */
  1138. #ifdef CONFIG_PROC_FS
  1139. static int ircomm_tty_read_proc(char *buf, char **start, off_t offset, int len,
  1140. int *eof, void *unused)
  1141. {
  1142. struct ircomm_tty_cb *self;
  1143. int count = 0, l;
  1144. off_t begin = 0;
  1145. unsigned long flags;
  1146. spin_lock_irqsave(&ircomm_tty->hb_spinlock, flags);
  1147. self = (struct ircomm_tty_cb *) hashbin_get_first(ircomm_tty);
  1148. while ((self != NULL) && (count < 4000)) {
  1149. if (self->magic != IRCOMM_TTY_MAGIC)
  1150. break;
  1151. l = ircomm_tty_line_info(self, buf + count);
  1152. count += l;
  1153. if (count+begin > offset+len)
  1154. goto done;
  1155. if (count+begin < offset) {
  1156. begin += count;
  1157. count = 0;
  1158. }
  1159. self = (struct ircomm_tty_cb *) hashbin_get_next(ircomm_tty);
  1160. }
  1161. *eof = 1;
  1162. done:
  1163. spin_unlock_irqrestore(&ircomm_tty->hb_spinlock, flags);
  1164. if (offset >= count+begin)
  1165. return 0;
  1166. *start = buf + (offset-begin);
  1167. return ((len < begin+count-offset) ? len : begin+count-offset);
  1168. }
  1169. #endif /* CONFIG_PROC_FS */
  1170. MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>");
  1171. MODULE_DESCRIPTION("IrCOMM serial TTY driver");
  1172. MODULE_LICENSE("GPL");
  1173. MODULE_ALIAS_CHARDEV_MAJOR(IRCOMM_TTY_MAJOR);
  1174. module_init(ircomm_tty_init);
  1175. module_exit(ircomm_tty_cleanup);