[PATCH] powerpc: remove pointer/integer confusion in of_find_node_by_name
[linux-2.6] / arch / powerpc / 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 #define LCR_DLAB 0x80
47
48 static volatile struct NS16550 __iomem *udbg_comport;
49
50 static void udbg_550_putc(char c)
51 {
52         if (udbg_comport) {
53                 while ((in_8(&udbg_comport->lsr) & LSR_THRE) == 0)
54                         /* wait for idle */;
55                 out_8(&udbg_comport->thr, c);
56                 if (c == '\n')
57                         udbg_550_putc('\r');
58         }
59 }
60
61 static int udbg_550_getc_poll(void)
62 {
63         if (udbg_comport) {
64                 if ((in_8(&udbg_comport->lsr) & LSR_DR) != 0)
65                         return in_8(&udbg_comport->rbr);
66                 else
67                         return -1;
68         }
69         return -1;
70 }
71
72 static int udbg_550_getc(void)
73 {
74         if (udbg_comport) {
75                 while ((in_8(&udbg_comport->lsr) & LSR_DR) == 0)
76                         /* wait for char */;
77                 return in_8(&udbg_comport->rbr);
78         }
79         return -1;
80 }
81
82 void udbg_init_uart(void __iomem *comport, unsigned int speed,
83                     unsigned int clock)
84 {
85         unsigned int dll, base_bauds = clock / 16;
86
87         if (speed == 0)
88                 speed = 9600;
89         dll = base_bauds / speed;
90
91         if (comport) {
92                 udbg_comport = (struct NS16550 __iomem *)comport;
93                 out_8(&udbg_comport->lcr, 0x00);
94                 out_8(&udbg_comport->ier, 0xff);
95                 out_8(&udbg_comport->ier, 0x00);
96                 out_8(&udbg_comport->lcr, LCR_DLAB);
97                 out_8(&udbg_comport->dll, dll & 0xff);
98                 out_8(&udbg_comport->dlm, dll >> 8);
99                 /* 8 data, 1 stop, no parity */
100                 out_8(&udbg_comport->lcr, 0x03);
101                 /* RTS/DTR */
102                 out_8(&udbg_comport->mcr, 0x03);
103                 /* Clear & enable FIFOs */
104                 out_8(&udbg_comport->fcr ,0x07);
105                 udbg_putc = udbg_550_putc;
106                 udbg_getc = udbg_550_getc;
107                 udbg_getc_poll = udbg_550_getc_poll;
108         }
109 }
110
111 unsigned int udbg_probe_uart_speed(void __iomem *comport, unsigned int clock)
112 {
113         unsigned int dll, dlm, divisor, prescaler, speed;
114         u8 old_lcr;
115         volatile struct NS16550 __iomem *port = comport;
116
117         old_lcr = in_8(&port->lcr);
118
119         /* select divisor latch registers.  */
120         out_8(&port->lcr, LCR_DLAB);
121
122         /* now, read the divisor */
123         dll = in_8(&port->dll);
124         dlm = in_8(&port->dlm);
125         divisor = dlm << 8 | dll;
126
127         /* check prescaling */
128         if (in_8(&port->mcr) & 0x80)
129                 prescaler = 4;
130         else
131                 prescaler = 1;
132
133         /* restore the LCR */
134         out_8(&port->lcr, old_lcr);
135
136         /* calculate speed */
137         speed = (clock / prescaler) / (divisor * 16);
138
139         /* sanity check */
140         if (speed < 0 || speed > (clock / 16))
141                 speed = 9600;
142
143         return speed;
144 }
145
146 #ifdef CONFIG_PPC_MAPLE
147 void udbg_maple_real_putc(unsigned char c)
148 {
149         if (udbg_comport) {
150                 while ((real_readb(&udbg_comport->lsr) & LSR_THRE) == 0)
151                         /* wait for idle */;
152                 real_writeb(c, &udbg_comport->thr); eieio();
153                 if (c == '\n')
154                         udbg_maple_real_putc('\r');
155         }
156 }
157
158 void __init udbg_init_maple_realmode(void)
159 {
160         udbg_comport = (volatile struct NS16550 __iomem *)0xf40003f8;
161
162         udbg_putc = udbg_maple_real_putc;
163         udbg_getc = NULL;
164         udbg_getc_poll = NULL;
165 }
166 #endif /* CONFIG_PPC_MAPLE */