ircomm_tty.c 40 KB

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