OMAP: DISPC: Fix to disable also interface clocks. 2nd.
[linux-ginger.git] / arch / sh / kernel / early_printk.c
blob6b7d166694e28fecc3f949b66cb94ae8c2e53950
1 /*
2 * arch/sh/kernel/early_printk.c
4 * Copyright (C) 1999, 2000 Niibe Yutaka
5 * Copyright (C) 2002 M. R. Brown
6 * Copyright (C) 2004 - 2007 Paul Mundt
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.
12 #include <linux/console.h>
13 #include <linux/tty.h>
14 #include <linux/init.h>
15 #include <linux/io.h>
16 #include <linux/delay.h>
18 #ifdef CONFIG_SH_STANDARD_BIOS
19 #include <asm/sh_bios.h>
22 * Print a string through the BIOS
24 static void sh_console_write(struct console *co, const char *s,
25 unsigned count)
27 sh_bios_console_write(s, count);
31 * Setup initial baud/bits/parity. We do two things here:
32 * - construct a cflag setting for the first rs_open()
33 * - initialize the serial port
34 * Return non-zero if we didn't find a serial port.
36 static int __init sh_console_setup(struct console *co, char *options)
38 int cflag = CREAD | HUPCL | CLOCAL;
41 * Now construct a cflag setting.
42 * TODO: this is a totally bogus cflag, as we have
43 * no idea what serial settings the BIOS is using, or
44 * even if its using the serial port at all.
46 cflag |= B115200 | CS8 | /*no parity*/0;
48 co->cflag = cflag;
50 return 0;
53 static struct console bios_console = {
54 .name = "bios",
55 .write = sh_console_write,
56 .setup = sh_console_setup,
57 .flags = CON_PRINTBUFFER,
58 .index = -1,
60 #endif
62 #ifdef CONFIG_EARLY_SCIF_CONSOLE
63 #include <linux/serial_core.h>
64 #include "../../../drivers/serial/sh-sci.h"
66 #if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
67 defined(CONFIG_CPU_SUBTYPE_SH7721)
68 #define EPK_SCSMR_VALUE 0x000
69 #define EPK_SCBRR_VALUE 0x00C
70 #define EPK_FIFO_SIZE 64
71 #define EPK_FIFO_BITS (0x7f00 >> 8)
72 #else
73 #define EPK_FIFO_SIZE 16
74 #define EPK_FIFO_BITS (0x1f00 >> 8)
75 #endif
77 static struct uart_port scif_port = {
78 .mapbase = CONFIG_EARLY_SCIF_CONSOLE_PORT,
79 .membase = (char __iomem *)CONFIG_EARLY_SCIF_CONSOLE_PORT,
82 static void scif_sercon_putc(int c)
84 while (((sci_in(&scif_port, SCFDR) & EPK_FIFO_BITS) >= EPK_FIFO_SIZE))
87 sci_out(&scif_port, SCxTDR, c);
88 sci_in(&scif_port, SCxSR);
89 sci_out(&scif_port, SCxSR, 0xf3 & ~(0x20 | 0x40));
91 while ((sci_in(&scif_port, SCxSR) & 0x40) == 0)
94 if (c == '\n')
95 scif_sercon_putc('\r');
98 static void scif_sercon_write(struct console *con, const char *s,
99 unsigned count)
101 while (count-- > 0)
102 scif_sercon_putc(*s++);
105 static int __init scif_sercon_setup(struct console *con, char *options)
107 con->cflag = CREAD | HUPCL | CLOCAL | B115200 | CS8;
109 return 0;
112 static struct console scif_console = {
113 .name = "sercon",
114 .write = scif_sercon_write,
115 .setup = scif_sercon_setup,
116 .flags = CON_PRINTBUFFER,
117 .index = -1,
120 #if !defined(CONFIG_SH_STANDARD_BIOS)
121 #if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
122 defined(CONFIG_CPU_SUBTYPE_SH7721)
123 static void scif_sercon_init(char *s)
125 sci_out(&scif_port, SCSCR, 0x0000); /* clear TE and RE */
126 sci_out(&scif_port, SCFCR, 0x4006); /* reset */
127 sci_out(&scif_port, SCSCR, 0x0000); /* select internal clock */
128 sci_out(&scif_port, SCSMR, EPK_SCSMR_VALUE);
129 sci_out(&scif_port, SCBRR, EPK_SCBRR_VALUE);
131 mdelay(1); /* wait 1-bit time */
133 sci_out(&scif_port, SCFCR, 0x0030); /* TTRG=b'11 */
134 sci_out(&scif_port, SCSCR, 0x0030); /* TE, RE */
136 #elif defined(CONFIG_CPU_SH4)
137 #define DEFAULT_BAUD 115200
139 * Simple SCIF init, primarily aimed at SH7750 and other similar SH-4
140 * devices that aren't using sh-ipl+g.
142 static void scif_sercon_init(char *s)
144 struct uart_port *port = &scif_port;
145 unsigned baud = DEFAULT_BAUD;
146 unsigned int status;
147 char *e;
149 if (*s == ',')
150 ++s;
152 if (*s) {
153 /* ignore ioport/device name */
154 s += strcspn(s, ",");
155 if (*s == ',')
156 s++;
159 if (*s) {
160 baud = simple_strtoul(s, &e, 0);
161 if (baud == 0 || s == e)
162 baud = DEFAULT_BAUD;
165 do {
166 status = sci_in(port, SCxSR);
167 } while (!(status & SCxSR_TEND(port)));
169 sci_out(port, SCSCR, 0); /* TE=0, RE=0 */
170 sci_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);
171 sci_out(port, SCSMR, 0);
173 /* Set baud rate */
174 sci_out(port, SCBRR, (CONFIG_SH_PCLK_FREQ + 16 * baud) /
175 (32 * baud) - 1);
176 udelay((1000000+(baud-1)) / baud); /* Wait one bit interval */
178 sci_out(port, SCSPTR, 0);
179 sci_out(port, SCxSR, 0x60);
180 sci_out(port, SCLSR, 0);
182 sci_out(port, SCFCR, 0);
183 sci_out(port, SCSCR, 0x30); /* TE=1, RE=1 */
185 #endif /* defined(CONFIG_CPU_SUBTYPE_SH7720) */
186 #endif /* !defined(CONFIG_SH_STANDARD_BIOS) */
187 #endif /* CONFIG_EARLY_SCIF_CONSOLE */
190 * Setup a default console, if more than one is compiled in, rely on the
191 * earlyprintk= parsing to give priority.
193 static struct console *early_console =
194 #ifdef CONFIG_SH_STANDARD_BIOS
195 &bios_console
196 #elif defined(CONFIG_EARLY_SCIF_CONSOLE)
197 &scif_console
198 #else
199 NULL
200 #endif
203 static int __init setup_early_printk(char *buf)
205 int keep_early = 0;
207 if (!buf)
208 return 0;
210 if (strstr(buf, "keep"))
211 keep_early = 1;
213 #ifdef CONFIG_SH_STANDARD_BIOS
214 if (!strncmp(buf, "bios", 4))
215 early_console = &bios_console;
216 #endif
217 #if defined(CONFIG_EARLY_SCIF_CONSOLE)
218 if (!strncmp(buf, "serial", 6)) {
219 early_console = &scif_console;
221 #if !defined(CONFIG_SH_STANDARD_BIOS)
222 #if defined(CONFIG_CPU_SH4) || defined(CONFIG_CPU_SUBTYPE_SH7720) || \
223 defined(CONFIG_CPU_SUBTYPE_SH7721)
224 scif_sercon_init(buf + 6);
225 #endif
226 #endif
228 #endif
230 if (likely(early_console)) {
231 if (keep_early)
232 early_console->flags &= ~CON_BOOT;
233 else
234 early_console->flags |= CON_BOOT;
235 register_console(early_console);
238 return 0;
240 early_param("earlyprintk", setup_early_printk);