Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[linux-2.6] / arch / mips / sibyte / cfe / console.c
1 #include <linux/init.h>
2 #include <linux/errno.h>
3 #include <linux/console.h>
4
5 #include <asm/sibyte/board.h>
6
7 #include <asm/fw/cfe/cfe_api.h>
8 #include <asm/fw/cfe/cfe_error.h>
9
10 extern int cfe_cons_handle;
11
12 static void cfe_console_write(struct console *cons, const char *str,
13                        unsigned int count)
14 {
15         int i, last, written;
16
17         for (i=0, last=0; i<count; i++) {
18                 if (!str[i])
19                         /* XXXKW can/should this ever happen? */
20                         return;
21                 if (str[i] == '\n') {
22                         do {
23                                 written = cfe_write(cfe_cons_handle, &str[last], i-last);
24                                 if (written < 0)
25                                         ;
26                                 last += written;
27                         } while (last < i);
28                         while (cfe_write(cfe_cons_handle, "\r", 1) <= 0)
29                                 ;
30                 }
31         }
32         if (last != count) {
33                 do {
34                         written = cfe_write(cfe_cons_handle, &str[last], count-last);
35                         if (written < 0)
36                                 ;
37                         last += written;
38                 } while (last < count);
39         }
40
41 }
42
43 static int cfe_console_setup(struct console *cons, char *str)
44 {
45         char consdev[32];
46         /* XXXKW think about interaction with 'console=' cmdline arg */
47         /* If none of the console options are configured, the build will break. */
48         if (cfe_getenv("BOOT_CONSOLE", consdev, 32) >= 0) {
49 #ifdef CONFIG_SERIAL_SB1250_DUART
50                 if (!strcmp(consdev, "uart0")) {
51                         setleds("u0cn");
52                 } else if (!strcmp(consdev, "uart1")) {
53                         setleds("u1cn");
54 #endif
55 #ifdef CONFIG_VGA_CONSOLE
56                 } else if (!strcmp(consdev, "pcconsole0")) {
57                         setleds("pccn");
58 #endif
59                 } else
60                         return -ENODEV;
61         }
62         return 0;
63 }
64
65 static struct console sb1250_cfe_cons = {
66         .name           = "cfe",
67         .write          = cfe_console_write,
68         .setup          = cfe_console_setup,
69         .flags          = CON_PRINTBUFFER,
70         .index          = -1,
71 };
72
73 static int __init sb1250_cfe_console_init(void)
74 {
75         register_console(&sb1250_cfe_cons);
76         return 0;
77 }
78
79 console_initcall(sb1250_cfe_console_init);