1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#if defined(CONFIG_SERIAL_8250_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
22#define SUPPORT_SYSRQ
23#endif
24
25#include <linux/module.h>
26#include <linux/moduleparam.h>
27#include <linux/ioport.h>
28#include <linux/init.h>
29#include <linux/console.h>
30#include <linux/sysrq.h>
31#include <linux/delay.h>
32#include <linux/platform_device.h>
33#include <linux/tty.h>
34#include <linux/tty_flip.h>
35#include <linux/serial_reg.h>
36#include <linux/serial_core.h>
37#include <linux/serial.h>
38#include <linux/serial_8250.h>
39#include <linux/nmi.h>
40#include <linux/mutex.h>
41
42#include <asm/io.h>
43#include <asm/irq.h>
44
45#include "8250.h"
46
47#ifdef CONFIG_SPARC
48#include "suncore.h"
49#endif
50
51
52
53
54
55
56static unsigned int share_irqs = SERIAL8250_SHARE_IRQS;
57
58static unsigned int nr_uarts = CONFIG_SERIAL_8250_RUNTIME_UARTS;
59
60static struct uart_driver serial8250_reg;
61
62static int serial_index(struct uart_port *port)
63{
64 return (serial8250_reg.minor - 64) + port->line;
65}
66
67
68
69
70#if 0
71#define DEBUG_AUTOCONF(fmt...) printk(fmt)
72#else
73#define DEBUG_AUTOCONF(fmt...) do { } while (0)
74#endif
75
76#if 0
77#define DEBUG_INTR(fmt...) printk(fmt)
78#else
79#define DEBUG_INTR(fmt...) do { } while (0)
80#endif
81
82#define PASS_LIMIT 256
83
84
85
86
87
88
89#define is_real_interrupt(irq) ((irq) != 0)
90
91#ifdef CONFIG_SERIAL_8250_DETECT_IRQ
92#define CONFIG_SERIAL_DETECT_IRQ 1
93#endif
94#ifdef CONFIG_SERIAL_8250_MANY_PORTS
95#define CONFIG_SERIAL_MANY_PORTS 1
96#endif
97
98
99
100
101
102#define CONFIG_HUB6 1
103
104#include <asm/serial.h>
105
106
107
108
109
110#ifndef SERIAL_PORT_DFNS
111#define SERIAL_PORT_DFNS
112#endif
113
114static const struct old_serial_port old_serial_port[] = {
115 SERIAL_PORT_DFNS
116};
117
118#define UART_NR CONFIG_SERIAL_8250_NR_UARTS
119
120#ifdef CONFIG_SERIAL_8250_RSA
121
122#define PORT_RSA_MAX 4
123static unsigned long probe_rsa[PORT_RSA_MAX];
124static unsigned int probe_rsa_count;
125#endif
126
127struct uart_8250_port {
128 struct uart_port port;
129 struct timer_list timer;
130 struct list_head list;
131 unsigned short capabilities;
132 unsigned short bugs;
133 unsigned int tx_loadsz;
134 unsigned char acr;
135 unsigned char ier;
136 unsigned char lcr;
137 unsigned char mcr;
138 unsigned char mcr_mask;
139 unsigned char mcr_force;
140
141
142
143
144
145
146#define LSR_SAVE_FLAGS UART_LSR_BRK_ERROR_BITS
147 unsigned char lsr_saved_flags;
148#define MSR_SAVE_FLAGS UART_MSR_ANY_DELTA
149 unsigned char msr_saved_flags;
150
151
152
153
154 void (*pm)(struct uart_port *port,
155 unsigned int state, unsigned int old);
156};
157
158struct irq_info {
159 struct hlist_node node;
160 int irq;
161 spinlock_t lock;
162 struct list_head *head;
163};
164
165#define NR_IRQ_HASH 32
166static struct hlist_head irq_lists[NR_IRQ_HASH];
167static DEFINE_MUTEX(hash_mutex);
168
169
170
171
172static const struct serial8250_config uart_config[] = {
173 [PORT_UNKNOWN] = {
174 .name = "unknown",
175 .fifo_size = 1,
176 .tx_loadsz = 1,
177 },
178 [PORT_8250] = {
179 .name = "8250",
180 .fifo_size = 1,
181 .tx_loadsz = 1,
182 },
183 [PORT_16450] = {
184 .name = "16450",
185 .fifo_size = 1,
186 .tx_loadsz = 1,
187 },
188 [PORT_16550] = {
189 .name = "16550",
190 .fifo_size = 1,
191 .tx_loadsz = 1,
192 },
193 [PORT_16550A] = {
194 .name = "16550A",
195 .fifo_size = 16,
196 .tx_loadsz = 16,
197 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
198 .flags = UART_CAP_FIFO,
199 },
200 [PORT_CIRRUS] = {
201 .name = "Cirrus",
202 .fifo_size = 1,
203 .tx_loadsz = 1,
204 },
205 [PORT_16650] = {
206 .name = "ST16650",
207 .fifo_size = 1,
208 .tx_loadsz = 1,
209 .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
210 },
211 [PORT_16650V2] = {
212 .name = "ST16650V2",
213 .fifo_size = 32,
214 .tx_loadsz = 16,
215 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
216 UART_FCR_T_TRIG_00,
217 .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
218 },
219 [PORT_16750] = {
220 .name = "TI16750",
221 .fifo_size = 64,
222 .tx_loadsz = 64,
223 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10 |
224 UART_FCR7_64BYTE,
225 .flags = UART_CAP_FIFO | UART_CAP_SLEEP | UART_CAP_AFE,
226 },
227 [PORT_STARTECH] = {
228 .name = "Startech",
229 .fifo_size = 1,
230 .tx_loadsz = 1,
231 },
232 [PORT_16C950] = {
233 .name = "16C950/954",
234 .fifo_size = 128,
235 .tx_loadsz = 128,
236 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
237 .flags = UART_CAP_FIFO,
238 },
239 [PORT_16654] = {
240 .name = "ST16654",
241 .fifo_size = 64,
242 .tx_loadsz = 32,
243 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
244 UART_FCR_T_TRIG_10,
245 .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
246 },
247 [PORT_16850] = {
248 .name = "XR16850",
249 .fifo_size = 128,
250 .tx_loadsz = 128,
251 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
252 .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
253 },
254 [PORT_RSA] = {
255 .name = "RSA",
256 .fifo_size = 2048,
257 .tx_loadsz = 2048,
258 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_11,
259 .flags = UART_CAP_FIFO,
260 },
261 [PORT_NS16550A] = {
262 .name = "NS16550A",
263 .fifo_size = 16,
264 .tx_loadsz = 16,
265 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
266 .flags = UART_CAP_FIFO | UART_NATSEMI,
267 },
268 [PORT_XSCALE] = {
269 .name = "XScale",
270 .fifo_size = 32,
271 .tx_loadsz = 32,
272 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
273 .flags = UART_CAP_FIFO | UART_CAP_UUE,
274 },
275 [PORT_RM9000] = {
276 .name = "RM9000",
277 .fifo_size = 16,
278 .tx_loadsz = 16,
279 .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
280 .flags = UART_CAP_FIFO,
281 },
282};
283
284#if defined (CONFIG_SERIAL_8250_AU1X00)
285
286
287static const u8 au_io_in_map[] = {
288 [UART_RX] = 0,
289 [UART_IER] = 2,
290 [UART_IIR] = 3,
291 [UART_LCR] = 5,
292 [UART_MCR] = 6,
293 [UART_LSR] = 7,
294 [UART_MSR] = 8,
295};
296
297static const u8 au_io_out_map[] = {
298 [UART_TX] = 1,
299 [UART_IER] = 2,
300 [UART_FCR] = 4,
301 [UART_LCR] = 5,
302 [UART_MCR] = 6,
303};
304
305
306static inline int map_8250_in_reg(struct uart_8250_port *up, int offset)
307{
308 if (up->port.iotype != UPIO_AU)
309 return offset;
310 return au_io_in_map[offset];
311}
312
313static inline int map_8250_out_reg(struct uart_8250_port *up, int offset)
314{
315 if (up->port.iotype != UPIO_AU)
316 return offset;
317 return au_io_out_map[offset];
318}
319
320#elif defined(CONFIG_SERIAL_8250_RM9K)
321
322static const u8
323 regmap_in[8] = {
324 [UART_RX] = 0x00,
325 [UART_IER] = 0x0c,
326 [UART_IIR] = 0x14,
327 [UART_LCR] = 0x1c,
328 [UART_MCR] = 0x20,
329 [UART_LSR] = 0x24,
330 [UART_MSR] = 0x28,
331 [UART_SCR] = 0x2c
332 },
333 regmap_out[8] = {
334 [UART_TX] = 0x04,
335 [UART_IER] = 0x0c,
336 [UART_FCR] = 0x18,
337 [UART_LCR] = 0x1c,
338 [UART_MCR] = 0x20,
339 [UART_LSR] = 0x24,
340 [UART_MSR] = 0x28,
341 [UART_SCR] = 0x2c
342 };
343
344static inline int map_8250_in_reg(struct uart_8250_port *up, int offset)
345{
346 if (up->port.iotype != UPIO_RM9000)
347 return offset;
348 return regmap_in[offset];
349}
350
351static inline int map_8250_out_reg(struct uart_8250_port *up, int offset)
352{
353 if (up->port.iotype != UPIO_RM9000)
354 return offset;
355 return regmap_out[offset];
356}
357
358#else
359
360
361#define map_8250_in_reg(up, offset) (offset)
362#define map_8250_out_reg(up, offset) (offset)
363
364#endif
365
366static unsigned int serial_in(struct uart_8250_port *up, int offset)
367{
368 unsigned int tmp;
369 offset = map_8250_in_reg(up, offset) << up->port.regshift;
370
371 switch (up->port.iotype) {
372 case UPIO_HUB6:
373 outb(up->port.hub6 - 1 + offset, up->port.iobase);
374 return inb(up->port.iobase + 1);
375
376 case UPIO_MEM:
377 case UPIO_DWAPB:
378 return readb(up->port.membase + offset);
379
380 case UPIO_RM9000:
381 case UPIO_MEM32:
382 return readl(up->port.membase + offset);
383
384#ifdef CONFIG_SERIAL_8250_AU1X00
385 case UPIO_AU:
386 return __raw_readl(up->port.membase + offset);
387#endif
388
389 case UPIO_TSI:
390 if (offset == UART_IIR) {
391 tmp = readl(up->port.membase + (UART_IIR & ~3));
392 return (tmp >> 16) & 0xff;
393 } else
394 return readb(up->port.membase + offset);
395
396 default:
397 return inb(up->port.iobase + offset);
398 }
399}
400
401static void
402serial_out(struct uart_8250_port *up, int offset, int value)
403{
404
405 int save_offset = offset;
406 offset = map_8250_out_reg(up, offset) << up->port.regshift;
407
408 switch (up->port.iotype) {
409 case UPIO_HUB6:
410 outb(up->port.hub6 - 1 + offset, up->port.iobase);
411 outb(value, up->port.iobase + 1);
412 break;
413
414 case UPIO_MEM:
415 writeb(value, up->port.membase + offset);
416 break;
417
418 case UPIO_RM9000:
419 case UPIO_MEM32:
420 writel(value, up->port.membase + offset);
421 break;
422
423#ifdef CONFIG_SERIAL_8250_AU1X00
424 case UPIO_AU:
425 __raw_writel(value, up->port.membase + offset);
426 break;
427#endif
428 case UPIO_TSI:
429 if (!((offset == UART_IER) && (value & UART_IER_UUE)))
430 writeb(value, up->port.membase + offset);
431 break;
432
433 case UPIO_DWAPB:
434
435
436 if (save_offset == UART_LCR)
437 up->lcr = value;
438 writeb(value, up->port.membase + offset);
439
440
441 if (save_offset == UART_TX || save_offset == UART_IER)
442 value = serial_in(up, UART_IER);
443 break;
444
445 default:
446 outb(value, up->port.iobase + offset);
447 }
448}
449
450static void
451serial_out_sync(struct uart_8250_port *up, int offset, int value)
452{
453 switch (up->port.iotype) {
454 case UPIO_MEM:
455 case UPIO_MEM32:
456#ifdef CONFIG_SERIAL_8250_AU1X00
457 case UPIO_AU:
458#endif
459 case UPIO_DWAPB:
460 serial_out(up, offset, value);
461 serial_in(up, UART_LCR);
462 break;
463 default:
464 serial_out(up, offset, value);
465 }
466}
467
468
469
470
471
472
473
474#define serial_inp(up, offset) serial_in(up, offset)
475#define serial_outp(up, offset, value) serial_out(up, offset, value)
476
477
478static inline int _serial_dl_read(struct uart_8250_port *up)
479{
480 return serial_inp(up, UART_DLL) | serial_inp(up, UART_DLM) << 8;
481}
482
483
484static inline void _serial_dl_write(struct uart_8250_port *up, int value)
485{
486 serial_outp(up, UART_DLL, value & 0xff);
487 serial_outp(up, UART_DLM, value >> 8 & 0xff);
488}
489
490#if defined(CONFIG_SERIAL_8250_AU1X00)
491
492static int serial_dl_read(struct uart_8250_port *up)
493{
494 if (up->port.iotype == UPIO_AU)
495 return __raw_readl(up->port.membase + 0x28);
496 else
497 return _serial_dl_read(up);
498}
499
500static void serial_dl_write(struct uart_8250_port *up, int value)
501{
502 if (up->port.iotype == UPIO_AU)
503 __raw_writel(value, up->port.membase + 0x28);
504 else
505 _serial_dl_write(up, value);
506}
507#elif defined(CONFIG_SERIAL_8250_RM9K)
508static int serial_dl_read(struct uart_8250_port *up)
509{
510 return (up->port.iotype == UPIO_RM9000) ?
511 (((__raw_readl(up->port.membase + 0x10) << 8) |
512 (__raw_readl(up->port.membase + 0x08) & 0xff)) & 0xffff) :
513 _serial_dl_read(up);
514}
515
516static void serial_dl_write(struct uart_8250_port *up, int value)
517{
518 if (up->port.iotype == UPIO_RM9000) {
519 __raw_writel(value, up->port.membase + 0x08);
520 __raw_writel(value >> 8, up->port.membase + 0x10);
521 } else {
522 _serial_dl_write(up, value);
523 }
524}
525#else
526#define serial_dl_read(up) _serial_dl_read(up)
527#define serial_dl_write(up, value) _serial_dl_write(up, value)
528#endif
529
530
531
532
533static void serial_icr_write(struct uart_8250_port *up, int offset, int value)
534{
535 serial_out(up, UART_SCR, offset);
536 serial_out(up, UART_ICR, value);
537}
538
539static unsigned int serial_icr_read(struct uart_8250_port *up, int offset)
540{
541 unsigned int value;
542
543 serial_icr_write(up, UART_ACR, up->acr | UART_ACR_ICRRD);
544 serial_out(up, UART_SCR, offset);
545 value = serial_in(up, UART_ICR);
546 serial_icr_write(up, UART_ACR, up->acr);
547
548 return value;
549}
550
551
552
553
554static void serial8250_clear_fifos(struct uart_8250_port *p)
555{
556 if (p->capabilities & UART_CAP_FIFO) {
557 serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO);
558 serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO |
559 UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
560 serial_outp(p, UART_FCR, 0);
561 }
562}
563
564
565
566
567
568
569static void serial8250_set_sleep(struct uart_8250_port *p, int sleep)
570{
571 if (p->capabilities & UART_CAP_SLEEP) {
572 if (p->capabilities & UART_CAP_EFR) {
573 serial_outp(p, UART_LCR, 0xBF);
574 serial_outp(p, UART_EFR, UART_EFR_ECB);
575 serial_outp(p, UART_LCR, 0);
576 }
577 serial_outp(p, UART_IER, sleep ? UART_IERX_SLEEP : 0);
578 if (p->capabilities & UART_CAP_EFR) {
579 serial_outp(p, UART_LCR, 0xBF);
580 serial_outp(p, UART_EFR, 0);
581 serial_outp(p, UART_LCR, 0);
582 }
583 }
584}
585
586#ifdef CONFIG_SERIAL_8250_RSA
587
588
589
590
591static int __enable_rsa(struct uart_8250_port *up)
592{
593 unsigned char mode;
594 int result;
595
596 mode = serial_inp(up, UART_RSA_MSR);
597 result = mode & UART_RSA_MSR_FIFO;
598
599 if (!result) {
600 serial_outp(up, UART_RSA_MSR, mode | UART_RSA_MSR_FIFO);
601 mode = serial_inp(up, UART_RSA_MSR);
602 result = mode & UART_RSA_MSR_FIFO;
603 }
604
605 if (result)
606 up->port.uartclk = SERIAL_RSA_BAUD_BASE * 16;
607
608 return result;
609}
610
611static void enable_rsa(struct uart_8250_port *up)
612{
613 if (up->port.type == PORT_RSA) {
614 if (up->port.uartclk != SERIAL_RSA_BAUD_BASE * 16) {
615 spin_lock_irq(&up->port.lock);
616 __enable_rsa(up);
617 spin_unlock_irq(&up->port.lock);
618 }
619 if (up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16)
620 serial_outp(up, UART_RSA_FRR, 0);
621 }
622}
623
624
625
626
627
628
629
630static void disable_rsa(struct uart_8250_port *up)
631{
632 unsigned char mode;
633 int result;
634
635 if (up->port.type == PORT_RSA &&
636 up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) {
637 spin_lock_irq(&up->port.lock);
638
639 mode = serial_inp(up, UART_RSA_MSR);
640 result = !(mode & UART_RSA_MSR_FIFO);
641
642 if (!result) {
643 serial_outp(up, UART_RSA_MSR, mode & ~UART_RSA_MSR_FIFO);
644 mode = serial_inp(up, UART_RSA_MSR);
645 result = !(mode & UART_RSA_MSR_FIFO);
646 }
647
648 if (result)
649 up->port.uartclk = SERIAL_RSA_BAUD_BASE_LO * 16;
650 spin_unlock_irq(&up->port.lock);
651 }
652}
653#endif
654
655
656
657
658
659static int size_fifo(struct uart_8250_port *up)
660{
661 unsigned char old_fcr, old_mcr, old_lcr;
662 unsigned short old_dl;
663 int count;
664
665 old_lcr = serial_inp(up, UART_LCR);
666 serial_outp(up, UART_LCR, 0);
667 old_fcr = serial_inp(up, UART_FCR);
668 old_mcr = serial_inp(up, UART_MCR);
669 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO |
670 UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
671 serial_outp(up, UART_MCR, UART_MCR_LOOP);
672 serial_outp(up, UART_LCR, UART_LCR_DLAB);
673 old_dl = serial_dl_read(up);
674 serial_dl_write(up, 0x0001);
675 serial_outp(up, UART_LCR, 0x03);
676 for (count = 0; count < 256; count++)
677 serial_outp(up, UART_TX, count);
678 mdelay(20);
679 for (count = 0; (serial_inp(up, UART_LSR) & UART_LSR_DR) &&
680 (count < 256); count++)
681 serial_inp(up, UART_RX);
682 serial_outp(up, UART_FCR, old_fcr);
683 serial_outp(up, UART_MCR, old_mcr);
684 serial_outp(up, UART_LCR, UART_LCR_DLAB);
685 serial_dl_write(up, old_dl);
686 serial_outp(up, UART_LCR, old_lcr);
687
688 return count;
689}
690
691
692
693
694
695
696static unsigned int autoconfig_read_divisor_id(struct uart_8250_port *p)
697{
698 unsigned char old_dll, old_dlm, old_lcr;
699 unsigned int id;
700
701 old_lcr = serial_inp(p, UART_LCR);
702 serial_outp(p, UART_LCR, UART_LCR_DLAB);
703
704 old_dll = serial_inp(p, UART_DLL);
705 old_dlm = serial_inp(p, UART_DLM);
706
707 serial_outp(p, UART_DLL, 0);
708 serial_outp(p, UART_DLM, 0);
709
710 id = serial_inp(p, UART_DLL) | serial_inp(p, UART_DLM) << 8;
711
712 serial_outp(p, UART_DLL, old_dll);
713 serial_outp(p, UART_DLM, old_dlm);
714 serial_outp(p, UART_LCR, old_lcr);
715
716 return id;
717}
718
719
720
721
722
723
724
725
726
727
728
729static void autoconfig_has_efr(struct uart_8250_port *up)
730{
731 unsigned int id1, id2, id3, rev;
732
733
734
735
736 up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755 up->acr = 0;
756 serial_out(up, UART_LCR, 0xBF);
757 serial_out(up, UART_EFR, UART_EFR_ECB);
758 serial_out(up, UART_LCR, 0x00);
759 id1 = serial_icr_read(up, UART_ID1);
760 id2 = serial_icr_read(up, UART_ID2);
761 id3 = serial_icr_read(up, UART_ID3);
762 rev = serial_icr_read(up, UART_REV);
763
764 DEBUG_AUTOCONF("950id=%02x:%02x:%02x:%02x ", id1, id2, id3, rev);
765
766 if (id1 == 0x16 && id2 == 0xC9 &&
767 (id3 == 0x50 || id3 == 0x52 || id3 == 0x54)) {
768 up->port.type = PORT_16C950;
769
770
771
772
773
774
775 if (id3 == 0x52 && rev == 0x01)
776 up->bugs |= UART_BUG_QUOT;
777 return;
778 }
779
780
781
782
783
784
785
786
787
788 id1 = autoconfig_read_divisor_id(up);
789 DEBUG_AUTOCONF("850id=%04x ", id1);
790
791 id2 = id1 >> 8;
792 if (id2 == 0x10 || id2 == 0x12 || id2 == 0x14) {
793 up->port.type = PORT_16850;
794 return;
795 }
796
797
798
799
800
801
802
803
804
805
806 if (size_fifo(up) == 64)
807 up->port.type = PORT_16654;
808 else
809 up->port.type = PORT_16650V2;
810}
811
812
813
814
815
816
817static void autoconfig_8250(struct uart_8250_port *up)
818{
819 unsigned char scratch, status1, status2;
820
821 up->port.type = PORT_8250;
822
823 scratch = serial_in(up, UART_SCR);
824 serial_outp(up, UART_SCR, 0xa5);
825 status1 = serial_in(up, UART_SCR);
826 serial_outp(up, UART_SCR, 0x5a);
827 status2 = serial_in(up, UART_SCR);
828 serial_outp(up, UART_SCR, scratch);
829
830 if (status1 == 0xa5 && status2 == 0x5a)
831 up->port.type = PORT_16450;
832}
833
834static int broken_efr(struct uart_8250_port *up)
835{
836
837
838
839
840
841 if (autoconfig_read_divisor_id(up) == 0x0201 && size_fifo(up) == 16)
842 return 1;
843
844 return 0;
845}
846
847
848
849
850
851
852
853static void autoconfig_16550a(struct uart_8250_port *up)
854{
855 unsigned char status1, status2;
856 unsigned int iersave;
857
858 up->port.type = PORT_16550A;
859 up->capabilities |= UART_CAP_FIFO;
860
861
862
863
864
865 serial_outp(up, UART_LCR, UART_LCR_DLAB);
866 if (serial_in(up, UART_EFR) == 0) {
867 serial_outp(up, UART_EFR, 0xA8);
868 if (serial_in(up, UART_EFR) != 0) {
869 DEBUG_AUTOCONF("EFRv1 ");
870 up->port.type = PORT_16650;
871 up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
872 } else {
873 DEBUG_AUTOCONF("Motorola 8xxx DUART ");
874 }
875 serial_outp(up, UART_EFR, 0);
876 return;
877 }
878
879
880
881
882
883 serial_outp(up, UART_LCR, 0xBF);
884 if (serial_in(up, UART_EFR) == 0 && !broken_efr(up)) {
885 DEBUG_AUTOCONF("EFRv2 ");
886 autoconfig_has_efr(up);
887 return;
888 }
889
890
891
892
893
894
895
896
897 serial_outp(up, UART_LCR, 0);
898 status1 = serial_in(up, UART_MCR);
899 serial_outp(up, UART_LCR, 0xE0);
900 status2 = serial_in(up, 0x02);
901
902 if (!((status2 ^ status1) & UART_MCR_LOOP)) {
903 serial_outp(up, UART_LCR, 0);
904 serial_outp(up, UART_MCR, status1 ^ UART_MCR_LOOP);
905 serial_outp(up, UART_LCR, 0xE0);
906 status2 = serial_in(up, 0x02);
907 serial_outp(up, UART_LCR, 0);
908 serial_outp(up, UART_MCR, status1);
909
910 if ((status2 ^ status1) & UART_MCR_LOOP) {
911 unsigned short quot;
912
913 serial_outp(up, UART_LCR, 0xE0);
914
915 quot = serial_dl_read(up);
916 quot <<= 3;
917
918 status1 = serial_in(up, 0x04);
919 status1 &= ~0xB0;
920 status1 |= 0x10;
921 serial_outp(up, 0x04, status1);
922
923 serial_dl_write(up, quot);
924
925 serial_outp(up, UART_LCR, 0);
926
927 up->port.uartclk = 921600*16;
928 up->port.type = PORT_NS16550A;
929 up->capabilities |= UART_NATSEMI;
930 return;
931 }
932 }
933
934
935
936
937
938
939
940 serial_outp(up, UART_LCR, 0);
941 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
942 status1 = serial_in(up, UART_IIR) >> 5;
943 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
944 serial_outp(up, UART_LCR, UART_LCR_DLAB);
945 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
946 status2 = serial_in(up, UART_IIR) >> 5;
947 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
948 serial_outp(up, UART_LCR, 0);
949
950 DEBUG_AUTOCONF("iir1=%d iir2=%d ", status1, status2);
951
952 if (status1 == 6 && status2 == 7) {
953 up->port.type = PORT_16750;
954 up->capabilities |= UART_CAP_AFE | UART_CAP_SLEEP;
955 return;
956 }
957
958
959
960
961
962
963
964
965
966 iersave = serial_in(up, UART_IER);
967 serial_outp(up, UART_IER, iersave & ~UART_IER_UUE);
968 if (!(serial_in(up, UART_IER) & UART_IER_UUE)) {
969
970
971
972
973 serial_outp(up, UART_IER, iersave | UART_IER_UUE);
974 if (serial_in(up, UART_IER) & UART_IER_UUE) {
975
976
977
978
979 DEBUG_AUTOCONF("Xscale ");
980 up->port.type = PORT_XSCALE;
981 up->capabilities |= UART_CAP_UUE;
982 return;
983 }
984 } else {
985
986
987
988
989 DEBUG_AUTOCONF("Couldn't force IER_UUE to 0 ");
990 }
991 serial_outp(up, UART_IER, iersave);
992}
993
994
995
996
997
998
999
1000
1001static void autoconfig(struct uart_8250_port *up, unsigned int probeflags)
1002{
1003 unsigned char status1, scratch, scratch2, scratch3;
1004 unsigned char save_lcr, save_mcr;
1005 unsigned long flags;
1006
1007 if (!up->port.iobase && !up->port.mapbase && !up->port.membase)
1008 return;
1009
1010 DEBUG_AUTOCONF("ttyS%d: autoconf (0x%04x, 0x%p): ",
1011 serial_index(&up->port), up->port.iobase, up->port.membase);
1012
1013
1014
1015
1016
1017 spin_lock_irqsave(&up->port.lock, flags);
1018
1019 up->capabilities = 0;
1020 up->bugs = 0;
1021
1022 if (!(up->port.flags & UPF_BUGGY_UART)) {
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036 scratch = serial_inp(up, UART_IER);
1037 serial_outp(up, UART_IER, 0);
1038#ifdef __i386__
1039 outb(0xff, 0x080);
1040#endif
1041
1042
1043
1044
1045 scratch2 = serial_inp(up, UART_IER) & 0x0f;
1046 serial_outp(up, UART_IER, 0x0F);
1047#ifdef __i386__
1048 outb(0, 0x080);
1049#endif
1050 scratch3 = serial_inp(up, UART_IER) & 0x0f;
1051 serial_outp(up, UART_IER, scratch);
1052 if (scratch2 != 0 || scratch3 != 0x0F) {
1053
1054
1055
1056 DEBUG_AUTOCONF("IER test failed (%02x, %02x) ",
1057 scratch2, scratch3);
1058 goto out;
1059 }
1060 }
1061
1062 save_mcr = serial_in(up, UART_MCR);
1063 save_lcr = serial_in(up, UART_LCR);
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074 if (!(up->port.flags & UPF_SKIP_TEST)) {
1075 serial_outp(up, UART_MCR, UART_MCR_LOOP | 0x0A);
1076 status1 = serial_inp(up, UART_MSR) & 0xF0;
1077 serial_outp(up, UART_MCR, save_mcr);
1078 if (status1 != 0x90) {
1079 DEBUG_AUTOCONF("LOOP test failed (%02x) ",
1080 status1);
1081 goto out;
1082 }
1083 }
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094 serial_outp(up, UART_LCR, 0xBF);
1095 serial_outp(up, UART_EFR, 0);
1096 serial_outp(up, UART_LCR, 0);
1097
1098 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
1099 scratch = serial_in(up, UART_IIR) >> 6;
1100
1101 DEBUG_AUTOCONF("iir=%d ", scratch);
1102
1103 switch (scratch) {
1104 case 0:
1105 autoconfig_8250(up);
1106 break;
1107 case 1:
1108 up->port.type = PORT_UNKNOWN;
1109 break;
1110 case 2:
1111 up->port.type = PORT_16550;
1112 break;
1113 case 3:
1114 autoconfig_16550a(up);
1115 break;
1116 }
1117
1118#ifdef CONFIG_SERIAL_8250_RSA
1119
1120
1121
1122 if (up->port.type == PORT_16550A && probeflags & PROBE_RSA) {
1123 int i;
1124
1125 for (i = 0 ; i < probe_rsa_count; ++i) {
1126 if (probe_rsa[i] == up->port.iobase &&
1127 __enable_rsa(up)) {
1128 up->port.type = PORT_RSA;
1129 break;
1130 }
1131 }
1132 }
1133#endif
1134
1135#ifdef CONFIG_SERIAL_8250_AU1X00
1136
1137 if (up->port.type == PORT_16550A && up->port.iotype == UPIO_AU)
1138 up->bugs |= UART_BUG_NOMSR;
1139#endif
1140
1141 serial_outp(up, UART_LCR, save_lcr);
1142
1143 if (up->capabilities != uart_config[up->port.type].flags) {
1144 printk(KERN_WARNING
1145 "ttyS%d: detected caps %08x should be %08x\n",
1146 serial_index(&up->port), up->capabilities,
1147 uart_config[up->port.type].flags);
1148 }
1149
1150 up->port.fifosize = uart_config[up->port.type].fifo_size;
1151 up->capabilities = uart_config[up->port.type].flags;
1152 up->tx_loadsz = uart_config[up->port.type].tx_loadsz;
1153
1154 if (up->port.type == PORT_UNKNOWN)
1155 goto out;
1156
1157
1158
1159
1160#ifdef CONFIG_SERIAL_8250_RSA
1161 if (up->port.type == PORT_RSA)
1162 serial_outp(up, UART_RSA_FRR, 0);
1163#endif
1164 serial_outp(up, UART_MCR, save_mcr);
1165 serial8250_clear_fifos(up);
1166 serial_in(up, UART_RX);
1167 if (up->capabilities & UART_CAP_UUE)
1168 serial_outp(up, UART_IER, UART_IER_UUE);
1169 else
1170 serial_outp(up, UART_IER, 0);
1171
1172 out:
1173 spin_unlock_irqrestore(&up->port.lock, flags);
1174 DEBUG_AUTOCONF("type=%s\n", uart_config[up->port.type].name);
1175}
1176
1177static void autoconfig_irq(struct uart_8250_port *up)
1178{
1179 unsigned char save_mcr, save_ier;
1180 unsigned char save_ICP = 0;
1181 unsigned int ICP = 0;
1182 unsigned long irqs;
1183 int irq;
1184
1185 if (up->port.flags & UPF_FOURPORT) {
1186 ICP = (up->port.iobase & 0xfe0) | 0x1f;
1187 save_ICP = inb_p(ICP);
1188 outb_p(0x80, ICP);
1189 (void) inb_p(ICP);
1190 }
1191
1192
1193 probe_irq_off(probe_irq_on());
1194 save_mcr = serial_inp(up, UART_MCR);
1195 save_ier = serial_inp(up, UART_IER);
1196 serial_outp(up, UART_MCR, UART_MCR_OUT1 | UART_MCR_OUT2);
1197
1198 irqs = probe_irq_on();
1199 serial_outp(up, UART_MCR, 0);
1200 udelay(10);
1201 if (up->port.flags & UPF_FOURPORT) {
1202 serial_outp(up, UART_MCR,
1203 UART_MCR_DTR | UART_MCR_RTS);
1204 } else {
1205 serial_outp(up, UART_MCR,
1206 UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2);
1207 }
1208 serial_outp(up, UART_IER, 0x0f);
1209 (void)serial_inp(up, UART_LSR);
1210 (void)serial_inp(up, UART_RX);
1211 (void)serial_inp(up, UART_IIR);
1212 (void)serial_inp(up, UART_MSR);
1213 serial_outp(up, UART_TX, 0xFF);
1214 udelay(20);
1215 irq = probe_irq_off(irqs);
1216
1217 serial_outp(up, UART_MCR, save_mcr);
1218 serial_outp(up, UART_IER, save_ier);
1219
1220 if (up->port.flags & UPF_FOURPORT)
1221 outb_p(save_ICP, ICP);
1222
1223 up->port.irq = (irq > 0) ? irq : 0;
1224}
1225
1226static inline void __stop_tx(struct uart_8250_port *p)
1227{
1228 if (p->ier & UART_IER_THRI) {
1229 p->ier &= ~UART_IER_THRI;
1230 serial_out(p, UART_IER, p->ier);
1231 }
1232}
1233
1234static void serial8250_stop_tx(struct uart_port *port)
1235{
1236 struct uart_8250_port *up = (struct uart_8250_port *)port;
1237
1238 __stop_tx(up);
1239
1240
1241
1242
1243 if (up->port.type == PORT_16C950) {
1244 up->acr |= UART_ACR_TXDIS;
1245 serial_icr_write(up, UART_ACR, up->acr);
1246 }
1247}
1248
1249static void transmit_chars(struct uart_8250_port *up);
1250
1251static void serial8250_start_tx(struct uart_port *port)
1252{
1253 struct uart_8250_port *up = (struct uart_8250_port *)port;
1254
1255 if (!(up->ier & UART_IER_THRI)) {
1256 up->ier |= UART_IER_THRI;
1257 serial_out(up, UART_IER, up->ier);
1258
1259 if (up->bugs & UART_BUG_TXEN) {
1260 unsigned char lsr, iir;
1261 lsr = serial_in(up, UART_LSR);
1262 up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
1263 iir = serial_in(up, UART_IIR) & 0x0f;
1264 if ((up->port.type == PORT_RM9000) ?
1265 (lsr & UART_LSR_THRE &&
1266 (iir == UART_IIR_NO_INT || iir == UART_IIR_THRI)) :
1267 (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT))
1268 transmit_chars(up);
1269 }
1270 }
1271
1272
1273
1274
1275 if (up->port.type == PORT_16C950 && up->acr & UART_ACR_TXDIS) {
1276 up->acr &= ~UART_ACR_TXDIS;
1277 serial_icr_write(up, UART_ACR, up->acr);
1278 }
1279}
1280
1281static void serial8250_stop_rx(struct uart_port *port)
1282{
1283 struct uart_8250_port *up = (struct uart_8250_port *)port;
1284
1285 up->ier &= ~UART_IER_RLSI;
1286 up->port.read_status_mask &= ~UART_LSR_DR;
1287 serial_out(up, UART_IER, up->ier);
1288}
1289
1290static void serial8250_enable_ms(struct uart_port *port)
1291{
1292 struct uart_8250_port *up = (struct uart_8250_port *)port;
1293
1294
1295 if (up->bugs & UART_BUG_NOMSR)
1296 return;
1297
1298 up->ier |= UART_IER_MSI;
1299 serial_out(up, UART_IER, up->ier);
1300}
1301
1302static void
1303receive_chars(struct uart_8250_port *up, unsigned int *status)
1304{
1305 struct tty_struct *tty = up->port.info->port.tty;
1306 unsigned char ch, lsr = *status;
1307 int max_count = 256;
1308 char flag;
1309
1310 do {
1311 if (likely(lsr & UART_LSR_DR))
1312 ch = serial_inp(up, UART_RX);
1313 else
1314
1315
1316
1317
1318
1319
1320
1321 ch = 0;
1322
1323 flag = TTY_NORMAL;
1324 up->port.icount.rx++;
1325
1326 lsr |= up->lsr_saved_flags;
1327 up->lsr_saved_flags = 0;
1328
1329 if (unlikely(lsr & UART_LSR_BRK_ERROR_BITS)) {
1330
1331
1332
1333 if (lsr & UART_LSR_BI) {
1334 lsr &= ~(UART_LSR_FE | UART_LSR_PE);
1335 up->port.icount.brk++;
1336
1337
1338
1339
1340
1341
1342 if (uart_handle_break(&up->port))
1343 goto ignore_char;
1344 } else if (lsr & UART_LSR_PE)
1345 up->port.icount.parity++;
1346 else if (lsr & UART_LSR_FE)
1347 up->port.icount.frame++;
1348 if (lsr & UART_LSR_OE)
1349 up->port.icount.overrun++;
1350
1351
1352
1353
1354 lsr &= up->port.read_status_mask;
1355
1356 if (lsr & UART_LSR_BI) {
1357 DEBUG_INTR("handling break....");
1358 flag = TTY_BREAK;
1359 } else if (lsr & UART_LSR_PE)
1360 flag = TTY_PARITY;
1361 else if (lsr & UART_LSR_FE)
1362 flag = TTY_FRAME;
1363 }
1364 if (uart_handle_sysrq_char(&up->port, ch))
1365 goto ignore_char;
1366
1367 uart_insert_char(&up->port, lsr, UART_LSR_OE, ch, flag);
1368
1369ignore_char:
1370 lsr = serial_inp(up, UART_LSR);
1371 } while ((lsr & (UART_LSR_DR | UART_LSR_BI)) && (max_count-- > 0));
1372 spin_unlock(&up->port.lock);
1373 tty_flip_buffer_push(tty);
1374 spin_lock(&up->port.lock);
1375 *status = lsr;
1376}
1377
1378static void transmit_chars(struct uart_8250_port *up)
1379{
1380 struct circ_buf *xmit = &up->port.info->xmit;
1381 int count;
1382
1383 if (up->port.x_char) {
1384 serial_outp(up, UART_TX, up->port.x_char);
1385 up->port.icount.tx++;
1386 up->port.x_char = 0;
1387 return;
1388 }
1389 if (uart_tx_stopped(&up->port)) {
1390 serial8250_stop_tx(&up->port);
1391 return;
1392 }
1393 if (uart_circ_empty(xmit)) {
1394 __stop_tx(up);
1395 return;
1396 }
1397
1398 count = up->tx_loadsz;
1399 do {
1400 serial_out(up, UART_TX, xmit->buf[xmit->tail]);
1401 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
1402 up->port.icount.tx++;
1403 if (uart_circ_empty(xmit))
1404 break;
1405 } while (--count > 0);
1406
1407 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
1408 uart_write_wakeup(&up->port);
1409
1410 DEBUG_INTR("THRE...");
1411
1412 if (uart_circ_empty(xmit))
1413 __stop_tx(up);
1414}
1415
1416static unsigned int check_modem_status(struct uart_8250_port *up)
1417{
1418 unsigned int status = serial_in(up, UART_MSR);
1419
1420 status |= up->msr_saved_flags;
1421 up->msr_saved_flags = 0;
1422 if (status & UART_MSR_ANY_DELTA && up->ier & UART_IER_MSI &&
1423 up->port.info != NULL) {
1424 if (status & UART_MSR_TERI)
1425 up->port.icount.rng++;
1426 if (status & UART_MSR_DDSR)
1427 up->port.icount.dsr++;
1428 if (status & UART_MSR_DDCD)
1429 uart_handle_dcd_change(&up->port, status & UART_MSR_DCD);
1430 if (status & UART_MSR_DCTS)
1431 uart_handle_cts_change(&up->port, status & UART_MSR_CTS);
1432
1433 wake_up_interruptible(&up->port.info->delta_msr_wait);
1434 }
1435
1436 return status;
1437}
1438
1439
1440
1441
1442static void serial8250_handle_port(struct uart_8250_port *up)
1443{
1444 unsigned int status;
1445 unsigned long flags;
1446
1447 spin_lock_irqsave(&up->port.lock, flags);
1448
1449 status = serial_inp(up, UART_LSR);
1450
1451 DEBUG_INTR("status = %x...", status);
1452
1453 if (status & (UART_LSR_DR | UART_LSR_BI))
1454 receive_chars(up, &status);
1455 check_modem_status(up);
1456 if (status & UART_LSR_THRE)
1457 transmit_chars(up);
1458
1459 spin_unlock_irqrestore(&up->port.lock, flags);
1460}
1461
1462
1463
1464
1465
1466
1467
1468
1469
1470
1471
1472
1473
1474
1475
1476static irqreturn_t serial8250_interrupt(int irq, void *dev_id)
1477{
1478 struct irq_info *i = dev_id;
1479 struct list_head *l, *end = NULL;
1480 int pass_counter = 0, handled = 0;
1481
1482 DEBUG_INTR("serial8250_interrupt(%d)...", irq);
1483
1484 spin_lock(&i->lock);
1485
1486 l = i->head;
1487 do {
1488 struct uart_8250_port *up;
1489 unsigned int iir;
1490
1491 up = list_entry(l, struct uart_8250_port, list);
1492
1493 iir = serial_in(up, UART_IIR);
1494 if (!(iir & UART_IIR_NO_INT)) {
1495 serial8250_handle_port(up);
1496
1497 handled = 1;
1498
1499 end = NULL;
1500 } else if (up->port.iotype == UPIO_DWAPB &&
1501 (iir & UART_IIR_BUSY) == UART_IIR_BUSY) {
1502
1503
1504
1505
1506 unsigned int status;
1507 status = *(volatile u32 *)up->port.private_data;
1508 serial_out(up, UART_LCR, up->lcr);
1509
1510 handled = 1;
1511
1512 end = NULL;
1513 } else if (end == NULL)
1514 end = l;
1515
1516 l = l->next;
1517
1518 if (l == i->head && pass_counter++ > PASS_LIMIT) {
1519
1520 printk(KERN_ERR "serial8250: too much work for "
1521 "irq%d\n", irq);
1522 break;
1523 }
1524 } while (l != end);
1525
1526 spin_unlock(&i->lock);
1527
1528 DEBUG_INTR("end.\n");
1529
1530 return IRQ_RETVAL(handled);
1531}
1532
1533
1534
1535
1536
1537
1538
1539
1540static void serial_do_unlink(struct irq_info *i, struct uart_8250_port *up)
1541{
1542 spin_lock_irq(&i->lock);
1543
1544 if (!list_empty(i->head)) {
1545 if (i->head == &up->list)
1546 i->head = i->head->next;
1547 list_del(&up->list);
1548 } else {
1549 BUG_ON(i->head != &up->list);
1550 i->head = NULL;
1551 }
1552 spin_unlock_irq(&i->lock);
1553
1554 if (i->head == NULL) {
1555 hlist_del(&i->node);
1556 kfree(i);
1557 }
1558}
1559
1560static int serial_link_irq_chain(struct uart_8250_port *up)
1561{
1562 struct hlist_head *h;
1563 struct hlist_node *n;
1564 struct irq_info *i;
1565 int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? IRQF_SHARED : 0;
1566
1567 mutex_lock(&hash_mutex);
1568
1569 h = &irq_lists[up->port.irq % NR_IRQ_HASH];
1570
1571 hlist_for_each(n, h) {
1572 i = hlist_entry(n, struct irq_info, node);
1573 if (i->irq == up->port.irq)
1574 break;
1575 }
1576
1577 if (n == NULL) {
1578 i = kzalloc(sizeof(struct irq_info), GFP_KERNEL);
1579 if (i == NULL) {
1580 mutex_unlock(&hash_mutex);
1581 return -ENOMEM;
1582 }
1583 spin_lock_init(&i->lock);
1584 i->irq = up->port.irq;
1585 hlist_add_head(&i->node, h);
1586 }
1587 mutex_unlock(&hash_mutex);
1588
1589 spin_lock_irq(&i->lock);
1590
1591 if (i->head) {
1592 list_add(&up->list, i->head);
1593 spin_unlock_irq(&i->lock);
1594
1595 ret = 0;
1596 } else {
1597 INIT_LIST_HEAD(&up->list);
1598 i->head = &up->list;
1599 spin_unlock_irq(&i->lock);
1600
1601 ret = request_irq(up->port.irq, serial8250_interrupt,
1602 irq_flags, "serial", i);
1603 if (ret < 0)
1604 serial_do_unlink(i, up);
1605 }
1606
1607 return ret;
1608}
1609
1610static void serial_unlink_irq_chain(struct uart_8250_port *up)
1611{
1612 struct irq_info *i;
1613 struct hlist_node *n;
1614 struct hlist_head *h;
1615
1616 mutex_lock(&hash_mutex);
1617
1618 h = &irq_lists[up->port.irq % NR_IRQ_HASH];
1619
1620 hlist_for_each(n, h) {
1621 i = hlist_entry(n, struct irq_info, node);
1622 if (i->irq == up->port.irq)
1623 break;
1624 }
1625
1626 BUG_ON(n == NULL);
1627 BUG_ON(i->head == NULL);
1628
1629 if (list_empty(i->head))
1630 free_irq(up->port.irq, i);
1631
1632 serial_do_unlink(i, up);
1633 mutex_unlock(&hash_mutex);
1634}
1635
1636
1637static inline int poll_timeout(int timeout)
1638{
1639 return timeout > 6 ? (timeout / 2 - 2) : 1;
1640}
1641
1642
1643
1644
1645
1646
1647
1648static void serial8250_timeout(unsigned long data)
1649{
1650 struct uart_8250_port *up = (struct uart_8250_port *)data;
1651 unsigned int iir;
1652
1653 iir = serial_in(up, UART_IIR);
1654 if (!(iir & UART_IIR_NO_INT))
1655 serial8250_handle_port(up);
1656 mod_timer(&up->timer, jiffies + poll_timeout(up->port.timeout));
1657}
1658
1659static void serial8250_backup_timeout(unsigned long data)
1660{
1661 struct uart_8250_port *up = (struct uart_8250_port *)data;
1662 unsigned int iir, ier = 0, lsr;
1663 unsigned long flags;
1664
1665
1666
1667
1668
1669 if (is_real_interrupt(up->port.irq)) {
1670 ier = serial_in(up, UART_IER);
1671 serial_out(up, UART_IER, 0);
1672 }
1673
1674 iir = serial_in(up, UART_IIR);
1675
1676
1677
1678
1679
1680
1681
1682 spin_lock_irqsave(&up->port.lock, flags);
1683 lsr = serial_in(up, UART_LSR);
1684 up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
1685 spin_unlock_irqrestore(&up->port.lock, flags);
1686 if ((iir & UART_IIR_NO_INT) && (up->ier & UART_IER_THRI) &&
1687 (!uart_circ_empty(&up->port.info->xmit) || up->port.x_char) &&
1688 (lsr & UART_LSR_THRE)) {
1689 iir &= ~(UART_IIR_ID | UART_IIR_NO_INT);
1690 iir |= UART_IIR_THRI;
1691 }
1692
1693 if (!(iir & UART_IIR_NO_INT))
1694 serial8250_handle_port(up);
1695
1696 if (is_real_interrupt(up->port.irq))
1697 serial_out(up, UART_IER, ier);
1698
1699
1700 mod_timer(&up->timer,
1701 jiffies + poll_timeout(up->port.timeout) + HZ / 5);
1702}
1703
1704static unsigned int serial8250_tx_empty(struct uart_port *port)
1705{
1706 struct uart_8250_port *up = (struct uart_8250_port *)port;
1707 unsigned long flags;
1708 unsigned int lsr;
1709
1710 spin_lock_irqsave(&up->port.lock, flags);
1711 lsr = serial_in(up, UART_LSR);
1712 up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
1713 spin_unlock_irqrestore(&up->port.lock, flags);
1714
1715 return lsr & UART_LSR_TEMT ? TIOCSER_TEMT : 0;
1716}
1717
1718static unsigned int serial8250_get_mctrl(struct uart_port *port)
1719{
1720 struct uart_8250_port *up = (struct uart_8250_port *)port;
1721 unsigned int status;
1722 unsigned int ret;
1723
1724 status = check_modem_status(up);
1725
1726 ret = 0;
1727 if (status & UART_MSR_DCD)
1728 ret |= TIOCM_CAR;
1729 if (status & UART_MSR_RI)
1730 ret |= TIOCM_RNG;
1731 if (status & UART_MSR_DSR)
1732 ret |= TIOCM_DSR;
1733 if (status & UART_MSR_CTS)
1734 ret |= TIOCM_CTS;
1735 return ret;
1736}
1737
1738static void serial8250_set_mctrl(struct uart_port *port, unsigned int mctrl)
1739{
1740 struct uart_8250_port *up = (struct uart_8250_port *)port;
1741 unsigned char mcr = 0;
1742
1743 if (mctrl & TIOCM_RTS)
1744 mcr |= UART_MCR_RTS;
1745 if (mctrl & TIOCM_DTR)
1746 mcr |= UART_MCR_DTR;
1747 if (mctrl & TIOCM_OUT1)
1748 mcr |= UART_MCR_OUT1;
1749 if (mctrl & TIOCM_OUT2)
1750 mcr |= UART_MCR_OUT2;
1751 if (mctrl & TIOCM_LOOP)
1752 mcr |= UART_MCR_LOOP;
1753
1754 mcr = (mcr & up->mcr_mask) | up->mcr_force | up->mcr;
1755
1756 serial_out(up, UART_MCR, mcr);
1757}
1758
1759static void serial8250_break_ctl(struct uart_port *port, int break_state)
1760{
1761 struct uart_8250_port *up = (struct uart_8250_port *)port;
1762 unsigned long flags;
1763
1764 spin_lock_irqsave(&up->port.lock, flags);
1765 if (break_state == -1)
1766 up->lcr |= UART_LCR_SBC;
1767 else
1768 up->lcr &= ~UART_LCR_SBC;
1769 serial_out(up, UART_LCR, up->lcr);
1770 spin_unlock_irqrestore(&up->port.lock, flags);
1771}
1772
1773#define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
1774
1775
1776
1777
1778static void wait_for_xmitr(struct uart_8250_port *up, int bits)
1779{
1780 unsigned int status, tmout = 10000;
1781
1782
1783 do {
1784 status = serial_in(up, UART_LSR);
1785
1786 up->lsr_saved_flags |= status & LSR_SAVE_FLAGS;
1787
1788 if (--tmout == 0)
1789 break;
1790 udelay(1);
1791 } while ((status & bits) != bits);
1792
1793
1794 if (up->port.flags & UPF_CONS_FLOW) {
1795 unsigned int tmout;
1796 for (tmout = 1000000; tmout; tmout--) {
1797 unsigned int msr = serial_in(up, UART_MSR);
1798 up->msr_saved_flags |= msr & MSR_SAVE_FLAGS;
1799 if (msr & UART_MSR_CTS)
1800 break;
1801 udelay(1);
1802 touch_nmi_watchdog();
1803 }
1804 }
1805}
1806
1807#ifdef CONFIG_CONSOLE_POLL
1808
1809
1810
1811
1812
1813static int serial8250_get_poll_char(struct uart_port *port)
1814{
1815 struct uart_8250_port *up = (struct uart_8250_port *)port;
1816 unsigned char lsr = serial_inp(up, UART_LSR);
1817
1818 while (!(lsr & UART_LSR_DR))
1819 lsr = serial_inp(up, UART_LSR);
1820
1821 return serial_inp(up, UART_RX);
1822}
1823
1824
1825static void serial8250_put_poll_char(struct uart_port *port,
1826 unsigned char c)
1827{
1828 unsigned int ier;
1829 struct uart_8250_port *up = (struct uart_8250_port *)port;
1830
1831
1832
1833
1834 ier = serial_in(up, UART_IER);
1835 if (up->capabilities & UART_CAP_UUE)
1836 serial_out(up, UART_IER, UART_IER_UUE);
1837 else
1838 serial_out(up, UART_IER, 0);
1839
1840 wait_for_xmitr(up, BOTH_EMPTY);
1841
1842
1843
1844
1845 serial_out(up, UART_TX, c);
1846 if (c == 10) {
1847 wait_for_xmitr(up, BOTH_EMPTY);
1848 serial_out(up, UART_TX, 13);
1849 }
1850
1851
1852
1853
1854
1855 wait_for_xmitr(up, BOTH_EMPTY);
1856 serial_out(up, UART_IER, ier);
1857}
1858
1859#endif
1860
1861static int serial8250_startup(struct uart_port *port)
1862{
1863 struct uart_8250_port *up = (struct uart_8250_port *)port;
1864 unsigned long flags;
1865 unsigned char lsr, iir;
1866 int retval;
1867
1868 up->capabilities = uart_config[up->port.type].flags;
1869 up->mcr = 0;
1870
1871 if (up->port.type == PORT_16C950) {
1872
1873 up->acr = 0;
1874 serial_outp(up, UART_LCR, 0xBF);
1875 serial_outp(up, UART_EFR, UART_EFR_ECB);
1876 serial_outp(up, UART_IER, 0);
1877 serial_outp(up, UART_LCR, 0);
1878 serial_icr_write(up, UART_CSR, 0);
1879 serial_outp(up, UART_LCR, 0xBF);
1880 serial_outp(up, UART_EFR, UART_EFR_ECB);
1881 serial_outp(up, UART_LCR, 0);
1882 }
1883
1884#ifdef CONFIG_SERIAL_8250_RSA
1885
1886
1887
1888
1889 enable_rsa(up);
1890#endif
1891
1892
1893
1894
1895
1896 serial8250_clear_fifos(up);
1897
1898
1899
1900
1901 (void) serial_inp(up, UART_LSR);
1902 (void) serial_inp(up, UART_RX);
1903 (void) serial_inp(up, UART_IIR);
1904 (void) serial_inp(up, UART_MSR);
1905
1906
1907
1908
1909
1910
1911 if (!(up->port.flags & UPF_BUGGY_UART) &&
1912 (serial_inp(up, UART_LSR) == 0xff)) {
1913 printk(KERN_INFO "ttyS%d: LSR safety check engaged!\n",
1914 serial_index(&up->port));
1915 return -ENODEV;
1916 }
1917
1918
1919
1920
1921 if (up->port.type == PORT_16850) {
1922 unsigned char fctr;
1923
1924 serial_outp(up, UART_LCR, 0xbf);
1925
1926 fctr = serial_inp(up, UART_FCTR) & ~(UART_FCTR_RX|UART_FCTR_TX);
1927 serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_RX);
1928 serial_outp(up, UART_TRG, UART_TRG_96);
1929 serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_TX);
1930 serial_outp(up, UART_TRG, UART_TRG_96);
1931
1932 serial_outp(up, UART_LCR, 0);
1933 }
1934
1935 if (is_real_interrupt(up->port.irq)) {
1936 unsigned char iir1;
1937
1938
1939
1940
1941
1942
1943
1944
1945 spin_lock_irqsave(&up->port.lock, flags);
1946 if (up->port.flags & UPF_SHARE_IRQ)
1947 disable_irq_nosync(up->port.irq);
1948
1949 wait_for_xmitr(up, UART_LSR_THRE);
1950 serial_out_sync(up, UART_IER, UART_IER_THRI);
1951 udelay(1);
1952 iir1 = serial_in(up, UART_IIR);
1953 serial_out(up, UART_IER, 0);
1954 serial_out_sync(up, UART_IER, UART_IER_THRI);
1955 udelay(1);
1956 iir = serial_in(up, UART_IIR);
1957 serial_out(up, UART_IER, 0);
1958
1959 if (up->port.flags & UPF_SHARE_IRQ)
1960 enable_irq(up->port.irq);
1961 spin_unlock_irqrestore(&up->port.lock, flags);
1962
1963
1964
1965
1966
1967 if (!(iir1 & UART_IIR_NO_INT) && (iir & UART_IIR_NO_INT)) {
1968 up->bugs |= UART_BUG_THRE;
1969 pr_debug("ttyS%d - using backup timer\n",
1970 serial_index(port));
1971 }
1972 }
1973
1974
1975
1976
1977
1978 if (up->bugs & UART_BUG_THRE) {
1979 up->timer.function = serial8250_backup_timeout;
1980 up->timer.data = (unsigned long)up;
1981 mod_timer(&up->timer, jiffies +
1982 poll_timeout(up->port.timeout) + HZ / 5);
1983 }
1984
1985
1986
1987
1988
1989
1990 if (!is_real_interrupt(up->port.irq)) {
1991 up->timer.data = (unsigned long)up;
1992 mod_timer(&up->timer, jiffies + poll_timeout(up->port.timeout));
1993 } else {
1994 retval = serial_link_irq_chain(up);
1995 if (retval)
1996 return retval;
1997 }
1998
1999
2000
2001
2002 serial_outp(up, UART_LCR, UART_LCR_WLEN8);
2003
2004 spin_lock_irqsave(&up->port.lock, flags);
2005 if (up->port.flags & UPF_FOURPORT) {
2006 if (!is_real_interrupt(up->port.irq))
2007 up->port.mctrl |= TIOCM_OUT1;
2008 } else
2009
2010
2011
2012 if (is_real_interrupt(up->port.irq))
2013 up->port.mctrl |= TIOCM_OUT2;
2014
2015 serial8250_set_mctrl(&up->port, up->port.mctrl);
2016
2017
2018
2019
2020
2021 serial_outp(up, UART_IER, UART_IER_THRI);
2022 lsr = serial_in(up, UART_LSR);
2023 iir = serial_in(up, UART_IIR);
2024 serial_outp(up, UART_IER, 0);
2025
2026 if (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT) {
2027 if (!(up->bugs & UART_BUG_TXEN)) {
2028 up->bugs |= UART_BUG_TXEN;
2029 pr_debug("ttyS%d - enabling bad tx status workarounds\n",
2030 serial_index(port));
2031 }
2032 } else {
2033 up->bugs &= ~UART_BUG_TXEN;
2034 }
2035
2036 spin_unlock_irqrestore(&up->port.lock, flags);
2037
2038
2039
2040
2041
2042
2043 serial_inp(up, UART_LSR);
2044 serial_inp(up, UART_RX);
2045 serial_inp(up, UART_IIR);
2046 serial_inp(up, UART_MSR);
2047 up->lsr_saved_flags = 0;
2048 up->msr_saved_flags = 0;
2049
2050
2051
2052
2053
2054
2055 up->ier = UART_IER_RLSI | UART_IER_RDI;
2056 serial_outp(up, UART_IER, up->ier);
2057
2058 if (up->port.flags & UPF_FOURPORT) {
2059 unsigned int icp;
2060
2061
2062
2063 icp = (up->port.iobase & 0xfe0) | 0x01f;
2064 outb_p(0x80, icp);
2065 (void) inb_p(icp);
2066 }
2067
2068 return 0;
2069}
2070
2071static void serial8250_shutdown(struct uart_port *port)
2072{
2073 struct uart_8250_port *up = (struct uart_8250_port *)port;
2074 unsigned long flags;
2075
2076
2077
2078
2079 up->ier = 0;
2080 serial_outp(up, UART_IER, 0);
2081
2082 spin_lock_irqsave(&up->port.lock, flags);
2083 if (up->port.flags & UPF_FOURPORT) {
2084
2085 inb((up->port.iobase & 0xfe0) | 0x1f);
2086 up->port.mctrl |= TIOCM_OUT1;
2087 } else
2088 up->port.mctrl &= ~TIOCM_OUT2;
2089
2090 serial8250_set_mctrl(&up->port, up->port.mctrl);
2091 spin_unlock_irqrestore(&up->port.lock, flags);
2092
2093
2094
2095
2096 serial_out(up, UART_LCR, serial_inp(up, UART_LCR) & ~UART_LCR_SBC);
2097 serial8250_clear_fifos(up);
2098
2099#ifdef CONFIG_SERIAL_8250_RSA
2100
2101
2102
2103 disable_rsa(up);
2104#endif
2105
2106
2107
2108
2109
2110 (void) serial_in(up, UART_RX);
2111
2112 del_timer_sync(&up->timer);
2113 up->timer.function = serial8250_timeout;
2114 if (is_real_interrupt(up->port.irq))
2115 serial_unlink_irq_chain(up);
2116}
2117
2118static unsigned int serial8250_get_divisor(struct uart_port *port, unsigned int baud)
2119{
2120 unsigned int quot;
2121
2122
2123
2124
2125
2126 if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
2127 baud == (port->uartclk/4))
2128 quot = 0x8001;
2129 else if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
2130 baud == (port->uartclk/8))
2131 quot = 0x8002;
2132 else
2133 quot = uart_get_divisor(port, baud);
2134
2135 return quot;
2136}
2137
2138static void
2139serial8250_set_termios(struct uart_port *port, struct ktermios *termios,
2140 struct ktermios *old)
2141{
2142 struct uart_8250_port *up = (struct uart_8250_port *)port;
2143 unsigned char cval, fcr = 0;
2144 unsigned long flags;
2145 unsigned int baud, quot;
2146
2147 switch (termios->c_cflag & CSIZE) {
2148 case CS5:
2149 cval = UART_LCR_WLEN5;
2150 break;
2151 case CS6:
2152 cval = UART_LCR_WLEN6;
2153 break;
2154 case CS7:
2155 cval = UART_LCR_WLEN7;
2156 break;
2157 default:
2158 case CS8:
2159 cval = UART_LCR_WLEN8;
2160 break;
2161 }
2162
2163 if (termios->c_cflag & CSTOPB)
2164 cval |= UART_LCR_STOP;
2165 if (termios->c_cflag & PARENB)
2166 cval |= UART_LCR_PARITY;
2167 if (!(termios->c_cflag & PARODD))
2168 cval |= UART_LCR_EPAR;
2169#ifdef CMSPAR
2170 if (termios->c_cflag & CMSPAR)
2171 cval |= UART_LCR_SPAR;
2172#endif
2173
2174
2175
2176
2177 baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
2178 quot = serial8250_get_divisor(port, baud);
2179
2180
2181
2182
2183 if (up->bugs & UART_BUG_QUOT && (quot & 0xff) == 0)
2184 quot++;
2185
2186 if (up->capabilities & UART_CAP_FIFO && up->port.fifosize > 1) {
2187 if (baud < 2400)
2188 fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
2189 else
2190 fcr = uart_config[up->port.type].fcr;
2191 }
2192
2193
2194
2195
2196
2197
2198
2199
2200
2201 if (up->capabilities & UART_CAP_AFE && up->port.fifosize >= 32) {
2202 up->mcr &= ~UART_MCR_AFE;
2203 if (termios->c_cflag & CRTSCTS)
2204 up->mcr |= UART_MCR_AFE;
2205 }
2206
2207
2208
2209
2210
2211 spin_lock_irqsave(&up->port.lock, flags);
2212
2213
2214
2215
2216 uart_update_timeout(port, termios->c_cflag, baud);
2217
2218 up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
2219 if (termios->c_iflag & INPCK)
2220 up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE;
2221 if (termios->c_iflag & (BRKINT | PARMRK))
2222 up->port.read_status_mask |= UART_LSR_BI;
2223
2224
2225
2226
2227 up->port.ignore_status_mask = 0;
2228 if (termios->c_iflag & IGNPAR)
2229 up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
2230 if (termios->c_iflag & IGNBRK) {
2231 up->port.ignore_status_mask |= UART_LSR_BI;
2232
2233
2234
2235
2236 if (termios->c_iflag & IGNPAR)
2237 up->port.ignore_status_mask |= UART_LSR_OE;
2238 }
2239
2240
2241
2242
2243 if ((termios->c_cflag & CREAD) == 0)
2244 up->port.ignore_status_mask |= UART_LSR_DR;
2245
2246
2247
2248
2249 up->ier &= ~UART_IER_MSI;
2250 if (!(up->bugs & UART_BUG_NOMSR) &&
2251 UART_ENABLE_MS(&up->port, termios->c_cflag))
2252 up->ier |= UART_IER_MSI;
2253 if (up->capabilities & UART_CAP_UUE)
2254 up->ier |= UART_IER_UUE | UART_IER_RTOIE;
2255
2256 serial_out(up, UART_IER, up->ier);
2257
2258 if (up->capabilities & UART_CAP_EFR) {
2259 unsigned char efr = 0;
2260
2261
2262
2263
2264
2265 if (termios->c_cflag & CRTSCTS)
2266 efr |= UART_EFR_CTS;
2267
2268 serial_outp(up, UART_LCR, 0xBF);
2269 serial_outp(up, UART_EFR, efr);
2270 }
2271
2272#ifdef CONFIG_ARCH_OMAP
2273
2274 if (cpu_is_omap1510() && is_omap_port(up)) {
2275 if (baud == 115200) {
2276 quot = 1;
2277 serial_out(up, UART_OMAP_OSC_12M_SEL, 1);
2278 } else
2279 serial_out(up, UART_OMAP_OSC_12M_SEL, 0);
2280 }
2281#endif
2282
2283 if (up->capabilities & UART_NATSEMI) {
2284
2285 serial_outp(up, UART_LCR, 0xe0);
2286 } else {
2287 serial_outp(up, UART_LCR, cval | UART_LCR_DLAB);
2288 }
2289
2290 serial_dl_write(up, quot);
2291
2292
2293
2294
2295
2296 if (up->port.type == PORT_16750)
2297 serial_outp(up, UART_FCR, fcr);
2298
2299 serial_outp(up, UART_LCR, cval);
2300 up->lcr = cval;
2301 if (up->port.type != PORT_16750) {
2302 if (fcr & UART_FCR_ENABLE_FIFO) {
2303
2304 serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
2305 }
2306 serial_outp(up, UART_FCR, fcr);
2307 }
2308 serial8250_set_mctrl(&up->port, up->port.mctrl);
2309 spin_unlock_irqrestore(&up->port.lock, flags);
2310
2311 if (tty_termios_baud_rate(termios))
2312 tty_termios_encode_baud_rate(termios, baud, baud);
2313}
2314
2315static void
2316serial8250_pm(struct uart_port *port, unsigned int state,
2317 unsigned int oldstate)
2318{
2319 struct uart_8250_port *p = (struct uart_8250_port *)port;
2320
2321 serial8250_set_sleep(p, state != 0);
2322
2323 if (p->pm)
2324 p->pm(port, state, oldstate);
2325}
2326
2327static unsigned int serial8250_port_size(struct uart_8250_port *pt)
2328{
2329 if (pt->port.iotype == UPIO_AU)
2330 return 0x100000;
2331#ifdef CONFIG_ARCH_OMAP
2332 if (is_omap_port(pt))
2333 return 0x16 << pt->port.regshift;
2334#endif
2335 return 8 << pt->port.regshift;
2336}
2337
2338
2339
2340
2341static int serial8250_request_std_resource(struct uart_8250_port *up)
2342{
2343 unsigned int size = serial8250_port_size(up);
2344 int ret = 0;
2345
2346 switch (up->port.iotype) {
2347 case UPIO_AU:
2348 case UPIO_TSI:
2349 case UPIO_MEM32:
2350 case UPIO_MEM:
2351 case UPIO_DWAPB:
2352 if (!up->port.mapbase)
2353 break;
2354
2355 if (!request_mem_region(up->port.mapbase, size, "serial")) {
2356 ret = -EBUSY;
2357 break;
2358 }
2359
2360 if (up->port.flags & UPF_IOREMAP) {
2361 up->port.membase = ioremap_nocache(up->port.mapbase,
2362 size);
2363 if (!up->port.membase) {
2364 release_mem_region(up->port.mapbase, size);
2365 ret = -ENOMEM;
2366 }
2367 }
2368 break;
2369
2370 case UPIO_HUB6:
2371 case UPIO_PORT:
2372 if (!request_region(up->port.iobase, size, "serial"))
2373 ret = -EBUSY;
2374 break;
2375 }
2376 return ret;
2377}
2378
2379static void serial8250_release_std_resource(struct uart_8250_port *up)
2380{
2381 unsigned int size = serial8250_port_size(up);
2382
2383 switch (up->port.iotype) {
2384 case UPIO_AU:
2385 case UPIO_TSI:
2386 case UPIO_MEM32:
2387 case UPIO_MEM:
2388 case UPIO_DWAPB:
2389 if (!up->port.mapbase)
2390 break;
2391
2392 if (up->port.flags & UPF_IOREMAP) {
2393 iounmap(up->port.membase);
2394 up->port.membase = NULL;
2395 }
2396
2397 release_mem_region(up->port.mapbase, size);
2398 break;
2399
2400 case UPIO_HUB6:
2401 case UPIO_PORT:
2402 release_region(up->port.iobase, size);
2403 break;
2404 }
2405}
2406
2407static int serial8250_request_rsa_resource(struct uart_8250_port *up)
2408{
2409 unsigned long start = UART_RSA_BASE << up->port.regshift;
2410 unsigned int size = 8 << up->port.regshift;
2411 int ret = -EINVAL;
2412
2413 switch (up->port.iotype) {
2414 case UPIO_HUB6:
2415 case UPIO_PORT:
2416 start += up->port.iobase;
2417 if (request_region(start, size, "serial-rsa"))
2418 ret = 0;
2419 else
2420 ret = -EBUSY;
2421 break;
2422 }
2423
2424 return ret;
2425}
2426
2427static void serial8250_release_rsa_resource(struct uart_8250_port *up)
2428{
2429 unsigned long offset = UART_RSA_BASE << up->port.regshift;
2430 unsigned int size = 8 << up->port.regshift;
2431
2432 switch (up->port.iotype) {
2433 case UPIO_HUB6:
2434 case UPIO_PORT:
2435 release_region(up->port.iobase + offset, size);
2436 break;
2437 }
2438}
2439
2440static void serial8250_release_port(struct uart_port *port)
2441{
2442 struct uart_8250_port *up = (struct uart_8250_port *)port;
2443
2444 serial8250_release_std_resource(up);
2445 if (up->port.type == PORT_RSA)
2446 serial8250_release_rsa_resource(up);
2447}
2448
2449static int serial8250_request_port(struct uart_port *port)
2450{
2451 struct uart_8250_port *up = (struct uart_8250_port *)port;
2452 int ret = 0;
2453
2454 ret = serial8250_request_std_resource(up);
2455 if (ret == 0 && up->port.type == PORT_RSA) {
2456 ret = serial8250_request_rsa_resource(up);
2457 if (ret < 0)
2458 serial8250_release_std_resource(up);
2459 }
2460
2461 return ret;
2462}
2463
2464static void serial8250_config_port(struct uart_port *port, int flags)
2465{
2466 struct uart_8250_port *up = (struct uart_8250_port *)port;
2467 int probeflags = PROBE_ANY;
2468 int ret;
2469
2470
2471
2472
2473
2474 ret = serial8250_request_std_resource(up);
2475 if (ret < 0)
2476 return;
2477
2478 ret = serial8250_request_rsa_resource(up);
2479 if (ret < 0)
2480 probeflags &= ~PROBE_RSA;
2481
2482 if (flags & UART_CONFIG_TYPE)
2483 autoconfig(up, probeflags);
2484 if (up->port.type != PORT_UNKNOWN && flags & UART_CONFIG_IRQ)
2485 autoconfig_irq(up);
2486
2487 if (up->port.type != PORT_RSA && probeflags & PROBE_RSA)
2488 serial8250_release_rsa_resource(up);
2489 if (up->port.type == PORT_UNKNOWN)
2490 serial8250_release_std_resource(up);
2491}
2492
2493static int
2494serial8250_verify_port(struct uart_port *port, struct serial_struct *ser)
2495{
2496 if (ser->irq >= nr_irqs || ser->irq < 0 ||
2497 ser->baud_base < 9600 || ser->type < PORT_UNKNOWN ||
2498 ser->type >= ARRAY_SIZE(uart_config) || ser->type == PORT_CIRRUS ||
2499 ser->type == PORT_STARTECH)
2500 return -EINVAL;
2501 return 0;
2502}
2503
2504static const char *
2505serial8250_type(struct uart_port *port)
2506{
2507 int type = port->type;
2508
2509 if (type >= ARRAY_SIZE(uart_config))
2510 type = 0;
2511 return uart_config[type].name;
2512}
2513
2514static struct uart_ops serial8250_pops = {
2515 .tx_empty = serial8250_tx_empty,
2516 .set_mctrl = serial8250_set_mctrl,
2517 .get_mctrl = serial8250_get_mctrl,
2518 .stop_tx = serial8250_stop_tx,
2519 .start_tx = serial8250_start_tx,
2520 .stop_rx = serial8250_stop_rx,
2521 .enable_ms = serial8250_enable_ms,
2522 .break_ctl = serial8250_break_ctl,
2523 .startup = serial8250_startup,
2524 .shutdown = serial8250_shutdown,
2525 .set_termios = serial8250_set_termios,
2526 .pm = serial8250_pm,
2527 .type = serial8250_type,
2528 .release_port = serial8250_release_port,
2529 .request_port = serial8250_request_port,
2530 .config_port = serial8250_config_port,
2531 .verify_port = serial8250_verify_port,
2532#ifdef CONFIG_CONSOLE_POLL
2533 .poll_get_char = serial8250_get_poll_char,
2534 .poll_put_char = serial8250_put_poll_char,
2535#endif
2536};
2537
2538static struct uart_8250_port serial8250_ports[UART_NR];
2539
2540static void __init serial8250_isa_init_ports(void)
2541{
2542 struct uart_8250_port *up;
2543 static int first = 1;
2544 int i;
2545
2546 if (!first)
2547 return;
2548 first = 0;
2549
2550 for (i = 0; i < nr_uarts; i++) {
2551 struct uart_8250_port *up = &serial8250_ports[i];
2552
2553 up->port.line = i;
2554 spin_lock_init(&up->port.lock);
2555
2556 init_timer(&up->timer);
2557 up->timer.function = serial8250_timeout;
2558
2559
2560
2561
2562 up->mcr_mask = ~ALPHA_KLUDGE_MCR;
2563 up->mcr_force = ALPHA_KLUDGE_MCR;
2564
2565 up->port.ops = &serial8250_pops;
2566 }
2567
2568 for (i = 0, up = serial8250_ports;
2569 i < ARRAY_SIZE(old_serial_port) && i < nr_uarts;
2570 i++, up++) {
2571 up->port.iobase = old_serial_port[i].port;
2572 up->port.irq = irq_canonicalize(old_serial_port[i].irq);
2573 up->port.uartclk = old_serial_port[i].baud_base * 16;
2574 up->port.flags = old_serial_port[i].flags;
2575 up->port.hub6 = old_serial_port[i].hub6;
2576 up->port.membase = old_serial_port[i].iomem_base;
2577 up->port.iotype = old_serial_port[i].io_type;
2578 up->port.regshift = old_serial_port[i].iomem_reg_shift;
2579 if (share_irqs)
2580 up->port.flags |= UPF_SHARE_IRQ;
2581 }
2582}
2583
2584static void __init
2585serial8250_register_ports(struct uart_driver *drv, struct device *dev)
2586{
2587 int i;
2588
2589 serial8250_isa_init_ports();
2590
2591 for (i = 0; i < nr_uarts; i++) {
2592 struct uart_8250_port *up = &serial8250_ports[i];
2593
2594 up->port.dev = dev;
2595 uart_add_one_port(drv, &up->port);
2596 }
2597}
2598
2599#ifdef CONFIG_SERIAL_8250_CONSOLE
2600
2601static void serial8250_console_putchar(struct uart_port *port, int ch)
2602{
2603 struct uart_8250_port *up = (struct uart_8250_port *)port;
2604
2605 wait_for_xmitr(up, UART_LSR_THRE);
2606 serial_out(up, UART_TX, ch);
2607}
2608
2609
2610
2611
2612
2613
2614
2615static void
2616serial8250_console_write(struct console *co, const char *s, unsigned int count)
2617{
2618 struct uart_8250_port *up = &serial8250_ports[co->index];
2619 unsigned long flags;
2620 unsigned int ier;
2621 int locked = 1;
2622
2623 touch_nmi_watchdog();
2624
2625 local_irq_save(flags);
2626 if (up->port.sysrq) {
2627
2628 locked = 0;
2629 } else if (oops_in_progress) {
2630 locked = spin_trylock(&up->port.lock);
2631 } else
2632 spin_lock(&up->port.lock);
2633
2634
2635
2636
2637 ier = serial_in(up, UART_IER);
2638
2639 if (up->capabilities & UART_CAP_UUE)
2640 serial_out(up, UART_IER, UART_IER_UUE);
2641 else
2642 serial_out(up, UART_IER, 0);
2643
2644 uart_console_write(&up->port, s, count, serial8250_console_putchar);
2645
2646
2647
2648
2649
2650 wait_for_xmitr(up, BOTH_EMPTY);
2651 serial_out(up, UART_IER, ier);
2652
2653
2654
2655
2656
2657
2658
2659
2660 if (up->msr_saved_flags)
2661 check_modem_status(up);
2662
2663 if (locked)
2664 spin_unlock(&up->port.lock);
2665 local_irq_restore(flags);
2666}
2667
2668static int __init serial8250_console_setup(struct console *co, char *options)
2669{
2670 struct uart_port *port;
2671 int baud = 9600;
2672 int bits = 8;
2673 int parity = 'n';
2674 int flow = 'n';
2675
2676
2677
2678
2679
2680
2681 if (co->index >= nr_uarts)
2682 co->index = 0;
2683 port = &serial8250_ports[co->index].port;
2684 if (!port->iobase && !port->membase)
2685 return -ENODEV;
2686
2687 if (options)
2688 uart_parse_options(options, &baud, &parity, &bits, &flow);
2689
2690 return uart_set_options(port, co, baud, parity, bits, flow);
2691}
2692
2693static int serial8250_console_early_setup(void)
2694{
2695 return serial8250_find_port_for_earlycon();
2696}
2697
2698static struct console serial8250_console = {
2699 .name = "ttyS",
2700 .write = serial8250_console_write,
2701 .device = uart_console_device,
2702 .setup = serial8250_console_setup,
2703 .early_setup = serial8250_console_early_setup,
2704 .flags = CON_PRINTBUFFER,
2705 .index = -1,
2706 .data = &serial8250_reg,
2707};
2708
2709static int __init serial8250_console_init(void)
2710{
2711 if (nr_uarts > UART_NR)
2712 nr_uarts = UART_NR;
2713
2714 serial8250_isa_init_ports();
2715 register_console(&serial8250_console);
2716 return 0;
2717}
2718console_initcall(serial8250_console_init);
2719
2720int serial8250_find_port(struct uart_port *p)
2721{
2722 int line;
2723 struct uart_port *port;
2724
2725 for (line = 0; line < nr_uarts; line++) {
2726 port = &serial8250_ports[line].port;
2727 if (uart_match_port(p, port))
2728 return line;
2729 }
2730 return -ENODEV;
2731}
2732
2733#define SERIAL8250_CONSOLE &serial8250_console
2734#else
2735#define SERIAL8250_CONSOLE NULL
2736#endif
2737
2738static struct uart_driver serial8250_reg = {
2739 .owner = THIS_MODULE,
2740 .driver_name = "serial",
2741 .dev_name = "ttyS",
2742 .major = TTY_MAJOR,
2743 .minor = 64,
2744 .cons = SERIAL8250_CONSOLE,
2745};
2746
2747
2748
2749
2750
2751
2752
2753int __init early_serial_setup(struct uart_port *port)
2754{
2755 if (port->line >= ARRAY_SIZE(serial8250_ports))
2756 return -ENODEV;
2757
2758 serial8250_isa_init_ports();
2759 serial8250_ports[port->line].port = *port;
2760 serial8250_ports[port->line].port.ops = &serial8250_pops;
2761 return 0;
2762}
2763
2764
2765
2766
2767
2768
2769
2770void serial8250_suspend_port(int line)
2771{
2772 uart_suspend_port(&serial8250_reg, &serial8250_ports[line].port);
2773}
2774
2775
2776
2777
2778
2779
2780
2781void serial8250_resume_port(int line)
2782{
2783 struct uart_8250_port *up = &serial8250_ports[line];
2784
2785 if (up->capabilities & UART_NATSEMI) {
2786 unsigned char tmp;
2787
2788
2789 serial_outp(up, UART_LCR, 0xE0);
2790
2791 tmp = serial_in(up, 0x04);
2792 tmp &= ~0xB0;
2793 tmp |= 0x10;
2794 serial_outp(up, 0x04, tmp);
2795
2796 serial_outp(up, UART_LCR, 0);
2797 }
2798 uart_resume_port(&serial8250_reg, &up->port);
2799}
2800
2801
2802
2803
2804
2805
2806static int __devinit serial8250_probe(struct platform_device *dev)
2807{
2808 struct plat_serial8250_port *p = dev->dev.platform_data;
2809 struct uart_port port;
2810 int ret, i;
2811
2812 memset(&port, 0, sizeof(struct uart_port));
2813
2814 for (i = 0; p && p->flags != 0; p++, i++) {
2815 port.iobase = p->iobase;
2816 port.membase = p->membase;
2817 port.irq = p->irq;
2818 port.uartclk = p->uartclk;
2819 port.regshift = p->regshift;
2820 port.iotype = p->iotype;
2821 port.flags = p->flags;
2822 port.mapbase = p->mapbase;
2823 port.hub6 = p->hub6;
2824 port.private_data = p->private_data;
2825 port.dev = &dev->dev;
2826 if (share_irqs)
2827 port.flags |= UPF_SHARE_IRQ;
2828 ret = serial8250_register_port(&port);
2829 if (ret < 0) {
2830 dev_err(&dev->dev, "unable to register port at index %d "
2831 "(IO%lx MEM%llx IRQ%d): %d\n", i,
2832 p->iobase, (unsigned long long)p->mapbase,
2833 p->irq, ret);
2834 }
2835 }
2836 return 0;
2837}
2838
2839
2840
2841
2842static int __devexit serial8250_remove(struct platform_device *dev)
2843{
2844 int i;
2845
2846 for (i = 0; i < nr_uarts; i++) {
2847 struct uart_8250_port *up = &serial8250_ports[i];
2848
2849 if (up->port.dev == &dev->dev)
2850 serial8250_unregister_port(i);
2851 }
2852 return 0;
2853}
2854
2855static int serial8250_suspend(struct platform_device *dev, pm_message_t state)
2856{
2857 int i;
2858
2859 for (i = 0; i < UART_NR; i++) {
2860 struct uart_8250_port *up = &serial8250_ports[i];
2861
2862 if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
2863 uart_suspend_port(&serial8250_reg, &up->port);
2864 }
2865
2866 return 0;
2867}
2868
2869static int serial8250_resume(struct platform_device *dev)
2870{
2871 int i;
2872
2873 for (i = 0; i < UART_NR; i++) {
2874 struct uart_8250_port *up = &serial8250_ports[i];
2875
2876 if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
2877 serial8250_resume_port(i);
2878 }
2879
2880 return 0;
2881}
2882
2883static struct platform_driver serial8250_isa_driver = {
2884 .probe = serial8250_probe,
2885 .remove = __devexit_p(serial8250_remove),
2886 .suspend = serial8250_suspend,
2887 .resume = serial8250_resume,
2888 .driver = {
2889 .name = "serial8250",
2890 .owner = THIS_MODULE,
2891 },
2892};
2893
2894
2895
2896
2897
2898static struct platform_device *serial8250_isa_devs;
2899
2900
2901
2902
2903
2904
2905static DEFINE_MUTEX(serial_mutex);
2906
2907static struct uart_8250_port *serial8250_find_match_or_unused(struct uart_port *port)
2908{
2909 int i;
2910
2911
2912
2913
2914 for (i = 0; i < nr_uarts; i++)
2915 if (uart_match_port(&serial8250_ports[i].port, port))
2916 return &serial8250_ports[i];
2917
2918
2919
2920
2921
2922
2923 for (i = 0; i < nr_uarts; i++)
2924 if (serial8250_ports[i].port.type == PORT_UNKNOWN &&
2925 serial8250_ports[i].port.iobase == 0)
2926 return &serial8250_ports[i];
2927
2928
2929
2930
2931
2932 for (i = 0; i < nr_uarts; i++)
2933 if (serial8250_ports[i].port.type == PORT_UNKNOWN)
2934 return &serial8250_ports[i];
2935
2936 return NULL;
2937}
2938
2939
2940
2941
2942
2943
2944
2945
2946
2947
2948
2949
2950
2951
2952int serial8250_register_port(struct uart_port *port)
2953{
2954 struct uart_8250_port *uart;
2955 int ret = -ENOSPC;
2956
2957 if (port->uartclk == 0)
2958 return -EINVAL;
2959
2960 mutex_lock(&serial_mutex);
2961
2962 uart = serial8250_find_match_or_unused(port);
2963 if (uart) {
2964 uart_remove_one_port(&serial8250_reg, &uart->port);
2965
2966 uart->port.iobase = port->iobase;
2967 uart->port.membase = port->membase;
2968 uart->port.irq = port->irq;
2969 uart->port.uartclk = port->uartclk;
2970 uart->port.fifosize = port->fifosize;
2971 uart->port.regshift = port->regshift;
2972 uart->port.iotype = port->iotype;
2973 uart->port.flags = port->flags | UPF_BOOT_AUTOCONF;
2974 uart->port.mapbase = port->mapbase;
2975 uart->port.private_data = port->private_data;
2976 if (port->dev)
2977 uart->port.dev = port->dev;
2978
2979 ret = uart_add_one_port(&serial8250_reg, &uart->port);
2980 if (ret == 0)
2981 ret = uart->port.line;
2982 }
2983 mutex_unlock(&serial_mutex);
2984
2985 return ret;
2986}
2987EXPORT_SYMBOL(serial8250_register_port);
2988
2989
2990
2991
2992
2993
2994
2995
2996void serial8250_unregister_port(int line)
2997{
2998 struct uart_8250_port *uart = &serial8250_ports[line];
2999
3000 mutex_lock(&serial_mutex);
3001 uart_remove_one_port(&serial8250_reg, &uart->port);
3002 if (serial8250_isa_devs) {
3003 uart->port.flags &= ~UPF_BOOT_AUTOCONF;
3004 uart->port.type = PORT_UNKNOWN;
3005 uart->port.dev = &serial8250_isa_devs->dev;
3006 uart_add_one_port(&serial8250_reg, &uart->port);
3007 } else {
3008 uart->port.dev = NULL;
3009 }
3010 mutex_unlock(&serial_mutex);
3011}
3012EXPORT_SYMBOL(serial8250_unregister_port);
3013
3014static int __init serial8250_init(void)
3015{
3016 int ret;
3017
3018 if (nr_uarts > UART_NR)
3019 nr_uarts = UART_NR;
3020
3021 printk(KERN_INFO "Serial: 8250/16550 driver"
3022 "%d ports, IRQ sharing %sabled\n", nr_uarts,
3023 share_irqs ? "en" : "dis");
3024
3025#ifdef CONFIG_SPARC
3026 ret = sunserial_register_minors(&serial8250_reg, UART_NR);
3027#else
3028 serial8250_reg.nr = UART_NR;
3029 ret = uart_register_driver(&serial8250_reg);
3030#endif
3031 if (ret)
3032 goto out;
3033
3034 serial8250_isa_devs = platform_device_alloc("serial8250",
3035 PLAT8250_DEV_LEGACY);
3036 if (!serial8250_isa_devs) {
3037 ret = -ENOMEM;
3038 goto unreg_uart_drv;
3039 }
3040
3041 ret = platform_device_add(serial8250_isa_devs);
3042 if (ret)
3043 goto put_dev;
3044
3045 serial8250_register_ports(&serial8250_reg, &serial8250_isa_devs->dev);
3046
3047 ret = platform_driver_register(&serial8250_isa_driver);
3048 if (ret == 0)
3049 goto out;
3050
3051 platform_device_del(serial8250_isa_devs);
3052put_dev:
3053 platform_device_put(serial8250_isa_devs);
3054unreg_uart_drv:
3055#ifdef CONFIG_SPARC
3056 sunserial_unregister_minors(&serial8250_reg, UART_NR);
3057#else
3058 uart_unregister_driver(&serial8250_reg);
3059#endif
3060out:
3061 return ret;
3062}
3063
3064static void __exit serial8250_exit(void)
3065{
3066 struct platform_device *isa_dev = serial8250_isa_devs;
3067
3068
3069
3070
3071
3072
3073 serial8250_isa_devs = NULL;
3074
3075 platform_driver_unregister(&serial8250_isa_driver);
3076 platform_device_unregister(isa_dev);
3077
3078#ifdef CONFIG_SPARC
3079 sunserial_unregister_minors(&serial8250_reg, UART_NR);
3080#else
3081 uart_unregister_driver(&serial8250_reg);
3082#endif
3083}
3084
3085module_init(serial8250_init);
3086module_exit(serial8250_exit);
3087
3088EXPORT_SYMBOL(serial8250_suspend_port);
3089EXPORT_SYMBOL(serial8250_resume_port);
3090
3091MODULE_LICENSE("GPL");
3092MODULE_DESCRIPTION("Generic 8250/16x50 serial driver");
3093
3094module_param(share_irqs, uint, 0644);
3095MODULE_PARM_DESC(share_irqs, "Share IRQs with other non-8250/16x50 devices"
3096 " (unsafe)");
3097
3098module_param(nr_uarts, uint, 0644);
3099MODULE_PARM_DESC(nr_uarts, "Maximum number of UARTs supported. (1-" __MODULE_STRING(CONFIG_SERIAL_8250_NR_UARTS) ")");
3100
3101#ifdef CONFIG_SERIAL_8250_RSA
3102module_param_array(probe_rsa, ulong, &probe_rsa_count, 0444);
3103MODULE_PARM_DESC(probe_rsa, "Probe I/O ports for RSA");
3104#endif
3105MODULE_ALIAS_CHARDEV_MAJOR(TTY_MAJOR);
3106