Bug fix.
[kvmfornfv.git] / kernel / arch / powerpc / sysdev / mv64x60_udbg.c
1 /*
2  * udbg serial input/output routines for the Marvell MV64x60 (Discovery).
3  *
4  * Author: Dale Farnsworth <dale@farnsworth.org>
5  *
6  * 2007 (c) MontaVista Software, Inc.  This file is licensed under
7  * the terms of the GNU General Public License version 2.  This program
8  * is licensed "as is" without any warranty of any kind, whether express
9  * or implied.
10  */
11
12 #include <asm/io.h>
13 #include <asm/prom.h>
14 #include <asm/udbg.h>
15
16 #include <sysdev/mv64x60.h>
17
18 #define MPSC_0_CR1_OFFSET       0x000c
19
20 #define MPSC_0_CR2_OFFSET       0x0010
21 #define MPSC_CHR_2_TCS          (1 << 9)
22
23 #define MPSC_0_CHR_10_OFFSET    0x0030
24
25 #define MPSC_INTR_CAUSE_OFF_0   0x0004
26 #define MPSC_INTR_CAUSE_OFF_1   0x000c
27 #define MPSC_INTR_CAUSE_RCC     (1<<6)
28
29 static void __iomem *mpsc_base;
30 static void __iomem *mpsc_intr_cause;
31
32 static void mv64x60_udbg_putc(char c)
33 {
34         if (c == '\n')
35                 mv64x60_udbg_putc('\r');
36
37         while(in_le32(mpsc_base + MPSC_0_CR2_OFFSET) & MPSC_CHR_2_TCS)
38                 ;
39         out_le32(mpsc_base + MPSC_0_CR1_OFFSET, c);
40         out_le32(mpsc_base + MPSC_0_CR2_OFFSET, MPSC_CHR_2_TCS);
41 }
42
43 static int mv64x60_udbg_testc(void)
44 {
45         return (in_le32(mpsc_intr_cause) & MPSC_INTR_CAUSE_RCC) != 0;
46 }
47
48 static int mv64x60_udbg_getc(void)
49 {
50         int cause = 0;
51         int c;
52
53         while (!mv64x60_udbg_testc())
54                 ;
55
56         c = in_8(mpsc_base + MPSC_0_CHR_10_OFFSET + 2);
57         out_8(mpsc_base + MPSC_0_CHR_10_OFFSET + 2, c);
58         out_le32(mpsc_intr_cause, cause & ~MPSC_INTR_CAUSE_RCC);
59         return c;
60 }
61
62 static int mv64x60_udbg_getc_poll(void)
63 {
64         if (!mv64x60_udbg_testc())
65                 return -1;
66
67         return mv64x60_udbg_getc();
68 }
69
70 static void mv64x60_udbg_init(void)
71 {
72         struct device_node *np, *mpscintr, *stdout = NULL;
73         const char *path;
74         const phandle *ph;
75         struct resource r[2];
76         const int *block_index;
77         int intr_cause_offset;
78         int err;
79
80         path = of_get_property(of_chosen, "linux,stdout-path", NULL);
81         if (!path)
82                 return;
83
84         stdout = of_find_node_by_path(path);
85         if (!stdout)
86                 return;
87
88         for_each_compatible_node(np, NULL, "marvell,mv64360-mpsc") {
89                 if (np == stdout)
90                         break;
91         }
92
93         of_node_put(stdout);
94         if (!np)
95                 return;
96
97         block_index = of_get_property(np, "cell-index", NULL);
98         if (!block_index)
99                 goto error;
100
101         switch (*block_index) {
102         case 0:
103                 intr_cause_offset = MPSC_INTR_CAUSE_OFF_0;
104                 break;
105         case 1:
106                 intr_cause_offset = MPSC_INTR_CAUSE_OFF_1;
107                 break;
108         default:
109                 goto error;
110         }
111
112         err = of_address_to_resource(np, 0, &r[0]);
113         if (err)
114                 goto error;
115
116         ph = of_get_property(np, "mpscintr", NULL);
117         mpscintr = of_find_node_by_phandle(*ph);
118         if (!mpscintr)
119                 goto error;
120
121         err = of_address_to_resource(mpscintr, 0, &r[1]);
122         of_node_put(mpscintr);
123         if (err)
124                 goto error;
125
126         of_node_put(np);
127
128         mpsc_base = ioremap(r[0].start, resource_size(&r[0]));
129         if (!mpsc_base)
130                 return;
131
132         mpsc_intr_cause = ioremap(r[1].start, resource_size(&r[1]));
133         if (!mpsc_intr_cause) {
134                 iounmap(mpsc_base);
135                 return;
136         }
137         mpsc_intr_cause += intr_cause_offset;
138
139         udbg_putc = mv64x60_udbg_putc;
140         udbg_getc = mv64x60_udbg_getc;
141         udbg_getc_poll = mv64x60_udbg_getc_poll;
142
143         return;
144
145 error:
146         of_node_put(np);
147 }
148
149 void mv64x60_init_early(void)
150 {
151         mv64x60_udbg_init();
152 }