| /* |
| * linux/arch/unicore32/kernel/early_printk.c |
| * |
| * Code specific to PKUnity SoC and UniCore ISA |
| * |
| * Copyright (C) 2001-2010 GUAN Xue-tao |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| #include <linux/console.h> |
| #include <linux/init.h> |
| #include <linux/string.h> |
| #include <mach/ocd.h> |
| |
| /* On-Chip-Debugger functions */ |
| |
| static void early_ocd_write(struct console *con, const char *s, unsigned n) |
| { |
| while (*s && n-- > 0) { |
| if (*s == '\n') |
| ocd_putc((int)'\r'); |
| ocd_putc((int)*s); |
| s++; |
| } |
| } |
| |
| static struct console early_ocd_console = { |
| .name = "earlyocd", |
| .write = early_ocd_write, |
| .flags = CON_PRINTBUFFER, |
| .index = -1, |
| }; |
| |
| /* Direct interface for emergencies */ |
| static struct console *early_console = &early_ocd_console; |
| |
| static int __initdata keep_early; |
| |
| static int __init setup_early_printk(char *buf) |
| { |
| if (!buf) |
| return 0; |
| |
| if (strstr(buf, "keep")) |
| keep_early = 1; |
| |
| if (!strncmp(buf, "ocd", 3)) |
| early_console = &early_ocd_console; |
| |
| if (keep_early) |
| early_console->flags &= ~CON_BOOT; |
| else |
| early_console->flags |= CON_BOOT; |
| register_console(early_console); |
| return 0; |
| } |
| early_param("earlyprintk", setup_early_printk); |