1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/kernel.h>
17#include <linux/sched.h>
18#include <linux/interrupt.h>
19#include <linux/delay.h>
20#include <linux/io.h>
21#include <linux/serial.h>
22#include <linux/serial_reg.h>
23#include <linux/pci.h>
24
25#include "dgnc_driver.h"
26#include "dgnc_cls.h"
27#include "dgnc_tty.h"
28
29static inline void cls_set_cts_flow_control(struct channel_t *ch)
30{
31 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
32 unsigned char ier = readb(&ch->ch_cls_uart->ier);
33 unsigned char isr_fcr = 0;
34
35
36
37
38
39 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
40
41 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
42
43
44 isr_fcr |= (UART_EXAR654_EFR_ECB | UART_EXAR654_EFR_CTSDSR);
45 isr_fcr &= ~(UART_EXAR654_EFR_IXON);
46
47 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
48
49
50 writeb(lcrb, &ch->ch_cls_uart->lcr);
51
52
53
54
55
56 ier |= (UART_EXAR654_IER_CTSDSR);
57 ier &= ~(UART_EXAR654_IER_XOFF);
58 writeb(ier, &ch->ch_cls_uart->ier);
59
60
61 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
62
63 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_56 |
64 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
65 &ch->ch_cls_uart->isr_fcr);
66
67 ch->ch_t_tlevel = 16;
68}
69
70static inline void cls_set_ixon_flow_control(struct channel_t *ch)
71{
72 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
73 unsigned char ier = readb(&ch->ch_cls_uart->ier);
74 unsigned char isr_fcr = 0;
75
76
77
78
79
80 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
81
82 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
83
84
85 isr_fcr |= (UART_EXAR654_EFR_ECB | UART_EXAR654_EFR_IXON);
86 isr_fcr &= ~(UART_EXAR654_EFR_CTSDSR);
87
88 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
89
90
91 writeb(ch->ch_startc, &ch->ch_cls_uart->mcr);
92 writeb(0, &ch->ch_cls_uart->lsr);
93 writeb(ch->ch_stopc, &ch->ch_cls_uart->msr);
94 writeb(0, &ch->ch_cls_uart->spr);
95
96
97 writeb(lcrb, &ch->ch_cls_uart->lcr);
98
99
100
101
102
103 ier &= ~(UART_EXAR654_IER_CTSDSR);
104 ier |= (UART_EXAR654_IER_XOFF);
105 writeb(ier, &ch->ch_cls_uart->ier);
106
107
108 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
109
110 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_16 |
111 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
112 &ch->ch_cls_uart->isr_fcr);
113}
114
115static inline void cls_set_no_output_flow_control(struct channel_t *ch)
116{
117 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
118 unsigned char ier = readb(&ch->ch_cls_uart->ier);
119 unsigned char isr_fcr = 0;
120
121
122
123
124
125 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
126
127 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
128
129
130 isr_fcr |= (UART_EXAR654_EFR_ECB);
131 isr_fcr &= ~(UART_EXAR654_EFR_CTSDSR | UART_EXAR654_EFR_IXON);
132
133 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
134
135
136 writeb(lcrb, &ch->ch_cls_uart->lcr);
137
138
139
140
141
142 ier &= ~(UART_EXAR654_IER_CTSDSR);
143 ier &= ~(UART_EXAR654_IER_XOFF);
144 writeb(ier, &ch->ch_cls_uart->ier);
145
146
147 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
148
149 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_16 |
150 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
151 &ch->ch_cls_uart->isr_fcr);
152
153 ch->ch_r_watermark = 0;
154 ch->ch_t_tlevel = 16;
155 ch->ch_r_tlevel = 16;
156}
157
158static inline void cls_set_rts_flow_control(struct channel_t *ch)
159{
160 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
161 unsigned char ier = readb(&ch->ch_cls_uart->ier);
162 unsigned char isr_fcr = 0;
163
164
165
166
167
168 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
169
170 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
171
172
173 isr_fcr |= (UART_EXAR654_EFR_ECB | UART_EXAR654_EFR_RTSDTR);
174 isr_fcr &= ~(UART_EXAR654_EFR_IXOFF);
175
176 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
177
178
179 writeb(lcrb, &ch->ch_cls_uart->lcr);
180
181
182 ier |= (UART_EXAR654_IER_RTSDTR);
183 writeb(ier, &ch->ch_cls_uart->ier);
184
185
186 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
187
188 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_56 |
189 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
190 &ch->ch_cls_uart->isr_fcr);
191
192 ch->ch_r_watermark = 4;
193 ch->ch_r_tlevel = 8;
194}
195
196static inline void cls_set_ixoff_flow_control(struct channel_t *ch)
197{
198 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
199 unsigned char ier = readb(&ch->ch_cls_uart->ier);
200 unsigned char isr_fcr = 0;
201
202
203
204
205
206 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
207
208 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
209
210
211 isr_fcr |= (UART_EXAR654_EFR_ECB | UART_EXAR654_EFR_IXOFF);
212 isr_fcr &= ~(UART_EXAR654_EFR_RTSDTR);
213
214 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
215
216
217 writeb(ch->ch_startc, &ch->ch_cls_uart->mcr);
218 writeb(0, &ch->ch_cls_uart->lsr);
219 writeb(ch->ch_stopc, &ch->ch_cls_uart->msr);
220 writeb(0, &ch->ch_cls_uart->spr);
221
222
223 writeb(lcrb, &ch->ch_cls_uart->lcr);
224
225
226 ier &= ~(UART_EXAR654_IER_RTSDTR);
227 writeb(ier, &ch->ch_cls_uart->ier);
228
229
230 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
231
232 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_16 |
233 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
234 &ch->ch_cls_uart->isr_fcr);
235}
236
237static inline void cls_set_no_input_flow_control(struct channel_t *ch)
238{
239 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
240 unsigned char ier = readb(&ch->ch_cls_uart->ier);
241 unsigned char isr_fcr = 0;
242
243
244
245
246
247 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
248
249 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
250
251
252 isr_fcr |= (UART_EXAR654_EFR_ECB);
253 isr_fcr &= ~(UART_EXAR654_EFR_RTSDTR | UART_EXAR654_EFR_IXOFF);
254
255 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
256
257
258 writeb(lcrb, &ch->ch_cls_uart->lcr);
259
260
261 ier &= ~(UART_EXAR654_IER_RTSDTR);
262 writeb(ier, &ch->ch_cls_uart->ier);
263
264
265 writeb((UART_FCR_ENABLE_FIFO), &ch->ch_cls_uart->isr_fcr);
266
267 writeb((UART_FCR_ENABLE_FIFO | UART_16654_FCR_RXTRIGGER_16 |
268 UART_16654_FCR_TXTRIGGER_16 | UART_FCR_CLEAR_RCVR),
269 &ch->ch_cls_uart->isr_fcr);
270
271 ch->ch_t_tlevel = 16;
272 ch->ch_r_tlevel = 16;
273}
274
275
276
277
278
279
280
281
282static inline void cls_clear_break(struct channel_t *ch, int force)
283{
284 unsigned long flags;
285
286 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
287 return;
288
289 spin_lock_irqsave(&ch->ch_lock, flags);
290
291
292 if (!ch->ch_stop_sending_break) {
293 spin_unlock_irqrestore(&ch->ch_lock, flags);
294 return;
295 }
296
297
298 if (ch->ch_flags & CH_BREAK_SENDING) {
299 if (time_after(jiffies, ch->ch_stop_sending_break) || force) {
300 unsigned char temp = readb(&ch->ch_cls_uart->lcr);
301
302 writeb((temp & ~UART_LCR_SBC), &ch->ch_cls_uart->lcr);
303 ch->ch_flags &= ~(CH_BREAK_SENDING);
304 ch->ch_stop_sending_break = 0;
305 }
306 }
307 spin_unlock_irqrestore(&ch->ch_lock, flags);
308}
309
310static void cls_copy_data_from_uart_to_queue(struct channel_t *ch)
311{
312 int qleft = 0;
313 unsigned char linestatus = 0;
314 unsigned char error_mask = 0;
315 ushort head;
316 ushort tail;
317 unsigned long flags;
318
319 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
320 return;
321
322 spin_lock_irqsave(&ch->ch_lock, flags);
323
324
325 head = ch->ch_r_head;
326 tail = ch->ch_r_tail;
327
328
329 qleft = tail - head - 1;
330 if (qleft < 0)
331 qleft += RQUEUEMASK + 1;
332
333
334
335
336
337 if (ch->ch_c_iflag & IGNBRK)
338 error_mask |= UART_LSR_BI;
339
340 while (1) {
341 linestatus = readb(&ch->ch_cls_uart->lsr);
342
343 if (!(linestatus & (UART_LSR_DR)))
344 break;
345
346
347
348
349 if (linestatus & error_mask) {
350 linestatus = 0;
351 readb(&ch->ch_cls_uart->txrx);
352 continue;
353 }
354
355
356
357
358
359
360
361
362
363 while (qleft < 1) {
364 tail = (tail + 1) & RQUEUEMASK;
365 ch->ch_r_tail = tail;
366 ch->ch_err_overrun++;
367 qleft++;
368 }
369
370 ch->ch_equeue[head] = linestatus & (UART_LSR_BI | UART_LSR_PE
371 | UART_LSR_FE);
372 ch->ch_rqueue[head] = readb(&ch->ch_cls_uart->txrx);
373
374 qleft--;
375
376 if (ch->ch_equeue[head] & UART_LSR_PE)
377 ch->ch_err_parity++;
378 if (ch->ch_equeue[head] & UART_LSR_BI)
379 ch->ch_err_break++;
380 if (ch->ch_equeue[head] & UART_LSR_FE)
381 ch->ch_err_frame++;
382
383
384 head = (head + 1) & RQUEUEMASK;
385 ch->ch_rxcount++;
386 }
387
388
389
390
391 ch->ch_r_head = head & RQUEUEMASK;
392 ch->ch_e_head = head & EQUEUEMASK;
393
394 spin_unlock_irqrestore(&ch->ch_lock, flags);
395}
396
397
398static void cls_assert_modem_signals(struct channel_t *ch)
399{
400 unsigned char out;
401
402 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
403 return;
404
405 out = ch->ch_mostat;
406
407 if (ch->ch_flags & CH_LOOPBACK)
408 out |= UART_MCR_LOOP;
409
410 writeb(out, &ch->ch_cls_uart->mcr);
411
412
413 udelay(10);
414}
415
416static void cls_copy_data_from_queue_to_uart(struct channel_t *ch)
417{
418 ushort head;
419 ushort tail;
420 int n;
421 int qlen;
422 uint len_written = 0;
423 unsigned long flags;
424
425 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
426 return;
427
428 spin_lock_irqsave(&ch->ch_lock, flags);
429
430
431 if (ch->ch_w_tail == ch->ch_w_head)
432 goto exit_unlock;
433
434
435 if ((ch->ch_flags & CH_FORCED_STOP) ||
436 (ch->ch_flags & CH_BREAK_SENDING))
437 goto exit_unlock;
438
439 if (!(ch->ch_flags & (CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM)))
440 goto exit_unlock;
441
442 n = 32;
443
444
445 head = ch->ch_w_head & WQUEUEMASK;
446 tail = ch->ch_w_tail & WQUEUEMASK;
447 qlen = (head - tail) & WQUEUEMASK;
448
449
450 n = min(n, qlen);
451
452 while (n > 0) {
453
454
455
456
457
458 if (ch->ch_digi.digi_flags & DIGI_RTS_TOGGLE) {
459 if (!(ch->ch_mostat & UART_MCR_RTS)) {
460 ch->ch_mostat |= (UART_MCR_RTS);
461 cls_assert_modem_signals(ch);
462 }
463 ch->ch_tun.un_flags |= (UN_EMPTY);
464 }
465
466
467
468
469
470
471 if (ch->ch_digi.digi_flags & DIGI_DTR_TOGGLE) {
472 if (!(ch->ch_mostat & UART_MCR_DTR)) {
473 ch->ch_mostat |= (UART_MCR_DTR);
474 cls_assert_modem_signals(ch);
475 }
476 ch->ch_tun.un_flags |= (UN_EMPTY);
477 }
478 writeb(ch->ch_wqueue[ch->ch_w_tail], &ch->ch_cls_uart->txrx);
479 ch->ch_w_tail++;
480 ch->ch_w_tail &= WQUEUEMASK;
481 ch->ch_txcount++;
482 len_written++;
483 n--;
484 }
485
486 if (len_written > 0)
487 ch->ch_flags &= ~(CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM);
488
489exit_unlock:
490 spin_unlock_irqrestore(&ch->ch_lock, flags);
491}
492
493static void cls_parse_modem(struct channel_t *ch, unsigned char signals)
494{
495 unsigned char msignals = signals;
496 unsigned long flags;
497
498 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
499 return;
500
501
502
503
504
505 spin_lock_irqsave(&ch->ch_lock, flags);
506 if (ch->ch_digi.digi_flags & DIGI_ALTPIN) {
507 unsigned char mswap = signals;
508
509 if (mswap & UART_MSR_DDCD) {
510 msignals &= ~UART_MSR_DDCD;
511 msignals |= UART_MSR_DDSR;
512 }
513 if (mswap & UART_MSR_DDSR) {
514 msignals &= ~UART_MSR_DDSR;
515 msignals |= UART_MSR_DDCD;
516 }
517 if (mswap & UART_MSR_DCD) {
518 msignals &= ~UART_MSR_DCD;
519 msignals |= UART_MSR_DSR;
520 }
521 if (mswap & UART_MSR_DSR) {
522 msignals &= ~UART_MSR_DSR;
523 msignals |= UART_MSR_DCD;
524 }
525 }
526 spin_unlock_irqrestore(&ch->ch_lock, flags);
527
528
529
530
531
532 signals &= 0xf0;
533
534 spin_lock_irqsave(&ch->ch_lock, flags);
535 if (msignals & UART_MSR_DCD)
536 ch->ch_mistat |= UART_MSR_DCD;
537 else
538 ch->ch_mistat &= ~UART_MSR_DCD;
539
540 if (msignals & UART_MSR_DSR)
541 ch->ch_mistat |= UART_MSR_DSR;
542 else
543 ch->ch_mistat &= ~UART_MSR_DSR;
544
545 if (msignals & UART_MSR_RI)
546 ch->ch_mistat |= UART_MSR_RI;
547 else
548 ch->ch_mistat &= ~UART_MSR_RI;
549
550 if (msignals & UART_MSR_CTS)
551 ch->ch_mistat |= UART_MSR_CTS;
552 else
553 ch->ch_mistat &= ~UART_MSR_CTS;
554 spin_unlock_irqrestore(&ch->ch_lock, flags);
555}
556
557
558static inline void cls_parse_isr(struct dgnc_board *brd, uint port)
559{
560 struct channel_t *ch;
561 unsigned char isr = 0;
562 unsigned long flags;
563
564
565
566
567
568
569 if (port >= brd->nasync)
570 return;
571
572 ch = brd->channels[port];
573 if (ch->magic != DGNC_CHANNEL_MAGIC)
574 return;
575
576
577 while (1) {
578 isr = readb(&ch->ch_cls_uart->isr_fcr);
579
580
581 if (isr & UART_IIR_NO_INT)
582 break;
583
584
585 if (isr & (UART_IIR_RDI | UART_IIR_RDI_TIMEOUT)) {
586
587 cls_copy_data_from_uart_to_queue(ch);
588 dgnc_check_queue_flow_control(ch);
589 }
590
591
592 if (isr & UART_IIR_THRI) {
593
594 spin_lock_irqsave(&ch->ch_lock, flags);
595 ch->ch_flags |= (CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM);
596 spin_unlock_irqrestore(&ch->ch_lock, flags);
597 cls_copy_data_from_queue_to_uart(ch);
598 }
599
600
601 cls_parse_modem(ch, readb(&ch->ch_cls_uart->msr));
602 }
603}
604
605
606static void cls_flush_uart_write(struct channel_t *ch)
607{
608 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
609 return;
610
611 writeb((UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_XMIT),
612 &ch->ch_cls_uart->isr_fcr);
613 usleep_range(10, 20);
614
615 ch->ch_flags |= (CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM);
616}
617
618
619static void cls_flush_uart_read(struct channel_t *ch)
620{
621 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
622 return;
623
624
625
626
627
628
629
630
631
632
633
634
635 udelay(10);
636}
637
638
639
640
641
642static void cls_param(struct tty_struct *tty)
643{
644 unsigned char lcr = 0;
645 unsigned char uart_lcr = 0;
646 unsigned char ier = 0;
647 unsigned char uart_ier = 0;
648 uint baud = 9600;
649 int quot = 0;
650 struct dgnc_board *bd;
651 struct channel_t *ch;
652 struct un_t *un;
653
654 if (!tty || tty->magic != TTY_MAGIC)
655 return;
656
657 un = (struct un_t *)tty->driver_data;
658 if (!un || un->magic != DGNC_UNIT_MAGIC)
659 return;
660
661 ch = un->un_ch;
662 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
663 return;
664
665 bd = ch->ch_bd;
666 if (!bd || bd->magic != DGNC_BOARD_MAGIC)
667 return;
668
669
670
671
672 if ((ch->ch_c_cflag & (CBAUD)) == 0) {
673 ch->ch_r_head = 0;
674 ch->ch_r_tail = 0;
675 ch->ch_e_head = 0;
676 ch->ch_e_tail = 0;
677 ch->ch_w_head = 0;
678 ch->ch_w_tail = 0;
679
680 cls_flush_uart_write(ch);
681 cls_flush_uart_read(ch);
682
683
684 ch->ch_flags |= (CH_BAUD0);
685 ch->ch_mostat &= ~(UART_MCR_RTS | UART_MCR_DTR);
686 cls_assert_modem_signals(ch);
687 ch->ch_old_baud = 0;
688 return;
689 } else if (ch->ch_custom_speed) {
690 baud = ch->ch_custom_speed;
691
692 if (ch->ch_flags & CH_BAUD0) {
693 ch->ch_flags &= ~(CH_BAUD0);
694
695
696
697
698
699 if (!(ch->ch_digi.digi_flags & DIGI_RTS_TOGGLE))
700 ch->ch_mostat |= (UART_MCR_RTS);
701 if (!(ch->ch_digi.digi_flags & DIGI_DTR_TOGGLE))
702 ch->ch_mostat |= (UART_MCR_DTR);
703 }
704
705 } else {
706 int iindex = 0;
707 int jindex = 0;
708
709 ulong bauds[4][16] = {
710 {
711 0, 50, 75, 110,
712 134, 150, 200, 300,
713 600, 1200, 1800, 2400,
714 4800, 9600, 19200, 38400 },
715 {
716 0, 57600, 115200, 230400,
717 460800, 150, 200, 921600,
718 600, 1200, 1800, 2400,
719 4800, 9600, 19200, 38400 },
720 {
721 0, 57600, 76800, 115200,
722 131657, 153600, 230400, 460800,
723 921600, 1200, 1800, 2400,
724 4800, 9600, 19200, 38400 },
725 {
726 0, 57600, 115200, 230400,
727 460800, 150, 200, 921600,
728 600, 1200, 1800, 2400,
729 4800, 9600, 19200, 38400 }
730 };
731
732
733
734
735
736 if (!(ch->ch_tun.un_flags & UN_ISOPEN) &&
737 (un->un_type == DGNC_PRINT))
738 baud = C_BAUD(ch->ch_pun.un_tty) & 0xff;
739 else
740 baud = C_BAUD(ch->ch_tun.un_tty) & 0xff;
741
742 if (ch->ch_c_cflag & CBAUDEX)
743 iindex = 1;
744
745 if (ch->ch_digi.digi_flags & DIGI_FAST)
746 iindex += 2;
747
748 jindex = baud;
749
750 if ((iindex >= 0) && (iindex < 4) && (jindex >= 0) &&
751 (jindex < 16)) {
752 baud = bauds[iindex][jindex];
753 } else {
754 baud = 0;
755 }
756
757 if (baud == 0)
758 baud = 9600;
759
760
761 if (ch->ch_flags & CH_BAUD0) {
762 ch->ch_flags &= ~(CH_BAUD0);
763
764
765
766
767
768 if (!(ch->ch_digi.digi_flags & DIGI_RTS_TOGGLE))
769 ch->ch_mostat |= (UART_MCR_RTS);
770 if (!(ch->ch_digi.digi_flags & DIGI_DTR_TOGGLE))
771 ch->ch_mostat |= (UART_MCR_DTR);
772 }
773 }
774
775 if (ch->ch_c_cflag & PARENB)
776 lcr |= UART_LCR_PARITY;
777
778 if (!(ch->ch_c_cflag & PARODD))
779 lcr |= UART_LCR_EPAR;
780
781
782
783
784
785#ifdef CMSPAR
786 if (ch->ch_c_cflag & CMSPAR)
787 lcr |= UART_LCR_SPAR;
788#endif
789
790 if (ch->ch_c_cflag & CSTOPB)
791 lcr |= UART_LCR_STOP;
792
793 switch (ch->ch_c_cflag & CSIZE) {
794 case CS5:
795 lcr |= UART_LCR_WLEN5;
796 break;
797 case CS6:
798 lcr |= UART_LCR_WLEN6;
799 break;
800 case CS7:
801 lcr |= UART_LCR_WLEN7;
802 break;
803 case CS8:
804 default:
805 lcr |= UART_LCR_WLEN8;
806 break;
807 }
808
809 uart_ier = readb(&ch->ch_cls_uart->ier);
810 ier = uart_ier;
811 uart_lcr = readb(&ch->ch_cls_uart->lcr);
812
813 if (baud == 0)
814 baud = 9600;
815
816 quot = ch->ch_bd->bd_dividend / baud;
817
818 if (quot != 0 && ch->ch_old_baud != baud) {
819 ch->ch_old_baud = baud;
820 writeb(UART_LCR_DLAB, &ch->ch_cls_uart->lcr);
821 writeb((quot & 0xff), &ch->ch_cls_uart->txrx);
822 writeb((quot >> 8), &ch->ch_cls_uart->ier);
823 writeb(lcr, &ch->ch_cls_uart->lcr);
824 }
825
826 if (uart_lcr != lcr)
827 writeb(lcr, &ch->ch_cls_uart->lcr);
828
829 if (ch->ch_c_cflag & CREAD)
830 ier |= (UART_IER_RDI | UART_IER_RLSI);
831 else
832 ier &= ~(UART_IER_RDI | UART_IER_RLSI);
833
834
835
836
837
838 if ((ch->ch_digi.digi_flags & CTSPACE) ||
839 (ch->ch_digi.digi_flags & RTSPACE) ||
840 (ch->ch_c_cflag & CRTSCTS) ||
841 !(ch->ch_digi.digi_flags & DIGI_FORCEDCD) ||
842 !(ch->ch_c_cflag & CLOCAL))
843 ier |= UART_IER_MSI;
844 else
845 ier &= ~UART_IER_MSI;
846
847 ier |= UART_IER_THRI;
848
849 if (ier != uart_ier)
850 writeb(ier, &ch->ch_cls_uart->ier);
851
852 if (ch->ch_digi.digi_flags & CTSPACE || ch->ch_c_cflag & CRTSCTS) {
853 cls_set_cts_flow_control(ch);
854 } else if (ch->ch_c_iflag & IXON) {
855
856
857
858
859 if ((ch->ch_startc == _POSIX_VDISABLE) ||
860 (ch->ch_stopc == _POSIX_VDISABLE))
861 cls_set_no_output_flow_control(ch);
862 else
863 cls_set_ixon_flow_control(ch);
864 } else {
865 cls_set_no_output_flow_control(ch);
866 }
867
868 if (ch->ch_digi.digi_flags & RTSPACE || ch->ch_c_cflag & CRTSCTS) {
869 cls_set_rts_flow_control(ch);
870 } else if (ch->ch_c_iflag & IXOFF) {
871
872
873
874
875 if ((ch->ch_startc == _POSIX_VDISABLE) ||
876 (ch->ch_stopc == _POSIX_VDISABLE))
877 cls_set_no_input_flow_control(ch);
878 else
879 cls_set_ixoff_flow_control(ch);
880 } else {
881 cls_set_no_input_flow_control(ch);
882 }
883
884 cls_assert_modem_signals(ch);
885
886
887 cls_parse_modem(ch, readb(&ch->ch_cls_uart->msr));
888}
889
890
891
892
893static void cls_tasklet(unsigned long data)
894{
895 struct dgnc_board *bd = (struct dgnc_board *)data;
896 struct channel_t *ch;
897 unsigned long flags;
898 int i;
899 int state = 0;
900 int ports = 0;
901
902 if (!bd || bd->magic != DGNC_BOARD_MAGIC)
903 return;
904
905
906 spin_lock_irqsave(&bd->bd_lock, flags);
907 state = bd->state;
908 ports = bd->nasync;
909 spin_unlock_irqrestore(&bd->bd_lock, flags);
910
911
912
913
914
915 spin_lock_irqsave(&bd->bd_intr_lock, flags);
916
917
918
919
920 if ((state == BOARD_READY) && (ports > 0)) {
921
922 for (i = 0; i < ports; i++) {
923 ch = bd->channels[i];
924
925
926
927
928
929
930
931
932 dgnc_input(ch);
933
934
935
936
937
938 cls_copy_data_from_queue_to_uart(ch);
939 dgnc_wakeup_writes(ch);
940
941
942
943
944 dgnc_carrier(ch);
945
946
947
948
949
950 if (ch->ch_stop_sending_break)
951 cls_clear_break(ch, 0);
952 }
953 }
954
955 spin_unlock_irqrestore(&bd->bd_intr_lock, flags);
956}
957
958
959
960
961
962
963static irqreturn_t cls_intr(int irq, void *voidbrd)
964{
965 struct dgnc_board *brd = voidbrd;
966 uint i = 0;
967 unsigned char poll_reg;
968 unsigned long flags;
969
970
971
972
973
974 if (!brd || brd->magic != DGNC_BOARD_MAGIC)
975 return IRQ_NONE;
976
977 spin_lock_irqsave(&brd->bd_intr_lock, flags);
978
979
980
981
982
983 poll_reg = readb(brd->re_map_membase + UART_CLASSIC_POLL_ADDR_OFFSET);
984
985
986 if (!poll_reg) {
987 spin_unlock_irqrestore(&brd->bd_intr_lock, flags);
988 return IRQ_NONE;
989 }
990
991
992 for (i = 0; i < brd->nasync; i++)
993 cls_parse_isr(brd, i);
994
995
996
997
998 tasklet_schedule(&brd->helper_tasklet);
999
1000 spin_unlock_irqrestore(&brd->bd_intr_lock, flags);
1001
1002 return IRQ_HANDLED;
1003}
1004
1005static void cls_disable_receiver(struct channel_t *ch)
1006{
1007 unsigned char tmp = readb(&ch->ch_cls_uart->ier);
1008
1009 tmp &= ~(UART_IER_RDI);
1010 writeb(tmp, &ch->ch_cls_uart->ier);
1011}
1012
1013static void cls_enable_receiver(struct channel_t *ch)
1014{
1015 unsigned char tmp = readb(&ch->ch_cls_uart->ier);
1016
1017 tmp |= (UART_IER_RDI);
1018 writeb(tmp, &ch->ch_cls_uart->ier);
1019}
1020
1021
1022
1023
1024
1025static int cls_drain(struct tty_struct *tty, uint seconds)
1026{
1027 unsigned long flags;
1028 struct channel_t *ch;
1029 struct un_t *un;
1030
1031 if (!tty || tty->magic != TTY_MAGIC)
1032 return -ENXIO;
1033
1034 un = (struct un_t *)tty->driver_data;
1035 if (!un || un->magic != DGNC_UNIT_MAGIC)
1036 return -ENXIO;
1037
1038 ch = un->un_ch;
1039 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1040 return -ENXIO;
1041
1042 spin_lock_irqsave(&ch->ch_lock, flags);
1043 un->un_flags |= UN_EMPTY;
1044 spin_unlock_irqrestore(&ch->ch_lock, flags);
1045
1046
1047
1048
1049
1050
1051
1052 return wait_event_interruptible(un->un_flags_wait,
1053 ((un->un_flags & UN_EMPTY) == 0));
1054}
1055
1056static void cls_send_start_character(struct channel_t *ch)
1057{
1058 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1059 return;
1060
1061 if (ch->ch_startc != _POSIX_VDISABLE) {
1062 ch->ch_xon_sends++;
1063 writeb(ch->ch_startc, &ch->ch_cls_uart->txrx);
1064 }
1065}
1066
1067static void cls_send_stop_character(struct channel_t *ch)
1068{
1069 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1070 return;
1071
1072 if (ch->ch_stopc != _POSIX_VDISABLE) {
1073 ch->ch_xoff_sends++;
1074 writeb(ch->ch_stopc, &ch->ch_cls_uart->txrx);
1075 }
1076}
1077
1078
1079static void cls_uart_init(struct channel_t *ch)
1080{
1081 unsigned char lcrb = readb(&ch->ch_cls_uart->lcr);
1082 unsigned char isr_fcr = 0;
1083
1084 writeb(0, &ch->ch_cls_uart->ier);
1085
1086
1087
1088
1089
1090 writeb(UART_EXAR654_ENHANCED_REGISTER_SET, &ch->ch_cls_uart->lcr);
1091
1092 isr_fcr = readb(&ch->ch_cls_uart->isr_fcr);
1093
1094
1095 isr_fcr |= (UART_EXAR654_EFR_ECB);
1096
1097 writeb(isr_fcr, &ch->ch_cls_uart->isr_fcr);
1098
1099
1100 writeb(lcrb, &ch->ch_cls_uart->lcr);
1101
1102
1103 readb(&ch->ch_cls_uart->txrx);
1104
1105 writeb(UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
1106 &ch->ch_cls_uart->isr_fcr);
1107 udelay(10);
1108
1109 ch->ch_flags |= (CH_FIFO_ENABLED | CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM);
1110
1111 readb(&ch->ch_cls_uart->lsr);
1112 readb(&ch->ch_cls_uart->msr);
1113}
1114
1115
1116
1117
1118static void cls_uart_off(struct channel_t *ch)
1119{
1120 writeb(0, &ch->ch_cls_uart->ier);
1121}
1122
1123
1124
1125
1126
1127
1128
1129static uint cls_get_uart_bytes_left(struct channel_t *ch)
1130{
1131 unsigned char left = 0;
1132 unsigned char lsr = 0;
1133
1134 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1135 return 0;
1136
1137 lsr = readb(&ch->ch_cls_uart->lsr);
1138
1139
1140 if (!(lsr & UART_LSR_TEMT)) {
1141 if (ch->ch_flags & CH_TX_FIFO_EMPTY)
1142 tasklet_schedule(&ch->ch_bd->helper_tasklet);
1143 left = 1;
1144 } else {
1145 ch->ch_flags |= (CH_TX_FIFO_EMPTY | CH_TX_FIFO_LWM);
1146 left = 0;
1147 }
1148
1149 return left;
1150}
1151
1152
1153
1154
1155
1156
1157
1158static void cls_send_break(struct channel_t *ch, int msecs)
1159{
1160 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1161 return;
1162
1163
1164
1165
1166 if (msecs == 0) {
1167
1168 if (ch->ch_flags & CH_BREAK_SENDING) {
1169 unsigned char temp = readb(&ch->ch_cls_uart->lcr);
1170
1171 writeb((temp & ~UART_LCR_SBC), &ch->ch_cls_uart->lcr);
1172 ch->ch_flags &= ~(CH_BREAK_SENDING);
1173 ch->ch_stop_sending_break = 0;
1174 }
1175 return;
1176 }
1177
1178
1179
1180
1181
1182
1183 ch->ch_stop_sending_break = jiffies + dgnc_jiffies_from_ms(msecs);
1184
1185
1186 if (!(ch->ch_flags & CH_BREAK_SENDING)) {
1187 unsigned char temp = readb(&ch->ch_cls_uart->lcr);
1188
1189 writeb((temp | UART_LCR_SBC), &ch->ch_cls_uart->lcr);
1190 ch->ch_flags |= (CH_BREAK_SENDING);
1191 }
1192}
1193
1194
1195
1196
1197
1198
1199
1200
1201static void cls_send_immediate_char(struct channel_t *ch, unsigned char c)
1202{
1203 if (!ch || ch->magic != DGNC_CHANNEL_MAGIC)
1204 return;
1205
1206 writeb(c, &ch->ch_cls_uart->txrx);
1207}
1208
1209static void cls_vpd(struct dgnc_board *brd)
1210{
1211 ulong vpdbase;
1212 u8 __iomem *re_map_vpdbase;
1213 int i = 0;
1214
1215 vpdbase = pci_resource_start(brd->pdev, 3);
1216
1217
1218 if (!vpdbase)
1219 return;
1220
1221 re_map_vpdbase = ioremap(vpdbase, 0x400);
1222
1223 if (!re_map_vpdbase)
1224 return;
1225
1226
1227 for (i = 0; i < 0x40; i++) {
1228 brd->vpd[i] = readb(re_map_vpdbase + i);
1229 pr_info("%x ", brd->vpd[i]);
1230 }
1231 pr_info("\n");
1232
1233 iounmap(re_map_vpdbase);
1234}
1235
1236struct board_ops dgnc_cls_ops = {
1237 .tasklet = cls_tasklet,
1238 .intr = cls_intr,
1239 .uart_init = cls_uart_init,
1240 .uart_off = cls_uart_off,
1241 .drain = cls_drain,
1242 .param = cls_param,
1243 .vpd = cls_vpd,
1244 .assert_modem_signals = cls_assert_modem_signals,
1245 .flush_uart_write = cls_flush_uart_write,
1246 .flush_uart_read = cls_flush_uart_read,
1247 .disable_receiver = cls_disable_receiver,
1248 .enable_receiver = cls_enable_receiver,
1249 .send_break = cls_send_break,
1250 .send_start_character = cls_send_start_character,
1251 .send_stop_character = cls_send_stop_character,
1252 .copy_data_from_queue_to_uart = cls_copy_data_from_queue_to_uart,
1253 .get_uart_bytes_left = cls_get_uart_bytes_left,
1254 .send_immediate_char = cls_send_immediate_char
1255};
1256