Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* Prom access routines for the sun3x */ |
2 | ||
3 | #include <linux/types.h> | |
4 | #include <linux/kernel.h> | |
5 | #include <linux/tty.h> | |
6 | #include <linux/console.h> | |
7 | #include <linux/init.h> | |
8 | #include <linux/mm.h> | |
9 | #include <linux/string.h> | |
10 | ||
11 | #include <asm/page.h> | |
12 | #include <asm/pgtable.h> | |
1da177e4 LT |
13 | #include <asm/setup.h> |
14 | #include <asm/traps.h> | |
15 | #include <asm/sun3xprom.h> | |
16 | #include <asm/idprom.h> | |
17 | #include <asm/segment.h> | |
18 | #include <asm/sun3ints.h> | |
19 | #include <asm/openprom.h> | |
20 | #include <asm/machines.h> | |
21 | ||
22 | void (*sun3x_putchar)(int); | |
23 | int (*sun3x_getchar)(void); | |
24 | int (*sun3x_mayget)(void); | |
25 | int (*sun3x_mayput)(int); | |
26 | void (*sun3x_prom_reboot)(void); | |
27 | e_vector sun3x_prom_abort; | |
28 | struct linux_romvec *romvec; | |
29 | ||
30 | /* prom vector table */ | |
31 | e_vector *sun3x_prom_vbr; | |
32 | ||
33 | /* Handle returning to the prom */ | |
34 | void sun3x_halt(void) | |
35 | { | |
6ff5801a | 36 | unsigned long flags; |
1da177e4 | 37 | |
6ff5801a RZ |
38 | /* Disable interrupts while we mess with things */ |
39 | local_irq_save(flags); | |
1da177e4 | 40 | |
6ff5801a RZ |
41 | /* Restore prom vbr */ |
42 | asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); | |
1da177e4 | 43 | |
6ff5801a RZ |
44 | /* Restore prom NMI clock */ |
45 | // sun3x_disable_intreg(5); | |
46 | sun3_enable_irq(7); | |
1da177e4 | 47 | |
6ff5801a RZ |
48 | /* Let 'er rip */ |
49 | asm volatile ("trap #14"); | |
1da177e4 | 50 | |
6ff5801a RZ |
51 | /* Restore everything */ |
52 | sun3_disable_irq(7); | |
53 | sun3_enable_irq(5); | |
1da177e4 | 54 | |
6ff5801a RZ |
55 | asm volatile ("movec %0,%%vbr" : : "r" ((void*)vectors)); |
56 | local_irq_restore(flags); | |
1da177e4 LT |
57 | } |
58 | ||
59 | void sun3x_reboot(void) | |
60 | { | |
6ff5801a RZ |
61 | /* This never returns, don't bother saving things */ |
62 | local_irq_disable(); | |
1da177e4 | 63 | |
6ff5801a RZ |
64 | /* Restore prom vbr */ |
65 | asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); | |
1da177e4 | 66 | |
6ff5801a RZ |
67 | /* Restore prom NMI clock */ |
68 | sun3_disable_irq(5); | |
69 | sun3_enable_irq(7); | |
1da177e4 | 70 | |
6ff5801a RZ |
71 | /* Let 'er rip */ |
72 | (*romvec->pv_reboot)("vmlinux"); | |
1da177e4 LT |
73 | } |
74 | ||
1da177e4 LT |
75 | static void sun3x_prom_write(struct console *co, const char *s, |
76 | unsigned int count) | |
77 | { | |
6ff5801a RZ |
78 | while (count--) { |
79 | if (*s == '\n') | |
80 | sun3x_putchar('\r'); | |
81 | sun3x_putchar(*s++); | |
82 | } | |
1da177e4 LT |
83 | } |
84 | ||
85 | /* debug console - write-only */ | |
86 | ||
87 | static struct console sun3x_debug = { | |
6ff5801a RZ |
88 | .name = "debug", |
89 | .write = sun3x_prom_write, | |
90 | .flags = CON_PRINTBUFFER, | |
91 | .index = -1, | |
1da177e4 LT |
92 | }; |
93 | ||
66a3f820 | 94 | void __init sun3x_prom_init(void) |
1da177e4 | 95 | { |
6ff5801a RZ |
96 | /* Read the vector table */ |
97 | ||
98 | sun3x_putchar = *(void (**)(int)) (SUN3X_P_PUTCHAR); | |
99 | sun3x_getchar = *(int (**)(void)) (SUN3X_P_GETCHAR); | |
100 | sun3x_mayget = *(int (**)(void)) (SUN3X_P_MAYGET); | |
101 | sun3x_mayput = *(int (**)(int)) (SUN3X_P_MAYPUT); | |
102 | sun3x_prom_reboot = *(void (**)(void)) (SUN3X_P_REBOOT); | |
103 | sun3x_prom_abort = *(e_vector *) (SUN3X_P_ABORT); | |
104 | romvec = (struct linux_romvec *)SUN3X_PROM_BASE; | |
105 | ||
106 | idprom_init(); | |
107 | ||
108 | if (!((idprom->id_machtype & SM_ARCH_MASK) == SM_SUN3X)) { | |
109 | printk("Warning: machine reports strange type %02x\n", | |
110 | idprom->id_machtype); | |
111 | printk("Pretending it's a 3/80, but very afraid...\n"); | |
112 | idprom->id_machtype = SM_SUN3X | SM_3_80; | |
113 | } | |
114 | ||
115 | /* point trap #14 at abort. | |
116 | * XXX this is futile since we restore the vbr first - oops | |
117 | */ | |
118 | vectors[VEC_TRAP14] = sun3x_prom_abort; | |
d6713b40 | 119 | } |
6ff5801a | 120 | |
d6713b40 RZ |
121 | static int __init sun3x_debug_setup(char *arg) |
122 | { | |
6ff5801a | 123 | /* If debug=prom was specified, start the debug console */ |
d6713b40 | 124 | if (MACH_IS_SUN3X && !strcmp(arg, "prom")) |
6ff5801a | 125 | register_console(&sun3x_debug); |
d6713b40 | 126 | return 0; |
1da177e4 LT |
127 | } |
128 | ||
d6713b40 RZ |
129 | early_param("debug", sun3x_debug_setup); |
130 | ||
1da177e4 LT |
131 | /* some prom functions to export */ |
132 | int prom_getintdefault(int node, char *property, int deflt) | |
133 | { | |
134 | return deflt; | |
135 | } | |
136 | ||
137 | int prom_getbool (int node, char *prop) | |
138 | { | |
139 | return 1; | |
140 | } | |
141 | ||
142 | void prom_printf(char *fmt, ...) | |
143 | { | |
1da177e4 LT |
144 | } |
145 | ||
146 | void prom_halt (void) | |
147 | { | |
148 | sun3x_halt(); | |
149 | } | |
150 | ||
151 | /* Get the idprom and stuff it into buffer 'idbuf'. Returns the | |
152 | * format type. 'num_bytes' is the number of bytes that your idbuf | |
153 | * has space for. Returns 0xff on error. | |
154 | */ | |
155 | unsigned char | |
156 | prom_get_idprom(char *idbuf, int num_bytes) | |
157 | { | |
158 | int i; | |
159 | ||
160 | /* make a copy of the idprom structure */ | |
6ff5801a | 161 | for (i = 0; i < num_bytes; i++) |
1da177e4 LT |
162 | idbuf[i] = ((char *)SUN3X_IDPROM)[i]; |
163 | ||
164 | return idbuf[0]; | |
165 | } |