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/signal.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 <linux/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 (tty_port_initialized(&self->port)) {
224 pr_debug("%s(), already open so break out!\n", __func__);
225 return 0;
226 }
227 tty_port_set_initialized(&self->port, 1);
228
229
230 irda_notify_init(¬ify);
231
232 notify.data_indication = ircomm_tty_data_indication;
233 notify.udata_indication = ircomm_tty_control_indication;
234 notify.flow_indication = ircomm_tty_flow_indication;
235
236
237 notify.disconnect_indication = ircomm_tty_disconnect_indication;
238 notify.connect_confirm = ircomm_tty_connect_confirm;
239 notify.connect_indication = ircomm_tty_connect_indication;
240 strlcpy(notify.name, "ircomm_tty", sizeof(notify.name));
241 notify.instance = self;
242
243 if (!self->ircomm) {
244 self->ircomm = ircomm_open(¬ify, self->service_type,
245 self->line);
246 }
247 if (!self->ircomm)
248 goto err;
249
250 self->slsap_sel = self->ircomm->slsap_sel;
251
252
253 ret = ircomm_tty_attach_cable(self);
254 if (ret < 0) {
255 net_err_ratelimited("%s(), error attaching cable!\n", __func__);
256 goto err;
257 }
258
259 return 0;
260err:
261 tty_port_set_initialized(&self->port, 0);
262 return ret;
263}
264
265
266
267
268
269
270
271static int ircomm_tty_block_til_ready(struct ircomm_tty_cb *self,
272 struct tty_struct *tty, struct file *filp)
273{
274 struct tty_port *port = &self->port;
275 DECLARE_WAITQUEUE(wait, current);
276 int retval;
277 int do_clocal = 0;
278 unsigned long flags;
279
280
281
282
283
284 if (tty_io_error(tty)) {
285 tty_port_set_active(port, 1);
286 return 0;
287 }
288
289 if (filp->f_flags & O_NONBLOCK) {
290
291 if (C_BAUD(tty))
292 tty_port_raise_dtr_rts(port);
293 tty_port_set_active(port, 1);
294 pr_debug("%s(), O_NONBLOCK requested!\n", __func__);
295 return 0;
296 }
297
298 if (C_CLOCAL(tty)) {
299 pr_debug("%s(), doing CLOCAL!\n", __func__);
300 do_clocal = 1;
301 }
302
303
304
305
306
307
308
309
310 retval = 0;
311 add_wait_queue(&port->open_wait, &wait);
312
313 pr_debug("%s(%d):block_til_ready before block on %s open_count=%d\n",
314 __FILE__, __LINE__, tty->driver->name, port->count);
315
316 spin_lock_irqsave(&port->lock, flags);
317 port->count--;
318 port->blocked_open++;
319 spin_unlock_irqrestore(&port->lock, flags);
320
321 while (1) {
322 if (C_BAUD(tty) && tty_port_initialized(port))
323 tty_port_raise_dtr_rts(port);
324
325 set_current_state(TASK_INTERRUPTIBLE);
326
327 if (tty_hung_up_p(filp) || !tty_port_initialized(port)) {
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 tty_port_set_active(port, 1);
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 skb_put_data(skb, 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 (!tty_port_initialized(&self->port))
880 return;
881 tty_port_set_initialized(&self->port, 0);
882
883 ircomm_tty_detach_cable(self);
884
885 spin_lock_irqsave(&self->spinlock, flags);
886
887 del_timer(&self->watchdog_timer);
888
889
890 if (self->ctrl_skb) {
891 dev_kfree_skb(self->ctrl_skb);
892 self->ctrl_skb = NULL;
893 }
894
895
896 if (self->tx_skb) {
897 dev_kfree_skb(self->tx_skb);
898 self->tx_skb = NULL;
899 }
900
901 if (self->ircomm) {
902 ircomm_close(self->ircomm);
903 self->ircomm = NULL;
904 }
905
906 spin_unlock_irqrestore(&self->spinlock, flags);
907}
908
909
910
911
912
913
914
915
916static void ircomm_tty_hangup(struct tty_struct *tty)
917{
918 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
919 struct tty_port *port = &self->port;
920 unsigned long flags;
921
922 IRDA_ASSERT(self != NULL, return;);
923 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
924
925
926 ircomm_tty_shutdown(self);
927
928 spin_lock_irqsave(&port->lock, flags);
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 tty_port_set_active(port, 0);
937
938 wake_up_interruptible(&port->open_wait);
939}
940
941
942
943
944
945
946
947static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch)
948{
949 pr_debug("%s(), not impl\n", __func__);
950}
951
952
953
954
955
956
957
958void ircomm_tty_start(struct tty_struct *tty)
959{
960 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
961
962 ircomm_flow_request(self->ircomm, FLOW_START);
963}
964
965
966
967
968
969
970
971static void ircomm_tty_stop(struct tty_struct *tty)
972{
973 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data;
974
975 IRDA_ASSERT(self != NULL, return;);
976 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
977
978 ircomm_flow_request(self->ircomm, FLOW_STOP);
979}
980
981
982
983
984
985
986
987
988void ircomm_tty_check_modem_status(struct ircomm_tty_cb *self)
989{
990 struct tty_struct *tty;
991 int status;
992
993 IRDA_ASSERT(self != NULL, return;);
994 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
995
996 tty = tty_port_tty_get(&self->port);
997
998 status = self->settings.dce;
999
1000 if (status & IRCOMM_DCE_DELTA_ANY) {
1001
1002 }
1003 if (tty_port_check_carrier(&self->port) && (status & IRCOMM_DELTA_CD)) {
1004 pr_debug("%s(), ircomm%d CD now %s...\n", __func__ , self->line,
1005 (status & IRCOMM_CD) ? "on" : "off");
1006
1007 if (status & IRCOMM_CD) {
1008 wake_up_interruptible(&self->port.open_wait);
1009 } else {
1010 pr_debug("%s(), Doing serial hangup..\n", __func__);
1011 if (tty)
1012 tty_hangup(tty);
1013
1014
1015 goto put;
1016 }
1017 }
1018 if (tty && tty_port_cts_enabled(&self->port)) {
1019 if (tty->hw_stopped) {
1020 if (status & IRCOMM_CTS) {
1021 pr_debug("%s(), CTS tx start...\n", __func__);
1022 tty->hw_stopped = 0;
1023
1024
1025 wake_up_interruptible(&self->port.open_wait);
1026
1027 schedule_work(&self->tqueue);
1028 goto put;
1029 }
1030 } else {
1031 if (!(status & IRCOMM_CTS)) {
1032 pr_debug("%s(), CTS tx stop...\n", __func__);
1033 tty->hw_stopped = 1;
1034 }
1035 }
1036 }
1037put:
1038 tty_kref_put(tty);
1039}
1040
1041
1042
1043
1044
1045
1046
1047static int ircomm_tty_data_indication(void *instance, void *sap,
1048 struct sk_buff *skb)
1049{
1050 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1051 struct tty_struct *tty;
1052
1053 IRDA_ASSERT(self != NULL, return -1;);
1054 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
1055 IRDA_ASSERT(skb != NULL, return -1;);
1056
1057 tty = tty_port_tty_get(&self->port);
1058 if (!tty) {
1059 pr_debug("%s(), no tty!\n", __func__);
1060 return 0;
1061 }
1062
1063
1064
1065
1066
1067
1068
1069 if (tty->hw_stopped && (self->flow == FLOW_START)) {
1070 pr_debug("%s(), polling for line settings!\n", __func__);
1071 ircomm_param_request(self, IRCOMM_POLL, TRUE);
1072
1073
1074 ircomm_tty_send_initial_parameters(self);
1075 ircomm_tty_link_established(self);
1076 }
1077 tty_kref_put(tty);
1078
1079
1080
1081
1082
1083 tty_insert_flip_string(&self->port, skb->data, skb->len);
1084 tty_flip_buffer_push(&self->port);
1085
1086
1087
1088 return 0;
1089}
1090
1091
1092
1093
1094
1095
1096
1097static int ircomm_tty_control_indication(void *instance, void *sap,
1098 struct sk_buff *skb)
1099{
1100 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1101 int clen;
1102
1103 IRDA_ASSERT(self != NULL, return -1;);
1104 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
1105 IRDA_ASSERT(skb != NULL, return -1;);
1106
1107 clen = skb->data[0];
1108
1109 irda_param_extract_all(self, skb->data+1, IRDA_MIN(skb->len-1, clen),
1110 &ircomm_param_info);
1111
1112
1113
1114 return 0;
1115}
1116
1117
1118
1119
1120
1121
1122
1123
1124static void ircomm_tty_flow_indication(void *instance, void *sap,
1125 LOCAL_FLOW cmd)
1126{
1127 struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
1128 struct tty_struct *tty;
1129
1130 IRDA_ASSERT(self != NULL, return;);
1131 IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
1132
1133 tty = tty_port_tty_get(&self->port);
1134
1135 switch (cmd) {
1136 case FLOW_START:
1137 pr_debug("%s(), hw start!\n", __func__);
1138 if (tty)
1139 tty->hw_stopped = 0;
1140
1141
1142 schedule_work(&self->tqueue);
1143 break;
1144 default:
1145 case FLOW_STOP:
1146 pr_debug("%s(), hw stopped!\n", __func__);
1147 if (tty)
1148 tty->hw_stopped = 1;
1149 break;
1150 }
1151
1152 tty_kref_put(tty);
1153 self->flow = cmd;
1154}
1155
1156#ifdef CONFIG_PROC_FS
1157static void ircomm_tty_line_info(struct ircomm_tty_cb *self, struct seq_file *m)
1158{
1159 struct tty_struct *tty;
1160 char sep;
1161
1162 seq_printf(m, "State: %s\n", ircomm_tty_state[self->state]);
1163
1164 seq_puts(m, "Service type: ");
1165 if (self->service_type & IRCOMM_9_WIRE)
1166 seq_puts(m, "9_WIRE");
1167 else if (self->service_type & IRCOMM_3_WIRE)
1168 seq_puts(m, "3_WIRE");
1169 else if (self->service_type & IRCOMM_3_WIRE_RAW)
1170 seq_puts(m, "3_WIRE_RAW");
1171 else
1172 seq_puts(m, "No common service type!\n");
1173 seq_putc(m, '\n');
1174
1175 seq_printf(m, "Port name: %s\n", self->settings.port_name);
1176
1177 seq_printf(m, "DTE status:");
1178 sep = ' ';
1179 if (self->settings.dte & IRCOMM_RTS) {
1180 seq_printf(m, "%cRTS", sep);
1181 sep = '|';
1182 }
1183 if (self->settings.dte & IRCOMM_DTR) {
1184 seq_printf(m, "%cDTR", sep);
1185 sep = '|';
1186 }
1187 seq_putc(m, '\n');
1188
1189 seq_puts(m, "DCE status:");
1190 sep = ' ';
1191 if (self->settings.dce & IRCOMM_CTS) {
1192 seq_printf(m, "%cCTS", sep);
1193 sep = '|';
1194 }
1195 if (self->settings.dce & IRCOMM_DSR) {
1196 seq_printf(m, "%cDSR", sep);
1197 sep = '|';
1198 }
1199 if (self->settings.dce & IRCOMM_CD) {
1200 seq_printf(m, "%cCD", sep);
1201 sep = '|';
1202 }
1203 if (self->settings.dce & IRCOMM_RI) {
1204 seq_printf(m, "%cRI", sep);
1205 sep = '|';
1206 }
1207 seq_putc(m, '\n');
1208
1209 seq_puts(m, "Configuration: ");
1210 if (!self->settings.null_modem)
1211 seq_puts(m, "DTE <-> DCE\n");
1212 else
1213 seq_puts(m, "DTE <-> DTE (null modem emulation)\n");
1214
1215 seq_printf(m, "Data rate: %d\n", self->settings.data_rate);
1216
1217 seq_puts(m, "Flow control:");
1218 sep = ' ';
1219 if (self->settings.flow_control & IRCOMM_XON_XOFF_IN) {
1220 seq_printf(m, "%cXON_XOFF_IN", sep);
1221 sep = '|';
1222 }
1223 if (self->settings.flow_control & IRCOMM_XON_XOFF_OUT) {
1224 seq_printf(m, "%cXON_XOFF_OUT", sep);
1225 sep = '|';
1226 }
1227 if (self->settings.flow_control & IRCOMM_RTS_CTS_IN) {
1228 seq_printf(m, "%cRTS_CTS_IN", sep);
1229 sep = '|';
1230 }
1231 if (self->settings.flow_control & IRCOMM_RTS_CTS_OUT) {
1232 seq_printf(m, "%cRTS_CTS_OUT", sep);
1233 sep = '|';
1234 }
1235 if (self->settings.flow_control & IRCOMM_DSR_DTR_IN) {
1236 seq_printf(m, "%cDSR_DTR_IN", sep);
1237 sep = '|';
1238 }
1239 if (self->settings.flow_control & IRCOMM_DSR_DTR_OUT) {
1240 seq_printf(m, "%cDSR_DTR_OUT", sep);
1241 sep = '|';
1242 }
1243 if (self->settings.flow_control & IRCOMM_ENQ_ACK_IN) {
1244 seq_printf(m, "%cENQ_ACK_IN", sep);
1245 sep = '|';
1246 }
1247 if (self->settings.flow_control & IRCOMM_ENQ_ACK_OUT) {
1248 seq_printf(m, "%cENQ_ACK_OUT", sep);
1249 sep = '|';
1250 }
1251 seq_putc(m, '\n');
1252
1253 seq_puts(m, "Flags:");
1254 sep = ' ';
1255 if (tty_port_cts_enabled(&self->port)) {
1256 seq_printf(m, "%cASYNC_CTS_FLOW", sep);
1257 sep = '|';
1258 }
1259 if (tty_port_check_carrier(&self->port)) {
1260 seq_printf(m, "%cASYNC_CHECK_CD", sep);
1261 sep = '|';
1262 }
1263 if (tty_port_initialized(&self->port)) {
1264 seq_printf(m, "%cASYNC_INITIALIZED", sep);
1265 sep = '|';
1266 }
1267 if (self->port.flags & ASYNC_LOW_LATENCY) {
1268 seq_printf(m, "%cASYNC_LOW_LATENCY", sep);
1269 sep = '|';
1270 }
1271 if (tty_port_active(&self->port)) {
1272 seq_printf(m, "%cASYNC_NORMAL_ACTIVE", sep);
1273 sep = '|';
1274 }
1275 seq_putc(m, '\n');
1276
1277 seq_printf(m, "Role: %s\n", self->client ? "client" : "server");
1278 seq_printf(m, "Open count: %d\n", self->port.count);
1279 seq_printf(m, "Max data size: %d\n", self->max_data_size);
1280 seq_printf(m, "Max header size: %d\n", self->max_header_size);
1281
1282 tty = tty_port_tty_get(&self->port);
1283 if (tty) {
1284 seq_printf(m, "Hardware: %s\n",
1285 tty->hw_stopped ? "Stopped" : "Running");
1286 tty_kref_put(tty);
1287 }
1288}
1289
1290static int ircomm_tty_proc_show(struct seq_file *m, void *v)
1291{
1292 struct ircomm_tty_cb *self;
1293 unsigned long flags;
1294
1295 spin_lock_irqsave(&ircomm_tty->hb_spinlock, flags);
1296
1297 self = (struct ircomm_tty_cb *) hashbin_get_first(ircomm_tty);
1298 while (self != NULL) {
1299 if (self->magic != IRCOMM_TTY_MAGIC)
1300 break;
1301
1302 ircomm_tty_line_info(self, m);
1303 self = (struct ircomm_tty_cb *) hashbin_get_next(ircomm_tty);
1304 }
1305 spin_unlock_irqrestore(&ircomm_tty->hb_spinlock, flags);
1306 return 0;
1307}
1308
1309static int ircomm_tty_proc_open(struct inode *inode, struct file *file)
1310{
1311 return single_open(file, ircomm_tty_proc_show, NULL);
1312}
1313
1314static const struct file_operations ircomm_tty_proc_fops = {
1315 .owner = THIS_MODULE,
1316 .open = ircomm_tty_proc_open,
1317 .read = seq_read,
1318 .llseek = seq_lseek,
1319 .release = single_release,
1320};
1321#endif
1322
1323MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>");
1324MODULE_DESCRIPTION("IrCOMM serial TTY driver");
1325MODULE_LICENSE("GPL");
1326MODULE_ALIAS_CHARDEV_MAJOR(IRCOMM_TTY_MAJOR);
1327
1328module_init(ircomm_tty_init);
1329module_exit(ircomm_tty_cleanup);
1330