1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31#include <linux/init.h>
32#include <linux/module.h>
33#include <linux/fs.h>
34#include <linux/slab.h>
35#include <linux/sched.h>
36#include <linux/seq_file.h>
37#include <linux/termios.h>
38#include <linux/tty.h>
39#include <linux/tty_flip.h>
40#include <linux/interrupt.h>
41#include <linux/device.h>
42
43#include <asm/uaccess.h>
44
45#include <net/irda/irda.h>
46#include <net/irda/irmod.h>
47
48#include <net/irda/ircomm_core.h>
49#include <net/irda/ircomm_param.h>
50#include <net/irda/ircomm_tty_attach.h>
51#include <net/irda/ircomm_tty.h>
52
53static int ircomm_tty_install(struct tty_driver *driver,
54 struct tty_struct *tty);
55static int ircomm_tty_open(struct tty_struct *tty, struct file *filp);
56static void ircomm_tty_close(struct tty_struct * tty, struct file *filp);
57static int ircomm_tty_write(struct tty_struct * tty,
58 const unsigned char *buf, int count);
59static int ircomm_tty_write_room(struct tty_struct *tty);
60static void ircomm_tty_throttle(struct tty_struct *tty);
61static void ircomm_tty_unthrottle(struct tty_struct *tty);
62static int ircomm_tty_chars_in_buffer(struct tty_struct *tty);
63static void ircomm_tty_flush_buffer(struct tty_struct *tty);
64static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch);
65static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout);
66static void ircomm_tty_hangup(struct tty_struct *tty);
67static void ircomm_tty_do_softint(struct work_struct *work);
68static void ircomm_tty_shutdown(struct ircomm_tty_cb *self);
69static void ircomm_tty_stop(struct tty_struct *tty);
70
71static int ircomm_tty_data_indication(void *instance, void *sap,
72 struct sk_buff *skb);
73static int ircomm_tty_control_indication(void *instance, void *sap,
74 struct sk_buff *skb);
75static void ircomm_tty_flow_indication(void *instance, void *sap,
76 LOCAL_FLOW cmd);
77#ifdef CONFIG_PROC_FS
78static const struct file_operations ircomm_tty_proc_fops;
79#endif
80static struct tty_driver *driver;
81
82static hashbin_t *ircomm_tty = NULL;
83
84static const struct tty_operations ops = {
85 .install = ircomm_tty_install,
86 .open = ircomm_tty_open,
87 .close = ircomm_tty_close,
88 .write = ircomm_tty_write,
89 .write_room = ircomm_tty_write_room,
90 .chars_in_buffer = ircomm_tty_chars_in_buffer,
91 .flush_buffer = ircomm_tty_flush_buffer,
92 .ioctl = ircomm_tty_ioctl,
93 .tiocmget = ircomm_tty_tiocmget,
94 .tiocmset = ircomm_tty_tiocmset,
95 .throttle = ircomm_tty_throttle,
96 .unthrottle = ircomm_tty_unthrottle,
97 .send_xchar = ircomm_tty_send_xchar,
98 .set_termios = ircomm_tty_set_termios,
99 .stop = ircomm_tty_stop,
100 .start = ircomm_tty_start,
101 .hangup = ircomm_tty_hangup,
102 .wait_until_sent = ircomm_tty_wait_until_sent,
103#ifdef CONFIG_PROC_FS
104 .proc_fops = &ircomm_tty_proc_fops,
105#endif
106};
107
108static void ircomm_port_raise_dtr_rts(struct tty_port *port, int raise)
109{
110 struct ircomm_tty_cb *self = container_of(port, struct ircomm_tty_cb,
111 port);
112
113
114
115
116
117 if (raise)
118 self->settings.dte |= IRCOMM_RTS | IRCOMM_DTR;
119 else
120 self->settings.dte &= ~(IRCOMM_RTS | IRCOMM_DTR);
121
122 ircomm_param_request(self, IRCOMM_DTE, TRUE);
123}
124
125static int ircomm_port_carrier_raised(struct tty_port *port)
126{
127 struct ircomm_tty_cb *self = container_of(port, struct ircomm_tty_cb,
128 port);
129 return self->settings.dce & IRCOMM_CD;
130}
131
132static const struct tty_port_operations ircomm_port_ops = {
133 .dtr_rts = ircomm_port_raise_dtr_rts,
134 .carrier_raised = ircomm_port_carrier_raised,
135};
136
137
138
139
140
141
142
143static int __init ircomm_tty_init(void)
144{
145 driver = alloc_tty_driver(IRCOMM_TTY_PORTS);
146 if (!driver)
147 return -ENOMEM;
148 ircomm_tty = hashbin_new(HB_LOCK);
149 if (ircomm_tty == NULL) {
150 net_err_ratelimited("%s(), can't allocate hashbin!\n",
151 __func__);
152 put_tty_driver(driver);
153 return -ENOMEM;
154 }
155
156 driver->driver_name = "ircomm";
157 driver->name = "ircomm";
158 driver->major = IRCOMM_TTY_MAJOR;
159 driver->minor_start = IRCOMM_TTY_MINOR;
160 driver->type = TTY_DRIVER_TYPE_SERIAL;
161 driver->subtype = SERIAL_TYPE_NORMAL;
162 driver->init_termios = tty_std_termios;
163 driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
164 driver->flags = TTY_DRIVER_REAL_RAW;
165 tty_set_operations(driver, &ops);
166 if (tty_register_driver(driver)) {
167 net_err_ratelimited("%s(): Couldn't register serial driver\n",
168 __func__);
169 put_tty_driver(driver);
170 return -1;
171 }
172 return 0;
173}
174
175static void __exit __ircomm_tty_cleanup(struct ircomm_tty_cb *self)
176{
177 IRDA_ASSERT(self != NULL, return;);
178 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
179
180 ircomm_tty_shutdown(self);
181
182 self->magic = 0;
183 tty_port_destroy(&self->port);
184 kfree(self);
185}
186
187
188
189
190
191
192
193static void __exit ircomm_tty_cleanup(void)
194{
195 int ret;
196
197 ret = tty_unregister_driver(driver);
198 if (ret) {
199 net_err_ratelimited("%s(), failed to unregister driver\n",
200 __func__);
201 return;
202 }
203
204 hashbin_delete(ircomm_tty, (FREE_FUNC) __ircomm_tty_cleanup);
205 put_tty_driver(driver);
206}
207
208
209
210
211
212
213
214static int ircomm_tty_startup(struct ircomm_tty_cb *self)
215{
216 notify_t notify;
217 int ret = -ENODEV;
218
219 IRDA_ASSERT(self != NULL, return -1;);
220 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
221
222
223 if (test_and_set_bit(ASYNCB_INITIALIZED, &self->port.flags)) {
224 pr_debug("%s(), already open so break out!\n", __func__);
225 return 0;
226 }
227
228
229 irda_notify_init(¬ify);
230
231 notify.data_indication = ircomm_tty_data_indication;
232 notify.udata_indication = ircomm_tty_control_indication;
233 notify.flow_indication = ircomm_tty_flow_indication;
234
235
236 notify.disconnect_indication = ircomm_tty_disconnect_indication;
237 notify.connect_confirm = ircomm_tty_connect_confirm;
238 notify.connect_indication = ircomm_tty_connect_indication;
239 strlcpy(notify.name, "ircomm_tty", sizeof(notify.name));
240 notify.instance = self;
241
242 if (!self->ircomm) {
243 self->ircomm = ircomm_open(¬ify, self->service_type,
244 self->line);
245 }
246 if (!self->ircomm)
247 goto err;
248
249 self->slsap_sel = self->ircomm->slsap_sel;
250
251
252 ret = ircomm_tty_attach_cable(self);
253 if (ret < 0) {
254 net_err_ratelimited("%s(), error attaching cable!\n", __func__);
255 goto err;
256 }
257
258 return 0;
259err:
260 clear_bit(ASYNCB_INITIALIZED, &self->port.flags);
261 return ret;
262}
263
264
265
266
267
268
269
270static int ircomm_tty_block_til_ready(struct ircomm_tty_cb *self,
271 struct tty_struct *tty, struct file *filp)
272{
273 struct tty_port *port = &self->port;
274 DECLARE_WAITQUEUE(wait, current);
275 int retval;
276 int do_clocal = 0;
277 unsigned long flags;
278
279
280
281
282
283 if (test_bit(TTY_IO_ERROR, &tty->flags)) {
284 port->flags |= ASYNC_NORMAL_ACTIVE;
285 return 0;
286 }
287
288 if (filp->f_flags & O_NONBLOCK) {
289
290 if (C_BAUD(tty))
291 tty_port_raise_dtr_rts(port);
292 port->flags |= ASYNC_NORMAL_ACTIVE;
293 pr_debug("%s(), O_NONBLOCK requested!\n", __func__);
294 return 0;
295 }
296
297 if (C_CLOCAL(tty)) {
298 pr_debug("%s(), doing CLOCAL!\n", __func__);
299 do_clocal = 1;
300 }
301
302
303
304
305
306
307
308
309 retval = 0;
310 add_wait_queue(&port->open_wait, &wait);
311
312 pr_debug("%s(%d):block_til_ready before block on %s open_count=%d\n",
313 __FILE__, __LINE__, tty->driver->name, port->count);
314
315 spin_lock_irqsave(&port->lock, flags);
316 port->count--;
317 port->blocked_open++;
318 spin_unlock_irqrestore(&port->lock, flags);
319
320 while (1) {
321 if (C_BAUD(tty) && test_bit(ASYNCB_INITIALIZED, &port->flags))
322 tty_port_raise_dtr_rts(port);
323
324 set_current_state(TASK_INTERRUPTIBLE);
325
326 if (tty_hung_up_p(filp) ||
327 !test_bit(ASYNCB_INITIALIZED, &port->flags)) {
328 retval = (port->flags & ASYNC_HUP_NOTIFY) ?
329 -EAGAIN : -ERESTARTSYS;
330 break;
331 }
332
333
334
335
336
337
338 if ((do_clocal || tty_port_carrier_raised(port)) &&
339 self->state == IRCOMM_TTY_READY)
340 {
341 break;
342 }
343
344 if (signal_pending(current)) {
345 retval = -ERESTARTSYS;
346 break;
347 }
348
349 pr_debug("%s(%d):block_til_ready blocking on %s open_count=%d\n",
350 __FILE__, __LINE__, tty->driver->name, port->count);
351
352 schedule();
353 }
354
355 __set_current_state(TASK_RUNNING);
356 remove_wait_queue(&port->open_wait, &wait);
357
358 spin_lock_irqsave(&port->lock, flags);
359 if (!tty_hung_up_p(filp))
360 port->count++;
361 port->blocked_open--;
362 spin_unlock_irqrestore(&port->lock, flags);
363
364 pr_debug("%s(%d):block_til_ready after blocking on %s open_count=%d\n",
365 __FILE__, __LINE__, tty->driver->name, port->count);
366
367 if (!retval)
368 port->flags |= ASYNC_NORMAL_ACTIVE;
369
370 return retval;
371}
372
373
374static int ircomm_tty_install(struct tty_driver *driver, struct tty_struct *tty)
375{
376 struct ircomm_tty_cb *self;
377 unsigned int line = tty->index;
378
379
380 self = hashbin_lock_find(ircomm_tty, line, NULL);
381 if (!self) {
382
383 self = kzalloc(sizeof(struct ircomm_tty_cb), GFP_KERNEL);
384 if (self == NULL)
385 return -ENOMEM;
386
387 tty_port_init(&self->port);
388 self->port.ops = &ircomm_port_ops;
389 self->magic = IRCOMM_TTY_MAGIC;
390 self->flow = FLOW_STOP;
391
392 self->line = line;
393 INIT_WORK(&self->tqueue, ircomm_tty_do_softint);
394 self->max_header_size = IRCOMM_TTY_HDR_UNINITIALISED;
395 self->max_data_size = IRCOMM_TTY_DATA_UNINITIALISED;
396
397
398 init_timer(&self->watchdog_timer);
399 spin_lock_init(&self->spinlock);
400
401
402
403
404
405
406
407
408 tty->termios.c_iflag = 0;
409 tty->termios.c_oflag = 0;
410
411
412 hashbin_insert(ircomm_tty, (irda_queue_t *) self, line, NULL);
413 }
414
415 tty->driver_data = self;
416
417 return tty_port_install(&self->port, driver, tty);
418}
419
420
421
422
423
424
425
426
427static int ircomm_tty_open(struct tty_struct *tty, struct file *filp)
428{
429 struct ircomm_tty_cb *self = tty->driver_data;
430 unsigned long flags;
431 int ret;
432
433
434 spin_lock_irqsave(&self->port.lock, flags);
435 self->port.count++;
436 spin_unlock_irqrestore(&self->port.lock, flags);
437 tty_port_tty_set(&self->port, tty);
438
439 pr_debug("%s(), %s%d, count = %d\n", __func__ , tty->driver->name,
440 self->line, self->port.count);
441
442
443 self->port.low_latency = (self->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0;
444
445
446 if (self->line < 0x10) {
447 self->service_type = IRCOMM_3_WIRE | IRCOMM_9_WIRE;
448 self->settings.service_type = IRCOMM_9_WIRE;
449
450 self->settings.dce = IRCOMM_CTS | IRCOMM_CD | IRCOMM_DSR | IRCOMM_RI;
451 pr_debug("%s(), IrCOMM device\n", __func__);
452 } else {
453 pr_debug("%s(), IrLPT device\n", __func__);
454 self->service_type = IRCOMM_3_WIRE_RAW;
455 self->settings.service_type = IRCOMM_3_WIRE_RAW;
456 }
457
458 ret = ircomm_tty_startup(self);
459 if (ret)
460 return ret;
461
462 ret = ircomm_tty_block_til_ready(self, tty, filp);
463 if (ret) {
464 pr_debug("%s(), returning after block_til_ready with %d\n",
465 __func__, ret);
466
467 return ret;
468 }
469 return 0;
470}
471
472
473
474
475
476
477
478static void ircomm_tty_close(struct tty_struct *tty, struct file *filp)
479{
480 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
481 struct tty_port *port = &self->port;
482
483 IRDA_ASSERT(self != NULL, return;);
484 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
485
486 if (tty_port_close_start(port, tty, filp) == 0)
487 return;
488
489 ircomm_tty_shutdown(self);
490
491 tty_driver_flush_buffer(tty);
492
493 tty_port_close_end(port, tty);
494 tty_port_tty_set(port, NULL);
495}
496
497
498
499
500
501
502
503static void ircomm_tty_flush_buffer(struct tty_struct *tty)
504{
505 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
506
507 IRDA_ASSERT(self != NULL, return;);
508 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
509
510
511
512
513
514 schedule_work(&self->tqueue);
515}
516
517
518
519
520
521
522
523
524static void ircomm_tty_do_softint(struct work_struct *work)
525{
526 struct ircomm_tty_cb *self =
527 container_of(work, struct ircomm_tty_cb, tqueue);
528 struct tty_struct *tty;
529 unsigned long flags;
530 struct sk_buff *skb, *ctrl_skb;
531
532 if (!self || self->magic != IRCOMM_TTY_MAGIC)
533 return;
534
535 tty = tty_port_tty_get(&self->port);
536 if (!tty)
537 return;
538
539
540 spin_lock_irqsave(&self->spinlock, flags);
541
542 ctrl_skb = self->ctrl_skb;
543 self->ctrl_skb = NULL;
544
545 spin_unlock_irqrestore(&self->spinlock, flags);
546
547
548 if(ctrl_skb) {
549 if(self->flow == FLOW_START)
550 ircomm_control_request(self->ircomm, ctrl_skb);
551
552 dev_kfree_skb(ctrl_skb);
553 }
554
555 if (tty->hw_stopped)
556 goto put;
557
558
559 spin_lock_irqsave(&self->spinlock, flags);
560
561 skb = self->tx_skb;
562 self->tx_skb = NULL;
563
564 spin_unlock_irqrestore(&self->spinlock, flags);
565
566
567 if (skb) {
568 ircomm_tty_do_event(self, IRCOMM_TTY_DATA_REQUEST, skb, NULL);
569
570 dev_kfree_skb(skb);
571 }
572
573
574 tty_wakeup(tty);
575put:
576 tty_kref_put(tty);
577}
578
579
580
581
582
583
584
585
586
587static int ircomm_tty_write(struct tty_struct *tty,
588 const unsigned char *buf, int count)
589{
590 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
591 unsigned long flags;
592 struct sk_buff *skb;
593 int tailroom = 0;
594 int len = 0;
595 int size;
596
597 pr_debug("%s(), count=%d, hw_stopped=%d\n", __func__ , count,
598 tty->hw_stopped);
599
600 IRDA_ASSERT(self != NULL, return -1;);
601 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619 if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED) {
620 pr_debug("%s() : not initialised\n", __func__);
621#ifdef IRCOMM_NO_TX_BEFORE_INIT
622
623 return 0;
624#endif
625 }
626
627 if (count < 1)
628 return 0;
629
630
631 spin_lock_irqsave(&self->spinlock, flags);
632
633
634 skb = self->tx_skb;
635
636
637
638
639
640
641
642
643
644 while (count) {
645 size = count;
646
647
648 if (size > self->max_data_size)
649 size = self->max_data_size;
650
651
652
653
654
655 if (skb) {
656
657
658
659
660
661
662
663
664
665 if ((tailroom = (self->tx_data_size - skb->len)) > 0) {
666
667 if (size > tailroom)
668 size = tailroom;
669 } else {
670
671
672
673
674 break;
675 }
676 } else {
677
678 skb = alloc_skb(self->max_data_size+
679 self->max_header_size,
680 GFP_ATOMIC);
681 if (!skb) {
682 spin_unlock_irqrestore(&self->spinlock, flags);
683 return -ENOBUFS;
684 }
685 skb_reserve(skb, self->max_header_size);
686 self->tx_skb = skb;
687
688
689 self->tx_data_size = self->max_data_size;
690 }
691
692
693 memcpy(skb_put(skb,size), buf + len, size);
694
695 count -= size;
696 len += size;
697 }
698
699 spin_unlock_irqrestore(&self->spinlock, flags);
700
701
702
703
704
705
706
707
708 schedule_work(&self->tqueue);
709
710 return len;
711}
712
713
714
715
716
717
718
719
720static int ircomm_tty_write_room(struct tty_struct *tty)
721{
722 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
723 unsigned long flags;
724 int ret;
725
726 IRDA_ASSERT(self != NULL, return -1;);
727 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
728
729#ifdef IRCOMM_NO_TX_BEFORE_INIT
730
731 if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED)
732
733 return 0;
734#endif
735
736
737
738
739 if (tty->hw_stopped)
740 ret = 0;
741 else {
742 spin_lock_irqsave(&self->spinlock, flags);
743 if (self->tx_skb)
744 ret = self->tx_data_size - self->tx_skb->len;
745 else
746 ret = self->max_data_size;
747 spin_unlock_irqrestore(&self->spinlock, flags);
748 }
749 pr_debug("%s(), ret=%d\n", __func__ , ret);
750
751 return ret;
752}
753
754
755
756
757
758
759
760static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout)
761{
762 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
763 unsigned long orig_jiffies, poll_time;
764 unsigned long flags;
765
766 IRDA_ASSERT(self != NULL, return;);
767 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
768
769 orig_jiffies = jiffies;
770
771
772 poll_time = msecs_to_jiffies(200);
773 if (timeout)
774 poll_time = min_t(unsigned long, timeout, poll_time);
775
776 spin_lock_irqsave(&self->spinlock, flags);
777 while (self->tx_skb && self->tx_skb->len) {
778 spin_unlock_irqrestore(&self->spinlock, flags);
779 schedule_timeout_interruptible(poll_time);
780 spin_lock_irqsave(&self->spinlock, flags);
781 if (signal_pending(current))
782 break;
783 if (timeout && time_after(jiffies, orig_jiffies + timeout))
784 break;
785 }
786 spin_unlock_irqrestore(&self->spinlock, flags);
787 __set_current_state(TASK_RUNNING);
788}
789
790
791
792
793
794
795
796
797static void ircomm_tty_throttle(struct tty_struct *tty)
798{
799 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
800
801 IRDA_ASSERT(self != NULL, return;);
802 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
803
804
805 if (I_IXOFF(tty))
806 ircomm_tty_send_xchar(tty, STOP_CHAR(tty));
807
808
809 if (C_CRTSCTS(tty)) {
810 self->settings.dte &= ~IRCOMM_RTS;
811 self->settings.dte |= IRCOMM_DELTA_RTS;
812
813 ircomm_param_request(self, IRCOMM_DTE, TRUE);
814 }
815
816 ircomm_flow_request(self->ircomm, FLOW_STOP);
817}
818
819
820
821
822
823
824
825
826static void ircomm_tty_unthrottle(struct tty_struct *tty)
827{
828 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
829
830 IRDA_ASSERT(self != NULL, return;);
831 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
832
833
834 if (I_IXOFF(tty))
835 ircomm_tty_send_xchar(tty, START_CHAR(tty));
836
837
838 if (C_CRTSCTS(tty)) {
839 self->settings.dte |= (IRCOMM_RTS|IRCOMM_DELTA_RTS);
840
841 ircomm_param_request(self, IRCOMM_DTE, TRUE);
842 pr_debug("%s(), FLOW_START\n", __func__);
843 }
844 ircomm_flow_request(self->ircomm, FLOW_START);
845}
846
847
848
849
850
851
852
853static int ircomm_tty_chars_in_buffer(struct tty_struct *tty)
854{
855 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
856 unsigned long flags;
857 int len = 0;
858
859 IRDA_ASSERT(self != NULL, return -1;);
860 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
861
862 spin_lock_irqsave(&self->spinlock, flags);
863
864 if (self->tx_skb)
865 len = self->tx_skb->len;
866
867 spin_unlock_irqrestore(&self->spinlock, flags);
868
869 return len;
870}
871
872static void ircomm_tty_shutdown(struct ircomm_tty_cb *self)
873{
874 unsigned long flags;
875
876 IRDA_ASSERT(self != NULL, return;);
877 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
878
879 if (!test_and_clear_bit(ASYNCB_INITIALIZED, &self->port.flags))
880 return;
881
882 ircomm_tty_detach_cable(self);
883
884 spin_lock_irqsave(&self->spinlock, flags);
885
886 del_timer(&self->watchdog_timer);
887
888
889 if (self->ctrl_skb) {
890 dev_kfree_skb(self->ctrl_skb);
891 self->ctrl_skb = NULL;
892 }
893
894
895 if (self->tx_skb) {
896 dev_kfree_skb(self->tx_skb);
897 self->tx_skb = NULL;
898 }
899
900 if (self->ircomm) {
901 ircomm_close(self->ircomm);
902 self->ircomm = NULL;
903 }
904
905 spin_unlock_irqrestore(&self->spinlock, flags);
906}
907
908
909
910
911
912
913
914
915static void ircomm_tty_hangup(struct tty_struct *tty)
916{
917 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
918 struct tty_port *port = &self->port;
919 unsigned long flags;
920
921 IRDA_ASSERT(self != NULL, return;);
922 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
923
924
925 ircomm_tty_shutdown(self);
926
927 spin_lock_irqsave(&port->lock, flags);
928 port->flags &= ~ASYNC_NORMAL_ACTIVE;
929 if (port->tty) {
930 set_bit(TTY_IO_ERROR, &port->tty->flags);
931 tty_kref_put(port->tty);
932 }
933 port->tty = NULL;
934 port->count = 0;
935 spin_unlock_irqrestore(&port->lock, flags);
936
937 wake_up_interruptible(&port->open_wait);
938}
939
940
941
942
943
944
945
946static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch)
947{
948 pr_debug("%s(), not impl\n", __func__);
949}
950
951
952
953
954
955
956
957void ircomm_tty_start(struct tty_struct *tty)
958{
959 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
960
961 ircomm_flow_request(self->ircomm, FLOW_START);
962}
963
964
965
966
967
968
969
970static void ircomm_tty_stop(struct tty_struct *tty)
971{
972 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
973
974 IRDA_ASSERT(self != NULL, return;);
975 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
976
977 ircomm_flow_request(self->ircomm, FLOW_STOP);
978}
979
980
981
982
983
984
985
986
987void ircomm_tty_check_modem_status(struct ircomm_tty_cb *self)
988{
989 struct tty_struct *tty;
990 int status;
991
992 IRDA_ASSERT(self != NULL, return;);
993 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
994
995 tty = tty_port_tty_get(&self->port);
996
997 status = self->settings.dce;
998
999 if (status & IRCOMM_DCE_DELTA_ANY) {
1000
1001 }
1002 if ((self->port.flags & ASYNC_CHECK_CD) && (status & IRCOMM_DELTA_CD)) {
1003 pr_debug("%s(), ircomm%d CD now %s...\n", __func__ , self->line,
1004 (status & IRCOMM_CD) ? "on" : "off");
1005
1006 if (status & IRCOMM_CD) {
1007 wake_up_interruptible(&self->port.open_wait);
1008 } else {
1009 pr_debug("%s(), Doing serial hangup..\n", __func__);
1010 if (tty)
1011 tty_hangup(tty);
1012
1013
1014 goto put;
1015 }
1016 }
1017 if (tty && tty_port_cts_enabled(&self->port)) {
1018 if (tty->hw_stopped) {
1019 if (status & IRCOMM_CTS) {
1020 pr_debug("%s(), CTS tx start...\n", __func__);
1021 tty->hw_stopped = 0;
1022
1023
1024 wake_up_interruptible(&self->port.open_wait);
1025
1026 schedule_work(&self->tqueue);
1027 goto put;
1028 }
1029 } else {
1030 if (!(status & IRCOMM_CTS)) {
1031 pr_debug("%s(), CTS tx stop...\n", __func__);
1032 tty->hw_stopped = 1;
1033 }
1034 }
1035 }
1036put:
1037 tty_kref_put(tty);
1038}
1039
1040
1041
1042
1043
1044
1045
1046static int ircomm_tty_data_indication(void *instance, void *sap,
1047 struct sk_buff *skb)
1048{
1049 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1050 struct tty_struct *tty;
1051
1052 IRDA_ASSERT(self != NULL, return -1;);
1053 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
1054 IRDA_ASSERT(skb != NULL, return -1;);
1055
1056 tty = tty_port_tty_get(&self->port);
1057 if (!tty) {
1058 pr_debug("%s(), no tty!\n", __func__);
1059 return 0;
1060 }
1061
1062
1063
1064
1065
1066
1067
1068 if (tty->hw_stopped && (self->flow == FLOW_START)) {
1069 pr_debug("%s(), polling for line settings!\n", __func__);
1070 ircomm_param_request(self, IRCOMM_POLL, TRUE);
1071
1072
1073 ircomm_tty_send_initial_parameters(self);
1074 ircomm_tty_link_established(self);
1075 }
1076 tty_kref_put(tty);
1077
1078
1079
1080
1081
1082 tty_insert_flip_string(&self->port, skb->data, skb->len);
1083 tty_flip_buffer_push(&self->port);
1084
1085
1086
1087 return 0;
1088}
1089
1090
1091
1092
1093
1094
1095
1096static int ircomm_tty_control_indication(void *instance, void *sap,
1097 struct sk_buff *skb)
1098{
1099 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1100 int clen;
1101
1102 IRDA_ASSERT(self != NULL, return -1;);
1103 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
1104 IRDA_ASSERT(skb != NULL, return -1;);
1105
1106 clen = skb->data[0];
1107
1108 irda_param_extract_all(self, skb->data+1, IRDA_MIN(skb->len-1, clen),
1109 &ircomm_param_info);
1110
1111
1112
1113 return 0;
1114}
1115
1116
1117
1118
1119
1120
1121
1122
1123static void ircomm_tty_flow_indication(void *instance, void *sap,
1124 LOCAL_FLOW cmd)
1125{
1126 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1127 struct tty_struct *tty;
1128
1129 IRDA_ASSERT(self != NULL, return;);
1130 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
1131
1132 tty = tty_port_tty_get(&self->port);
1133
1134 switch (cmd) {
1135 case FLOW_START:
1136 pr_debug("%s(), hw start!\n", __func__);
1137 if (tty)
1138 tty->hw_stopped = 0;
1139
1140
1141 schedule_work(&self->tqueue);
1142 break;
1143 default:
1144 case FLOW_STOP:
1145 pr_debug("%s(), hw stopped!\n", __func__);
1146 if (tty)
1147 tty->hw_stopped = 1;
1148 break;
1149 }
1150
1151 tty_kref_put(tty);
1152 self->flow = cmd;
1153}
1154
1155#ifdef CONFIG_PROC_FS
1156static void ircomm_tty_line_info(struct ircomm_tty_cb *self, struct seq_file *m)
1157{
1158 struct tty_struct *tty;
1159 char sep;
1160
1161 seq_printf(m, "State: %s\n", ircomm_tty_state[self->state]);
1162
1163 seq_puts(m, "Service type: ");
1164 if (self->service_type & IRCOMM_9_WIRE)
1165 seq_puts(m, "9_WIRE");
1166 else if (self->service_type & IRCOMM_3_WIRE)
1167 seq_puts(m, "3_WIRE");
1168 else if (self->service_type & IRCOMM_3_WIRE_RAW)
1169 seq_puts(m, "3_WIRE_RAW");
1170 else
1171 seq_puts(m, "No common service type!\n");
1172 seq_putc(m, '\n');
1173
1174 seq_printf(m, "Port name: %s\n", self->settings.port_name);
1175
1176 seq_printf(m, "DTE status:");
1177 sep = ' ';
1178 if (self->settings.dte & IRCOMM_RTS) {
1179 seq_printf(m, "%cRTS", sep);
1180 sep = '|';
1181 }
1182 if (self->settings.dte & IRCOMM_DTR) {
1183 seq_printf(m, "%cDTR", sep);
1184 sep = '|';
1185 }
1186 seq_putc(m, '\n');
1187
1188 seq_puts(m, "DCE status:");
1189 sep = ' ';
1190 if (self->settings.dce & IRCOMM_CTS) {
1191 seq_printf(m, "%cCTS", sep);
1192 sep = '|';
1193 }
1194 if (self->settings.dce & IRCOMM_DSR) {
1195 seq_printf(m, "%cDSR", sep);
1196 sep = '|';
1197 }
1198 if (self->settings.dce & IRCOMM_CD) {
1199 seq_printf(m, "%cCD", sep);
1200 sep = '|';
1201 }
1202 if (self->settings.dce & IRCOMM_RI) {
1203 seq_printf(m, "%cRI", sep);
1204 sep = '|';
1205 }
1206 seq_putc(m, '\n');
1207
1208 seq_puts(m, "Configuration: ");
1209 if (!self->settings.null_modem)
1210 seq_puts(m, "DTE <-> DCE\n");
1211 else
1212 seq_puts(m, "DTE <-> DTE (null modem emulation)\n");
1213
1214 seq_printf(m, "Data rate: %d\n", self->settings.data_rate);
1215
1216 seq_puts(m, "Flow control:");
1217 sep = ' ';
1218 if (self->settings.flow_control & IRCOMM_XON_XOFF_IN) {
1219 seq_printf(m, "%cXON_XOFF_IN", sep);
1220 sep = '|';
1221 }
1222 if (self->settings.flow_control & IRCOMM_XON_XOFF_OUT) {
1223 seq_printf(m, "%cXON_XOFF_OUT", sep);
1224 sep = '|';
1225 }
1226 if (self->settings.flow_control & IRCOMM_RTS_CTS_IN) {
1227 seq_printf(m, "%cRTS_CTS_IN", sep);
1228 sep = '|';
1229 }
1230 if (self->settings.flow_control & IRCOMM_RTS_CTS_OUT) {
1231 seq_printf(m, "%cRTS_CTS_OUT", sep);
1232 sep = '|';
1233 }
1234 if (self->settings.flow_control & IRCOMM_DSR_DTR_IN) {
1235 seq_printf(m, "%cDSR_DTR_IN", sep);
1236 sep = '|';
1237 }
1238 if (self->settings.flow_control & IRCOMM_DSR_DTR_OUT) {
1239 seq_printf(m, "%cDSR_DTR_OUT", sep);
1240 sep = '|';
1241 }
1242 if (self->settings.flow_control & IRCOMM_ENQ_ACK_IN) {
1243 seq_printf(m, "%cENQ_ACK_IN", sep);
1244 sep = '|';
1245 }
1246 if (self->settings.flow_control & IRCOMM_ENQ_ACK_OUT) {
1247 seq_printf(m, "%cENQ_ACK_OUT", sep);
1248 sep = '|';
1249 }
1250 seq_putc(m, '\n');
1251
1252 seq_puts(m, "Flags:");
1253 sep = ' ';
1254 if (tty_port_cts_enabled(&self->port)) {
1255 seq_printf(m, "%cASYNC_CTS_FLOW", sep);
1256 sep = '|';
1257 }
1258 if (self->port.flags & ASYNC_CHECK_CD) {
1259 seq_printf(m, "%cASYNC_CHECK_CD", sep);
1260 sep = '|';
1261 }
1262 if (self->port.flags & ASYNC_INITIALIZED) {
1263 seq_printf(m, "%cASYNC_INITIALIZED", sep);
1264 sep = '|';
1265 }
1266 if (self->port.flags & ASYNC_LOW_LATENCY) {
1267 seq_printf(m, "%cASYNC_LOW_LATENCY", sep);
1268 sep = '|';
1269 }
1270 if (self->port.flags & ASYNC_NORMAL_ACTIVE) {
1271 seq_printf(m, "%cASYNC_NORMAL_ACTIVE", sep);
1272 sep = '|';
1273 }
1274 seq_putc(m, '\n');
1275
1276 seq_printf(m, "Role: %s\n", self->client ? "client" : "server");
1277 seq_printf(m, "Open count: %d\n", self->port.count);
1278 seq_printf(m, "Max data size: %d\n", self->max_data_size);
1279 seq_printf(m, "Max header size: %d\n", self->max_header_size);
1280
1281 tty = tty_port_tty_get(&self->port);
1282 if (tty) {
1283 seq_printf(m, "Hardware: %s\n",
1284 tty->hw_stopped ? "Stopped" : "Running");
1285 tty_kref_put(tty);
1286 }
1287}
1288
1289static int ircomm_tty_proc_show(struct seq_file *m, void *v)
1290{
1291 struct ircomm_tty_cb *self;
1292 unsigned long flags;
1293
1294 spin_lock_irqsave(&ircomm_tty->hb_spinlock, flags);
1295
1296 self = (struct ircomm_tty_cb *) hashbin_get_first(ircomm_tty);
1297 while (self != NULL) {
1298 if (self->magic != IRCOMM_TTY_MAGIC)
1299 break;
1300
1301 ircomm_tty_line_info(self, m);
1302 self = (struct ircomm_tty_cb *) hashbin_get_next(ircomm_tty);
1303 }
1304 spin_unlock_irqrestore(&ircomm_tty->hb_spinlock, flags);
1305 return 0;
1306}
1307
1308static int ircomm_tty_proc_open(struct inode *inode, struct file *file)
1309{
1310 return single_open(file, ircomm_tty_proc_show, NULL);
1311}
1312
1313static const struct file_operations ircomm_tty_proc_fops = {
1314 .owner = THIS_MODULE,
1315 .open = ircomm_tty_proc_open,
1316 .read = seq_read,
1317 .llseek = seq_lseek,
1318 .release = single_release,
1319};
1320#endif
1321
1322MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>");
1323MODULE_DESCRIPTION("IrCOMM serial TTY driver");
1324MODULE_LICENSE("GPL");
1325MODULE_ALIAS_CHARDEV_MAJOR(IRCOMM_TTY_MAJOR);
1326
1327module_init(ircomm_tty_init);
1328module_exit(ircomm_tty_cleanup);
1329