release/src-rt-6.x.4708/linux/linux-2.6.36/arch/sh/kernel/sh_bios.c

   1 /*
   2  *  C interface for trapping into the standard LinuxSH BIOS.
   3  *
   4  *  Copyright (C) 2000 Greg Banks, Mitch Davis
   5  *  Copyright (C) 1999, 2000  Niibe Yutaka
   6  *  Copyright (C) 2002  M. R. Brown
   7  *  Copyright (C) 2004 - 2010  Paul Mundt
   8  *
   9  * This file is subject to the terms and conditions of the GNU General Public
  10  * License.  See the file "COPYING" in the main directory of this archive
  11  * for more details.
  12  */
  13 #include <linux/module.h>
  14 #include <linux/console.h>
  15 #include <linux/tty.h>
  16 #include <linux/init.h>
  17 #include <linux/io.h>
  18 #include <linux/delay.h>
  19 #include <asm/sh_bios.h>
  20
  21 #define BIOS_CALL_CONSOLE_WRITE         0
  22 #define BIOS_CALL_ETH_NODE_ADDR         10
  23 #define BIOS_CALL_SHUTDOWN              11
  24 #define BIOS_CALL_GDB_DETACH            0xff
  25
  26 void *gdb_vbr_vector = NULL;
  27
  28 static inline long sh_bios_call(long func, long arg0, long arg1, long arg2,
  29                                     long arg3)
  30 {
  31         register long r0 __asm__("r0") = func;
  32         register long r4 __asm__("r4") = arg0;
  33         register long r5 __asm__("r5") = arg1;
  34         register long r6 __asm__("r6") = arg2;
  35         register long r7 __asm__("r7") = arg3;
  36
  37         if (!gdb_vbr_vector)
  38                 return -ENOSYS;
  39
  40         __asm__ __volatile__("trapa     #0x3f":"=z"(r0)
  41                              :"0"(r0), "r"(r4), "r"(r5), "r"(r6), "r"(r7)
  42                              :"memory");
  43         return r0;
  44 }
  45
  46 void sh_bios_console_write(const char *buf, unsigned int len)
  47 {
  48         sh_bios_call(BIOS_CALL_CONSOLE_WRITE, (long)buf, (long)len, 0, 0);
  49 }
  50
  51 void sh_bios_gdb_detach(void)
  52 {
  53         sh_bios_call(BIOS_CALL_GDB_DETACH, 0, 0, 0, 0);
  54 }
  55 EXPORT_SYMBOL_GPL(sh_bios_gdb_detach);
  56
  57 void sh_bios_get_node_addr(unsigned char *node_addr)
  58 {
  59         sh_bios_call(BIOS_CALL_ETH_NODE_ADDR, 0, (long)node_addr, 0, 0);
  60 }
  61 EXPORT_SYMBOL_GPL(sh_bios_get_node_addr);
  62
  63 void sh_bios_shutdown(unsigned int how)
  64 {
  65         sh_bios_call(BIOS_CALL_SHUTDOWN, how, 0, 0, 0);
  66 }
  67
  68 /*
  69  * Read the old value of the VBR register to initialise the vector
  70  * through which debug and BIOS traps are delegated by the Linux trap
  71  * handler.
  72  */
  73 void sh_bios_vbr_init(void)
  74 {
  75         unsigned long vbr;
  76
  77         if (unlikely(gdb_vbr_vector))
  78                 return;
  79
  80         __asm__ __volatile__ ("stc vbr, %0" : "=r" (vbr));
  81
  82         if (vbr) {
  83                 gdb_vbr_vector = (void *)(vbr + 0x100);
  84                 printk(KERN_NOTICE "Setting GDB trap vector to %p\n",
  85                        gdb_vbr_vector);
  86         } else
  87                 printk(KERN_NOTICE "SH-BIOS not detected\n");
  88 }
  89
  90 /**
  91  * sh_bios_vbr_reload - Re-load the system VBR from the BIOS vector.
  92  *
  93  * This can be used by save/restore code to reinitialize the system VBR
  94  * from the fixed BIOS VBR. A no-op if no BIOS VBR is known.
  95  */
  96 void sh_bios_vbr_reload(void)
  97 {
  98         if (gdb_vbr_vector)
  99                 __asm__ __volatile__ (
 100                         "ldc %0, vbr"
 101                         :
 102                         : "r" (((unsigned long) gdb_vbr_vector) - 0x100)
 103                         : "memory"
 104                 );
 105 }
 106
 107 /*
 108  *      Print a string through the BIOS
 109  */
 110 static void sh_console_write(struct console *co, const char *s,
 111                                  unsigned count)
 112 {
 113         sh_bios_console_write(s, count);
 114 }
 115
 116 /*
 117  *      Setup initial baud/bits/parity. We do two things here:
 118  *      - construct a cflag setting for the first rs_open()
 119  *      - initialize the serial port
 120  *      Return non-zero if we didn't find a serial port.
 121  */
 122 static int __init sh_console_setup(struct console *co, char *options)
 123 {
 124         int     cflag = CREAD | HUPCL | CLOCAL;
 125
 126         /*
 127          *      Now construct a cflag setting.
 128          *      TODO: this is a totally bogus cflag, as we have
 129          *      no idea what serial settings the BIOS is using, or
 130          *      even if its using the serial port at all.
 131          */
 132         cflag |= B115200 | CS8 | /*no parity*/0;
 133
 134         co->cflag = cflag;
 135
 136         return 0;
 137 }
 138
 139 static struct console bios_console = {
 140         .name           = "bios",
 141         .write          = sh_console_write,
 142         .setup          = sh_console_setup,
 143         .flags          = CON_PRINTBUFFER,
 144         .index          = -1,
 145 };
 146
 147 static struct console *early_console;
 148
 149 static int __init setup_early_printk(char *buf)
 150 {
 151         int keep_early = 0;
 152
 153         if (!buf)
 154                 return 0;
 155
 156         if (strstr(buf, "keep"))
 157                 keep_early = 1;
 158
 159         if (!strncmp(buf, "bios", 4))
 160                 early_console = &bios_console;
 161
 162         if (likely(early_console)) {
 163                 if (keep_early)
 164                         early_console->flags &= ~CON_BOOT;
 165                 else
 166                         early_console->flags |= CON_BOOT;
 167                 register_console(early_console);
 168         }
 169
 170         return 0;
 171 }
 172 early_param("earlyprintk", setup_early_printk);