diff options
Diffstat (limited to 'arch/sh')
-rw-r--r-- | arch/sh/kernel/sh_bios.c | 70 |
1 files changed, 34 insertions, 36 deletions
diff --git a/arch/sh/kernel/sh_bios.c b/arch/sh/kernel/sh_bios.c index d1bcac4fa269..7c8c58ec5dec 100644 --- a/arch/sh/kernel/sh_bios.c +++ b/arch/sh/kernel/sh_bios.c | |||
@@ -8,69 +8,67 @@ | |||
8 | #include <linux/module.h> | 8 | #include <linux/module.h> |
9 | #include <asm/sh_bios.h> | 9 | #include <asm/sh_bios.h> |
10 | 10 | ||
11 | #define BIOS_CALL_CONSOLE_WRITE 0 | 11 | #define BIOS_CALL_CONSOLE_WRITE 0 |
12 | #define BIOS_CALL_READ_BLOCK 1 | 12 | #define BIOS_CALL_READ_BLOCK 1 |
13 | #define BIOS_CALL_ETH_NODE_ADDR 10 | 13 | #define BIOS_CALL_ETH_NODE_ADDR 10 |
14 | #define BIOS_CALL_SHUTDOWN 11 | 14 | #define BIOS_CALL_SHUTDOWN 11 |
15 | #define BIOS_CALL_CHAR_OUT 0x1f /* TODO: hack */ | 15 | #define BIOS_CALL_CHAR_OUT 0x1f /* TODO: hack */ |
16 | #define BIOS_CALL_GDB_GET_MODE_PTR 0xfe | 16 | #define BIOS_CALL_GDB_GET_MODE_PTR 0xfe |
17 | #define BIOS_CALL_GDB_DETACH 0xff | 17 | #define BIOS_CALL_GDB_DETACH 0xff |
18 | 18 | ||
19 | static __inline__ long sh_bios_call(long func, long arg0, long arg1, long arg2, long arg3) | 19 | static inline long sh_bios_call(long func, long arg0, long arg1, long arg2, |
20 | long arg3) | ||
20 | { | 21 | { |
21 | register long r0 __asm__("r0") = func; | 22 | register long r0 __asm__("r0") = func; |
22 | register long r4 __asm__("r4") = arg0; | 23 | register long r4 __asm__("r4") = arg0; |
23 | register long r5 __asm__("r5") = arg1; | 24 | register long r5 __asm__("r5") = arg1; |
24 | register long r6 __asm__("r6") = arg2; | 25 | register long r6 __asm__("r6") = arg2; |
25 | register long r7 __asm__("r7") = arg3; | 26 | register long r7 __asm__("r7") = arg3; |
26 | __asm__ __volatile__("trapa #0x3f" | ||
27 | : "=z" (r0) | ||
28 | : "0" (r0), "r" (r4), "r" (r5), "r" (r6), "r" (r7) | ||
29 | : "memory"); | ||
30 | return r0; | ||
31 | } | ||
32 | 27 | ||
28 | __asm__ __volatile__("trapa #0x3f":"=z"(r0) | ||
29 | :"0"(r0), "r"(r4), "r"(r5), "r"(r6), "r"(r7) | ||
30 | :"memory"); | ||
31 | return r0; | ||
32 | } | ||
33 | 33 | ||
34 | void sh_bios_console_write(const char *buf, unsigned int len) | 34 | void sh_bios_console_write(const char *buf, unsigned int len) |
35 | { | 35 | { |
36 | sh_bios_call(BIOS_CALL_CONSOLE_WRITE, (long)buf, (long)len, 0, 0); | 36 | sh_bios_call(BIOS_CALL_CONSOLE_WRITE, (long)buf, (long)len, 0, 0); |
37 | } | 37 | } |
38 | 38 | ||
39 | |||
40 | void sh_bios_char_out(char ch) | 39 | void sh_bios_char_out(char ch) |
41 | { | 40 | { |
42 | sh_bios_call(BIOS_CALL_CHAR_OUT, ch, 0, 0, 0); | 41 | sh_bios_call(BIOS_CALL_CHAR_OUT, ch, 0, 0, 0); |
43 | } | 42 | } |
44 | 43 | ||
45 | |||
46 | int sh_bios_in_gdb_mode(void) | 44 | int sh_bios_in_gdb_mode(void) |
47 | { | 45 | { |
48 | static char queried = 0; | 46 | static char queried = 0; |
49 | static char *gdb_mode_p = 0; | 47 | static char *gdb_mode_p = 0; |
50 | 48 | ||
51 | if (!queried) | 49 | if (!queried) { |
52 | { | 50 | /* Query the gdb stub for address of its gdb mode variable */ |
53 | /* Query the gdb stub for address of its gdb mode variable */ | 51 | long r = sh_bios_call(BIOS_CALL_GDB_GET_MODE_PTR, 0, 0, 0, 0); |
54 | long r = sh_bios_call(BIOS_CALL_GDB_GET_MODE_PTR, 0, 0, 0, 0); | 52 | if (r != ~0) /* BIOS returns -1 for unknown function */ |
55 | if (r != ~0) /* BIOS returns -1 for unknown function */ | 53 | gdb_mode_p = (char *)r; |
56 | gdb_mode_p = (char *)r; | 54 | queried = 1; |
57 | queried = 1; | 55 | } |
58 | } | 56 | return (gdb_mode_p != 0 ? *gdb_mode_p : 0); |
59 | return (gdb_mode_p != 0 ? *gdb_mode_p : 0); | ||
60 | } | 57 | } |
61 | 58 | ||
62 | void sh_bios_gdb_detach(void) | 59 | void sh_bios_gdb_detach(void) |
63 | { | 60 | { |
64 | sh_bios_call(BIOS_CALL_GDB_DETACH, 0, 0, 0, 0); | 61 | sh_bios_call(BIOS_CALL_GDB_DETACH, 0, 0, 0, 0); |
65 | } | 62 | } |
63 | |||
66 | EXPORT_SYMBOL(sh_bios_gdb_detach); | 64 | EXPORT_SYMBOL(sh_bios_gdb_detach); |
67 | 65 | ||
68 | void sh_bios_get_node_addr (unsigned char *node_addr) | 66 | void sh_bios_get_node_addr(unsigned char *node_addr) |
69 | { | 67 | { |
70 | sh_bios_call(BIOS_CALL_ETH_NODE_ADDR, 0, (long)node_addr, 0, 0); | 68 | sh_bios_call(BIOS_CALL_ETH_NODE_ADDR, 0, (long)node_addr, 0, 0); |
71 | } | 69 | } |
72 | 70 | ||
73 | void sh_bios_shutdown(unsigned int how) | 71 | void sh_bios_shutdown(unsigned int how) |
74 | { | 72 | { |
75 | sh_bios_call(BIOS_CALL_SHUTDOWN, how, 0, 0, 0); | 73 | sh_bios_call(BIOS_CALL_SHUTDOWN, how, 0, 0, 0); |
76 | } | 74 | } |