aboutsummaryrefslogtreecommitdiffstats
path: root/arch/sh
diff options
context:
space:
mode:
Diffstat (limited to 'arch/sh')
-rw-r--r--arch/sh/kernel/sh_bios.c70
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
19static __inline__ long sh_bios_call(long func, long arg0, long arg1, long arg2, long arg3) 19static 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
34void sh_bios_console_write(const char *buf, unsigned int len) 34void 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
40void sh_bios_char_out(char ch) 39void 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
46int sh_bios_in_gdb_mode(void) 44int 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
62void sh_bios_gdb_detach(void) 59void 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
66EXPORT_SYMBOL(sh_bios_gdb_detach); 64EXPORT_SYMBOL(sh_bios_gdb_detach);
67 65
68void sh_bios_get_node_addr (unsigned char *node_addr) 66void 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
73void sh_bios_shutdown(unsigned int how) 71void 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}