Merge master.kernel.org:/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[linux-2.6] / arch / sh / kernel / early_printk.c
1 /*
2  * arch/sh/kernel/early_printk.c
3  *
4  *  Copyright (C) 1999, 2000  Niibe Yutaka
5  *  Copyright (C) 2002  M. R. Brown
6  *  Copyright (C) 2004 - 2006  Paul Mundt
7  *
8  * This file is subject to the terms and conditions of the GNU General Public
9  * License.  See the file "COPYING" in the main directory of this archive
10  * for more details.
11  */
12 #include <linux/console.h>
13 #include <linux/tty.h>
14 #include <linux/init.h>
15 #include <asm/io.h>
16
17 #ifdef CONFIG_SH_STANDARD_BIOS
18 #include <asm/sh_bios.h>
19
20 /*
21  *      Print a string through the BIOS
22  */
23 static void sh_console_write(struct console *co, const char *s,
24                                  unsigned count)
25 {
26         sh_bios_console_write(s, count);
27 }
28
29 /*
30  *      Setup initial baud/bits/parity. We do two things here:
31  *      - construct a cflag setting for the first rs_open()
32  *      - initialize the serial port
33  *      Return non-zero if we didn't find a serial port.
34  */
35 static int __init sh_console_setup(struct console *co, char *options)
36 {
37         int     cflag = CREAD | HUPCL | CLOCAL;
38
39         /*
40          *      Now construct a cflag setting.
41          *      TODO: this is a totally bogus cflag, as we have
42          *      no idea what serial settings the BIOS is using, or
43          *      even if its using the serial port at all.
44          */
45         cflag |= B115200 | CS8 | /*no parity*/0;
46
47         co->cflag = cflag;
48
49         return 0;
50 }
51
52 static struct console bios_console = {
53         .name           = "bios",
54         .write          = sh_console_write,
55         .setup          = sh_console_setup,
56         .flags          = CON_PRINTBUFFER,
57         .index          = -1,
58 };
59 #endif
60
61 #ifdef CONFIG_EARLY_SCIF_CONSOLE
62 #include <linux/serial_core.h>
63 #include "../../../drivers/serial/sh-sci.h"
64
65 #ifdef CONFIG_CPU_SH4
66 #define SCIF_REG        0xffe80000
67 #elif defined(CONFIG_CPU_SUBTYPE_SH72060)
68 #define SCIF_REG        0xfffe9800
69 #else
70 #error "Undefined SCIF for this subtype"
71 #endif
72
73 static struct uart_port scif_port = {
74         .mapbase        = SCIF_REG,
75         .membase        = (char __iomem *)SCIF_REG,
76 };
77
78 static void scif_sercon_putc(int c)
79 {
80         while (((sci_in(&scif_port, SCFDR) & 0x1f00 >> 8) == 16))
81                 ;
82
83         sci_out(&scif_port, SCxTDR, c);
84         sci_in(&scif_port, SCxSR);
85         sci_out(&scif_port, SCxSR, 0xf3 & ~(0x20 | 0x40));
86
87         while ((sci_in(&scif_port, SCxSR) & 0x40) == 0);
88                 ;
89
90         if (c == '\n')
91                 scif_sercon_putc('\r');
92 }
93
94 static void scif_sercon_write(struct console *con, const char *s,
95                               unsigned count)
96 {
97         while (count-- > 0)
98                 scif_sercon_putc(*s++);
99 }
100
101 static int __init scif_sercon_setup(struct console *con, char *options)
102 {
103         con->cflag = CREAD | HUPCL | CLOCAL | B115200 | CS8;
104
105         return 0;
106 }
107
108 static struct console scif_console = {
109         .name           = "sercon",
110         .write          = scif_sercon_write,
111         .setup          = scif_sercon_setup,
112         .flags          = CON_PRINTBUFFER,
113         .index          = -1,
114 };
115
116 static void scif_sercon_init(int baud)
117 {
118         ctrl_outw(0, SCIF_REG + 8);
119         ctrl_outw(0, SCIF_REG);
120
121         /* Set baud rate */
122         ctrl_outb((CONFIG_SH_PCLK_FREQ + 16 * baud) /
123                   (32 * baud) - 1, SCIF_REG + 4);
124
125         ctrl_outw(12, SCIF_REG + 24);
126         ctrl_outw(8, SCIF_REG + 24);
127         ctrl_outw(0, SCIF_REG + 32);
128         ctrl_outw(0x60, SCIF_REG + 16);
129         ctrl_outw(0, SCIF_REG + 36);
130         ctrl_outw(0x30, SCIF_REG + 8);
131 }
132 #endif
133
134 /*
135  * Setup a default console, if more than one is compiled in, rely on the
136  * earlyprintk= parsing to give priority.
137  */
138 static struct console *early_console =
139 #ifdef CONFIG_SH_STANDARD_BIOS
140         &bios_console
141 #elif defined(CONFIG_EARLY_SCIF_CONSOLE)
142         &scif_console
143 #else
144         NULL
145 #endif
146         ;
147
148 static int __initdata keep_early;
149
150 int __init setup_early_printk(char *opt)
151 {
152         char *space;
153         char buf[256];
154
155         strlcpy(buf, opt, sizeof(buf));
156         space = strchr(buf, ' ');
157         if (space)
158                 *space = 0;
159
160         if (strstr(buf, "keep"))
161                 keep_early = 1;
162
163 #ifdef CONFIG_SH_STANDARD_BIOS
164         if (!strncmp(buf, "bios", 4))
165                 early_console = &bios_console;
166 #endif
167 #if defined(CONFIG_EARLY_SCIF_CONSOLE)
168         if (!strncmp(buf, "serial", 6)) {
169                 early_console = &scif_console;
170
171 #ifdef CONFIG_CPU_SH4
172                 scif_sercon_init(115200);
173 #endif
174         }
175 #endif
176
177         if (likely(early_console))
178                 register_console(early_console);
179
180         return 1;
181 }
182 __setup("earlyprintk=", setup_early_printk);
183
184 void __init disable_early_printk(void)
185 {
186         if (!keep_early) {
187                 printk("disabling early console\n");
188                 unregister_console(early_console);
189         } else
190                 printk("keeping early console\n");
191 }