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
 23void (*sun3x_putchar)(int);
 24int (*sun3x_getchar)(void);
 25int (*sun3x_mayget)(void);
 26int (*sun3x_mayput)(int);
 27void (*sun3x_prom_reboot)(void);
 28e_vector sun3x_prom_abort;
 29struct linux_romvec *romvec;
 30
 31/* prom vector table */
 32e_vector *sun3x_prom_vbr;
 33
 34/* Handle returning to the prom */
 35void 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
 60void 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
 76static 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
 88static struct console sun3x_debug = {
 89	.name	= "debug",
 90	.write	= sun3x_prom_write,
 91	.flags	= CON_PRINTBUFFER,
 92	.index	= -1,
 93};
 94
 95void __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
122static 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
130early_param("debug", sun3x_debug_setup);
131
132/* some prom functions to export */
133int prom_getintdefault(int node, char *property, int deflt)
134{
135	return deflt;
136}
137
138int prom_getbool (int node, char *prop)
139{
140	return 1;
141}
142
143void prom_printf(char *fmt, ...)
144{
145}
146
147void 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 */
156unsigned char
157prom_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}