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 */
sun3x_halt(void)35 void sun3x_halt(void)
36 {
37 unsigned long flags;
38
39 /* Disable interrupts while we mess with things */
40 local_irq_save(flags);
41
42 /* Restore prom vbr */
43 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));
44
45 /* Restore prom NMI clock */
46 // sun3x_disable_intreg(5);
47 sun3_enable_irq(7);
48
49 /* Let 'er rip */
50 asm volatile ("trap #14");
51
52 /* Restore everything */
53 sun3_disable_irq(7);
54 sun3_enable_irq(5);
55
56 asm volatile ("movec %0,%%vbr" : : "r" ((void*)vectors));
57 local_irq_restore(flags);
58 }
59
sun3x_reboot(void)60 void sun3x_reboot(void)
61 {
62 /* This never returns, don't bother saving things */
63 local_irq_disable();
64
65 /* Restore prom vbr */
66 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));
67
68 /* Restore prom NMI clock */
69 sun3_disable_irq(5);
70 sun3_enable_irq(7);
71
72 /* Let 'er rip */
73 (*romvec->pv_reboot)("vmlinux");
74 }
75
sun3x_prom_write(struct console * co,const char * s,unsigned int count)76 static void sun3x_prom_write(struct console *co, const char *s,
77 unsigned int count)
78 {
79 while (count--) {
80 if (*s == '\n')
81 sun3x_putchar('\r');
82 sun3x_putchar(*s++);
83 }
84 }
85
86 /* debug console - write-only */
87
88 static struct console sun3x_debug = {
89 .name = "debug",
90 .write = sun3x_prom_write,
91 .flags = CON_PRINTBUFFER,
92 .index = -1,
93 };
94
sun3x_prom_init(void)95 void __init sun3x_prom_init(void)
96 {
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;
120 }
121
sun3x_debug_setup(char * arg)122 static int __init sun3x_debug_setup(char *arg)
123 {
124 /* If debug=prom was specified, start the debug console */
125 if (MACH_IS_SUN3X && !strcmp(arg, "prom"))
126 register_console(&sun3x_debug);
127 return 0;
128 }
129
130 early_param("debug", sun3x_debug_setup);
131
132 /* some prom functions to export */
prom_getintdefault(int node,char * property,int deflt)133 int prom_getintdefault(int node, char *property, int deflt)
134 {
135 return deflt;
136 }
137
prom_getbool(int node,char * prop)138 int prom_getbool (int node, char *prop)
139 {
140 return 1;
141 }
142
prom_printf(char * fmt,...)143 void prom_printf(char *fmt, ...)
144 {
145 }
146
prom_halt(void)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
prom_get_idprom(char * idbuf,int num_bytes)157 prom_get_idprom(char *idbuf, int num_bytes)
158 {
159 int i;
160
161 /* make a copy of the idprom structure */
162 for (i = 0; i < num_bytes; i++)
163 idbuf[i] = ((char *)SUN3X_IDPROM)[i];
164
165 return idbuf[0];
166 }
167