arch/unicore32/kernel/early_printk.c

   1 /*
   2  * linux/arch/unicore32/kernel/early_printk.c
   3  *
   4  * Code specific to PKUnity SoC and UniCore ISA
   5  *
   6  * Copyright (C) 2001-2010 GUAN Xue-tao
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  */
  12 #include <linux/console.h>
  13 #include <linux/init.h>
  14 #include <linux/string.h>
  15 #include <mach/ocd.h>
  16
  17 /* On-Chip-Debugger functions */
  18
  19 static void early_ocd_write(struct console *con, const char *s, unsigned n)
  20 {
  21         while (*s && n-- > 0) {
  22                 if (*s == '\n')
  23                         ocd_putc((int)'\r');
  24                 ocd_putc((int)*s);
  25                 s++;
  26         }
  27 }
  28
  29 static struct console early_ocd_console = {
  30         .name =         "earlyocd",
  31         .write =        early_ocd_write,
  32         .flags =        CON_PRINTBUFFER,
  33         .index =        -1,
  34 };
  35
  36 static int __init setup_early_printk(char *buf)
  37 {
  38         int keep_early;
  39
  40         if (!buf || early_console)
  41                 return 0;
  42
  43         if (strstr(buf, "keep"))
  44                 keep_early = 1;
  45
  46         early_console = &early_ocd_console;
  47
  48         if (keep_early)
  49                 early_console->flags &= ~CON_BOOT;
  50         else
  51                 early_console->flags |= CON_BOOT;
  52         register_console(early_console);
  53         return 0;
  54 }
  55 early_param("earlyprintk", setup_early_printk);