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