Merge master.kernel.org:/pub/scm/linux/kernel/git/chrisw/lsm-2.6
[linux-2.6] / arch / ppc64 / kernel / udbg_16550.c
1 /*
2  * udbg for for NS16550 compatable serial ports
3  *
4  * Copyright (C) 2001-2005 PPC 64 Team, IBM Corp
5  *
6  *      This program is free software; you can redistribute it and/or
7  *      modify it under the terms of the GNU General Public License
8  *      as published by the Free Software Foundation; either version
9  *      2 of the License, or (at your option) any later version.
10  */
11 #include <linux/config.h>
12 #include <linux/types.h>
13 #include <asm/udbg.h>
14 #include <asm/io.h>
15
16 extern u8 real_readb(volatile u8 __iomem  *addr);
17 extern void real_writeb(u8 data, volatile u8 __iomem *addr);
18
19 struct NS16550 {
20         /* this struct must be packed */
21         unsigned char rbr;  /* 0 */
22         unsigned char ier;  /* 1 */
23         unsigned char fcr;  /* 2 */
24         unsigned char lcr;  /* 3 */
25         unsigned char mcr;  /* 4 */
26         unsigned char lsr;  /* 5 */
27         unsigned char msr;  /* 6 */
28         unsigned char scr;  /* 7 */
29 };
30
31 #define thr rbr
32 #define iir fcr
33 #define dll rbr
34 #define dlm ier
35 #define dlab lcr
36
37 #define LSR_DR   0x01  /* Data ready */
38 #define LSR_OE   0x02  /* Overrun */
39 #define LSR_PE   0x04  /* Parity error */
40 #define LSR_FE   0x08  /* Framing error */
41 #define LSR_BI   0x10  /* Break */
42 #define LSR_THRE 0x20  /* Xmit holding register empty */
43 #define LSR_TEMT 0x40  /* Xmitter empty */
44 #define LSR_ERR  0x80  /* Error */
45
46 static volatile struct NS16550 __iomem *udbg_comport;
47
48 static void udbg_550_putc(unsigned char c)
49 {
50         if (udbg_comport) {
51                 while ((in_8(&udbg_comport->lsr) & LSR_THRE) == 0)
52                         /* wait for idle */;
53                 out_8(&udbg_comport->thr, c);
54                 if (c == '\n')
55                         udbg_550_putc('\r');
56         }
57 }
58
59 static int udbg_550_getc_poll(void)
60 {
61         if (udbg_comport) {
62                 if ((in_8(&udbg_comport->lsr) & LSR_DR) != 0)
63                         return in_8(&udbg_comport->rbr);
64                 else
65                         return -1;
66         }
67         return -1;
68 }
69
70 static unsigned char udbg_550_getc(void)
71 {
72         if (udbg_comport) {
73                 while ((in_8(&udbg_comport->lsr) & LSR_DR) == 0)
74                         /* wait for char */;
75                 return in_8(&udbg_comport->rbr);
76         }
77         return 0;
78 }
79
80 void udbg_init_uart(void __iomem *comport, unsigned int speed)
81 {
82         u16 dll = speed ? (115200 / speed) : 12;
83
84         if (comport) {
85                 udbg_comport = (struct NS16550 __iomem *)comport;
86                 out_8(&udbg_comport->lcr, 0x00);
87                 out_8(&udbg_comport->ier, 0xff);
88                 out_8(&udbg_comport->ier, 0x00);
89                 out_8(&udbg_comport->lcr, 0x80);        /* Access baud rate */
90                 out_8(&udbg_comport->dll, dll & 0xff);  /* 1 = 115200,  2 = 57600,
91                                                            3 = 38400, 12 = 9600 baud */
92                 out_8(&udbg_comport->dlm, dll >> 8);    /* dll >> 8 which should be zero
93                                                            for fast rates; */
94                 out_8(&udbg_comport->lcr, 0x03);        /* 8 data, 1 stop, no parity */
95                 out_8(&udbg_comport->mcr, 0x03);        /* RTS/DTR */
96                 out_8(&udbg_comport->fcr ,0x07);        /* Clear & enable FIFOs */
97                 udbg_putc = udbg_550_putc;
98                 udbg_getc = udbg_550_getc;
99                 udbg_getc_poll = udbg_550_getc_poll;
100         }
101 }
102
103 #ifdef CONFIG_PPC_MAPLE
104 void udbg_maple_real_putc(unsigned char c)
105 {
106         if (udbg_comport) {
107                 while ((real_readb(&udbg_comport->lsr) & LSR_THRE) == 0)
108                         /* wait for idle */;
109                 real_writeb(c, &udbg_comport->thr); eieio();
110                 if (c == '\n')
111                         udbg_maple_real_putc('\r');
112         }
113 }
114
115 void udbg_init_maple_realmode(void)
116 {
117         udbg_comport = (volatile struct NS16550 __iomem *)0xf40003f8;
118
119         udbg_putc = udbg_maple_real_putc;
120         udbg_getc = NULL;
121         udbg_getc_poll = NULL;
122 }
123 #endif /* CONFIG_PPC_MAPLE */