m68k: reformat various m68k files
[linux-2.6.git] / arch / m68k / sun3x / prom.c
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 {
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
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
76 extern char m68k_debug_device[];
77
78 static void sun3x_prom_write(struct console *co, const char *s,
79                              unsigned int count)
80 {
81         while (count--) {
82                 if (*s == '\n')
83                         sun3x_putchar('\r');
84                 sun3x_putchar(*s++);
85         }
86 }
87
88 /* debug console - write-only */
89
90 static struct console sun3x_debug = {
91         .name   = "debug",
92         .write  = sun3x_prom_write,
93         .flags  = CON_PRINTBUFFER,
94         .index  = -1,
95 };
96
97 void sun3x_prom_init(void)
98 {
99         /* Read the vector table */
100
101         sun3x_putchar = *(void (**)(int)) (SUN3X_P_PUTCHAR);
102         sun3x_getchar = *(int (**)(void)) (SUN3X_P_GETCHAR);
103         sun3x_mayget = *(int (**)(void))  (SUN3X_P_MAYGET);
104         sun3x_mayput = *(int (**)(int))   (SUN3X_P_MAYPUT);
105         sun3x_prom_reboot = *(void (**)(void)) (SUN3X_P_REBOOT);
106         sun3x_prom_abort = *(e_vector *)  (SUN3X_P_ABORT);
107         romvec = (struct linux_romvec *)SUN3X_PROM_BASE;
108
109         idprom_init();
110
111         if (!((idprom->id_machtype & SM_ARCH_MASK) == SM_SUN3X)) {
112                 printk("Warning: machine reports strange type %02x\n",
113                         idprom->id_machtype);
114                 printk("Pretending it's a 3/80, but very afraid...\n");
115                 idprom->id_machtype = SM_SUN3X | SM_3_80;
116         }
117
118         /* point trap #14 at abort.
119          * XXX this is futile since we restore the vbr first - oops
120          */
121         vectors[VEC_TRAP14] = sun3x_prom_abort;
122
123         /* If debug=prom was specified, start the debug console */
124
125         if (!strcmp(m68k_debug_device, "prom"))
126                 register_console(&sun3x_debug);
127 }
128
129 /* some prom functions to export */
130 int prom_getintdefault(int node, char *property, int deflt)
131 {
132         return deflt;
133 }
134
135 int prom_getbool (int node, char *prop)
136 {
137         return 1;
138 }
139
140 void prom_printf(char *fmt, ...)
141 {
142 }
143
144 void prom_halt (void)
145 {
146         sun3x_halt();
147 }
148
149 /* Get the idprom and stuff it into buffer 'idbuf'.  Returns the
150  * format type.  'num_bytes' is the number of bytes that your idbuf
151  * has space for.  Returns 0xff on error.
152  */
153 unsigned char
154 prom_get_idprom(char *idbuf, int num_bytes)
155 {
156         int i;
157
158         /* make a copy of the idprom structure */
159         for (i = 0; i < num_bytes; i++)
160                 idbuf[i] = ((char *)SUN3X_IDPROM)[i];
161
162         return idbuf[0];
163 }