|
@@ -15,7 +15,6 @@
|
|
|
#include <linux/io.h>
|
|
|
#include <linux/delay.h>
|
|
|
|
|
|
-#ifdef CONFIG_SH_STANDARD_BIOS
|
|
|
#include <asm/sh_bios.h>
|
|
|
|
|
|
/*
|
|
@@ -57,140 +56,7 @@ static struct console bios_console = {
|
|
|
.flags = CON_PRINTBUFFER,
|
|
|
.index = -1,
|
|
|
};
|
|
|
-#endif
|
|
|
|
|
|
-#ifdef CONFIG_EARLY_SCIF_CONSOLE
|
|
|
-#include <linux/serial_core.h>
|
|
|
-#include "../../../drivers/serial/sh-sci.h"
|
|
|
-
|
|
|
-#if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
|
|
|
- defined(CONFIG_CPU_SUBTYPE_SH7721)
|
|
|
-#define EPK_SCSMR_VALUE 0x000
|
|
|
-#define EPK_SCBRR_VALUE 0x00C
|
|
|
-#define EPK_FIFO_SIZE 64
|
|
|
-#define EPK_FIFO_BITS (0x7f00 >> 8)
|
|
|
-#else
|
|
|
-#define EPK_FIFO_SIZE 16
|
|
|
-#define EPK_FIFO_BITS (0x1f00 >> 8)
|
|
|
-#endif
|
|
|
-
|
|
|
-static struct uart_port scif_port = {
|
|
|
- .type = PORT_SCIF,
|
|
|
- .mapbase = CONFIG_EARLY_SCIF_CONSOLE_PORT,
|
|
|
- .membase = (char __iomem *)CONFIG_EARLY_SCIF_CONSOLE_PORT,
|
|
|
-};
|
|
|
-
|
|
|
-static void scif_sercon_putc(int c)
|
|
|
-{
|
|
|
- while (((sci_in(&scif_port, SCFDR) & EPK_FIFO_BITS) >= EPK_FIFO_SIZE))
|
|
|
- ;
|
|
|
-
|
|
|
- sci_in(&scif_port, SCxSR);
|
|
|
- sci_out(&scif_port, SCxSR, 0xf3 & ~(0x20 | 0x40));
|
|
|
- sci_out(&scif_port, SCxTDR, c);
|
|
|
-
|
|
|
- while ((sci_in(&scif_port, SCxSR) & 0x40) == 0)
|
|
|
- ;
|
|
|
-
|
|
|
- if (c == '\n')
|
|
|
- scif_sercon_putc('\r');
|
|
|
-}
|
|
|
-
|
|
|
-static void scif_sercon_write(struct console *con, const char *s,
|
|
|
- unsigned count)
|
|
|
-{
|
|
|
- while (count-- > 0)
|
|
|
- scif_sercon_putc(*s++);
|
|
|
-}
|
|
|
-
|
|
|
-static int __init scif_sercon_setup(struct console *con, char *options)
|
|
|
-{
|
|
|
- con->cflag = CREAD | HUPCL | CLOCAL | B115200 | CS8;
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static struct console scif_console = {
|
|
|
- .name = "sercon",
|
|
|
- .write = scif_sercon_write,
|
|
|
- .setup = scif_sercon_setup,
|
|
|
- .flags = CON_PRINTBUFFER,
|
|
|
- .index = -1,
|
|
|
-};
|
|
|
-
|
|
|
-#if !defined(CONFIG_SH_STANDARD_BIOS)
|
|
|
-#if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
|
|
|
- defined(CONFIG_CPU_SUBTYPE_SH7721)
|
|
|
-static void scif_sercon_init(char *s)
|
|
|
-{
|
|
|
- sci_out(&scif_port, SCSCR, 0x0000); /* clear TE and RE */
|
|
|
- sci_out(&scif_port, SCFCR, 0x4006); /* reset */
|
|
|
- sci_out(&scif_port, SCSCR, 0x0000); /* select internal clock */
|
|
|
- sci_out(&scif_port, SCSMR, EPK_SCSMR_VALUE);
|
|
|
- sci_out(&scif_port, SCBRR, EPK_SCBRR_VALUE);
|
|
|
-
|
|
|
- mdelay(1); /* wait 1-bit time */
|
|
|
-
|
|
|
- sci_out(&scif_port, SCFCR, 0x0030); /* TTRG=b'11 */
|
|
|
- sci_out(&scif_port, SCSCR, 0x0030); /* TE, RE */
|
|
|
-}
|
|
|
-#elif defined(CONFIG_CPU_SH4) || defined(CONFIG_CPU_SH3)
|
|
|
-#define DEFAULT_BAUD 115200
|
|
|
-/*
|
|
|
- * Simple SCIF init, primarily aimed at SH7750 and other similar SH-4
|
|
|
- * devices that aren't using sh-ipl+g.
|
|
|
- */
|
|
|
-static void scif_sercon_init(char *s)
|
|
|
-{
|
|
|
- struct uart_port *port = &scif_port;
|
|
|
- unsigned baud = DEFAULT_BAUD;
|
|
|
- unsigned int status;
|
|
|
- char *e;
|
|
|
-
|
|
|
- if (*s == ',')
|
|
|
- ++s;
|
|
|
-
|
|
|
- if (*s) {
|
|
|
- /* ignore ioport/device name */
|
|
|
- s += strcspn(s, ",");
|
|
|
- if (*s == ',')
|
|
|
- s++;
|
|
|
- }
|
|
|
-
|
|
|
- if (*s) {
|
|
|
- baud = simple_strtoul(s, &e, 0);
|
|
|
- if (baud == 0 || s == e)
|
|
|
- baud = DEFAULT_BAUD;
|
|
|
- }
|
|
|
-
|
|
|
- do {
|
|
|
- status = sci_in(port, SCxSR);
|
|
|
- } while (!(status & SCxSR_TEND(port)));
|
|
|
-
|
|
|
- sci_out(port, SCSCR, 0); /* TE=0, RE=0 */
|
|
|
- sci_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);
|
|
|
- sci_out(port, SCSMR, 0);
|
|
|
-
|
|
|
- /* Set baud rate */
|
|
|
- sci_out(port, SCBRR, (CONFIG_SH_PCLK_FREQ + 16 * baud) /
|
|
|
- (32 * baud) - 1);
|
|
|
- udelay((1000000+(baud-1)) / baud); /* Wait one bit interval */
|
|
|
-
|
|
|
- sci_out(port, SCSPTR, 0);
|
|
|
- sci_out(port, SCxSR, 0x60);
|
|
|
- sci_out(port, SCLSR, 0);
|
|
|
-
|
|
|
- sci_out(port, SCFCR, 0);
|
|
|
- sci_out(port, SCSCR, 0x30); /* TE=1, RE=1 */
|
|
|
-}
|
|
|
-#endif /* defined(CONFIG_CPU_SUBTYPE_SH7720) */
|
|
|
-#endif /* !defined(CONFIG_SH_STANDARD_BIOS) */
|
|
|
-#endif /* CONFIG_EARLY_SCIF_CONSOLE */
|
|
|
-
|
|
|
-/*
|
|
|
- * Setup a default console, if more than one is compiled in, rely on the
|
|
|
- * earlyprintk= parsing to give priority.
|
|
|
- */
|
|
|
static struct console *early_console;
|
|
|
|
|
|
static int __init setup_early_printk(char *buf)
|
|
@@ -203,21 +69,8 @@ static int __init setup_early_printk(char *buf)
|
|
|
if (strstr(buf, "keep"))
|
|
|
keep_early = 1;
|
|
|
|
|
|
-#ifdef CONFIG_SH_STANDARD_BIOS
|
|
|
if (!strncmp(buf, "bios", 4))
|
|
|
early_console = &bios_console;
|
|
|
-#endif
|
|
|
-#if defined(CONFIG_EARLY_SCIF_CONSOLE)
|
|
|
- if (!strncmp(buf, "serial", 6)) {
|
|
|
- early_console = &scif_console;
|
|
|
-
|
|
|
-#if !defined(CONFIG_SH_STANDARD_BIOS)
|
|
|
-#if defined(CONFIG_CPU_SH4) || defined(CONFIG_CPU_SH3)
|
|
|
- scif_sercon_init(buf + 6);
|
|
|
-#endif
|
|
|
-#endif
|
|
|
- }
|
|
|
-#endif
|
|
|
|
|
|
if (likely(early_console)) {
|
|
|
if (keep_early)
|