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/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 { 36 unsigned long flags; 37 38 /* Disable interrupts while we mess with things */ 39 local_irq_save(flags); 40 41 /* Restore prom vbr */ 42 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); 43 44 /* Restore prom NMI clock */ 45 // sun3x_disable_intreg(5); 46 sun3_enable_irq(7); 47 48 /* Let 'er rip */ 49 asm volatile ("trap #14"); 50 51 /* Restore everything */ 52 sun3_disable_irq(7); 53 sun3_enable_irq(5); 54 55 asm volatile ("movec %0,%%vbr" : : "r" ((void*)vectors)); 56 local_irq_restore(flags); 57 } 58 59 void sun3x_reboot(void) 60 { 61 /* This never returns, don't bother saving things */ 62 local_irq_disable(); 63 64 /* Restore prom vbr */ 65 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); 66 67 /* Restore prom NMI clock */ 68 sun3_disable_irq(5); 69 sun3_enable_irq(7); 70 71 /* Let 'er rip */ 72 (*romvec->pv_reboot)("vmlinux"); 73 } 74 75 static void sun3x_prom_write(struct console *co, const char *s, 76 unsigned int count) 77 { 78 while (count--) { 79 if (*s == '\n') 80 sun3x_putchar('\r'); 81 sun3x_putchar(*s++); 82 } 83 } 84 85 /* debug console - write-only */ 86 87 static struct console sun3x_debug = { 88 .name = "debug", 89 .write = sun3x_prom_write, 90 .flags = CON_PRINTBUFFER, 91 .index = -1, 92 }; 93 94 void __init sun3x_prom_init(void) 95 { 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 pr_warn("Machine reports strange type %02x\n", 110 idprom->id_machtype); 111 pr_warn("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; 119 } 120 121 static int __init sun3x_debug_setup(char *arg) 122 { 123 /* If debug=prom was specified, start the debug console */ 124 if (MACH_IS_SUN3X && !strcmp(arg, "prom")) 125 register_console(&sun3x_debug); 126 return 0; 127 } 128 129 early_param("debug", sun3x_debug_setup); 130 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 { 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 */ 161 for (i = 0; i < num_bytes; i++) 162 idbuf[i] = ((char *)SUN3X_IDPROM)[i]; 163 164 return idbuf[0]; 165 } 166