1 1.2 isaki /* $NetBSD: switch.c,v 1.2 2014/08/10 07:40:50 isaki Exp $ */ 2 1.1 isaki 3 1.1 isaki /* 4 1.1 isaki * Copyright (c) 2014 Tetsuya Isaki. All rights reserved. 5 1.1 isaki * 6 1.1 isaki * Redistribution and use in source and binary forms, with or without 7 1.1 isaki * modification, are permitted provided that the following conditions 8 1.1 isaki * are met: 9 1.1 isaki * 1. Redistributions of source code must retain the above copyright 10 1.1 isaki * notice, this list of conditions and the following disclaimer. 11 1.1 isaki * 2. Redistributions in binary form must reproduce the above copyright 12 1.1 isaki * notice, this list of conditions and the following disclaimer in the 13 1.1 isaki * documentation and/or other materials provided with the distribution. 14 1.1 isaki * 15 1.1 isaki * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.1 isaki * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 1.1 isaki * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 1.1 isaki * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 1.1 isaki * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 20 1.1 isaki * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 1.1 isaki * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 22 1.1 isaki * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 23 1.1 isaki * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 1.1 isaki * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 1.1 isaki * SUCH DAMAGE. 26 1.1 isaki */ 27 1.1 isaki 28 1.1 isaki #include <sys/param.h> 29 1.1 isaki #include <lib/libsa/stand.h> 30 1.1 isaki #include <lib/libkern/libkern.h> 31 1.1 isaki 32 1.1 isaki #include "switch.h" 33 1.1 isaki 34 1.1 isaki #define SRAM_MEMSIZE (*((volatile uint32_t *)0x00ed0008)) 35 1.1 isaki #define SRAM_ROMADDR (*((volatile uint32_t *)0x00ed000c)) 36 1.1 isaki #define SRAM_RAMADDR (*((volatile uint32_t *)0x00ed0010)) 37 1.1 isaki #define SRAM_BOOTDEV (*((volatile uint16_t *)0x00ed0018)) 38 1.1 isaki 39 1.1 isaki #define SYSPORT_SRAM_WP (*((volatile uint8_t *)0x00e8e00d)) 40 1.1 isaki 41 1.1 isaki static int hextoi(const char *); 42 1.1 isaki static void cmd_switch_help(void); 43 1.1 isaki static void cmd_switch_show(void); 44 1.1 isaki static void cmd_switch_show_boot(void); 45 1.1 isaki static void cmd_switch_show_rom(void); 46 1.1 isaki static void cmd_switch_show_memory(void); 47 1.1 isaki static const char *romaddr_tostr(uint32_t); 48 1.1 isaki static const char *get_romaddr_name(uint32_t); 49 1.1 isaki static void cmd_switch_boot(const char *); 50 1.1 isaki static void cmd_switch_rom(const char *); 51 1.1 isaki static void cmd_switch_memory(const char *); 52 1.1 isaki 53 1.1 isaki static inline void 54 1.1 isaki sram_write_enable(void) 55 1.1 isaki { 56 1.1 isaki SYSPORT_SRAM_WP = 0x31; 57 1.1 isaki } 58 1.1 isaki 59 1.1 isaki static inline void 60 1.1 isaki sram_write_disable(void) 61 1.1 isaki { 62 1.1 isaki SYSPORT_SRAM_WP = 0; 63 1.1 isaki } 64 1.1 isaki 65 1.1 isaki static int 66 1.1 isaki hextoi(const char *in) 67 1.1 isaki { 68 1.1 isaki char *c; 69 1.1 isaki int ret; 70 1.1 isaki 71 1.1 isaki ret = 0; 72 1.1 isaki c = (char *)in; 73 1.1 isaki for (; isxdigit(*c); c++) { 74 1.1 isaki ret = (ret * 16) + 75 1.1 isaki (*c > '9' ? ((*c | 0x20) - 'a' + 10) : *c - '0'); 76 1.1 isaki } 77 1.1 isaki return ret; 78 1.1 isaki } 79 1.1 isaki 80 1.1 isaki static void 81 1.1 isaki cmd_switch_help(void) 82 1.1 isaki { 83 1.1 isaki printf( 84 1.1 isaki "usage: switch <key>=<val>\n" 85 1.1 isaki " boot=[std | inscsi<N> | exscsi<N> | fd<N> | rom ]\n" 86 1.1 isaki " rom=[ inscsi<N> | exscsi<N> | $<addr> ]\n" 87 1.1 isaki " memory=<1..12> (unit:MB)\n" 88 1.1 isaki " switch show\n" 89 1.1 isaki ); 90 1.1 isaki } 91 1.1 isaki 92 1.1 isaki void 93 1.1 isaki cmd_switch(char *arg) 94 1.1 isaki { 95 1.1 isaki char *val; 96 1.1 isaki 97 1.1 isaki if (strcmp(arg, "show") == 0) { 98 1.1 isaki cmd_switch_show(); 99 1.1 isaki return; 100 1.1 isaki } 101 1.1 isaki 102 1.1 isaki val = strchr(arg, '='); 103 1.1 isaki if (val == NULL) { 104 1.1 isaki cmd_switch_help(); 105 1.1 isaki return; 106 1.1 isaki } 107 1.1 isaki *val++ = '\0'; 108 1.1 isaki 109 1.1 isaki if (strcmp(arg, "boot") == 0) { 110 1.1 isaki cmd_switch_boot(val); 111 1.1 isaki } else if (strcmp(arg, "rom") == 0) { 112 1.1 isaki cmd_switch_rom(val); 113 1.1 isaki } else if (strcmp(arg, "memory") == 0) { 114 1.1 isaki cmd_switch_memory(val); 115 1.1 isaki } else { 116 1.1 isaki cmd_switch_help(); 117 1.1 isaki } 118 1.1 isaki } 119 1.1 isaki 120 1.1 isaki static void 121 1.1 isaki cmd_switch_show(void) 122 1.1 isaki { 123 1.1 isaki cmd_switch_show_boot(); 124 1.1 isaki cmd_switch_show_rom(); 125 1.1 isaki cmd_switch_show_memory(); 126 1.1 isaki } 127 1.1 isaki 128 1.1 isaki static void 129 1.1 isaki cmd_switch_show_boot(void) 130 1.1 isaki { 131 1.1 isaki uint32_t romaddr; 132 1.1 isaki uint16_t bootdev; 133 1.1 isaki const char *name; 134 1.1 isaki 135 1.1 isaki bootdev = SRAM_BOOTDEV; 136 1.1 isaki romaddr = SRAM_ROMADDR; 137 1.1 isaki 138 1.1 isaki /* 139 1.1 isaki * $0000: std 140 1.1 isaki * $8n00: sasi<N> 141 1.1 isaki * $9n70: fd<N> 142 1.1 isaki * $a000: ROM 143 1.1 isaki * $b000: RAM 144 1.1 isaki */ 145 1.1 isaki printf("boot="); 146 1.1 isaki switch (bootdev >> 12) { 147 1.1 isaki default: 148 1.1 isaki case 0x0: 149 1.1 isaki /* 150 1.1 isaki * The real order is fd->sasi->rom->ram 151 1.1 isaki * but it is a bit redundant.. 152 1.1 isaki */ 153 1.1 isaki printf("std (fd -> "); 154 1.1 isaki name = get_romaddr_name(romaddr); 155 1.1 isaki if (name) 156 1.1 isaki printf("%s)", name); 157 1.1 isaki else 158 1.1 isaki printf("rom$%x)", romaddr); 159 1.1 isaki break; 160 1.1 isaki case 0x8: 161 1.1 isaki printf("sasi%d", (bootdev >> 8) & 15); 162 1.1 isaki break; 163 1.1 isaki case 0x9: 164 1.1 isaki printf("fd%d", (bootdev >> 8) & 3); 165 1.1 isaki break; 166 1.1 isaki case 0xa: 167 1.1 isaki printf("rom%s", romaddr_tostr(romaddr)); 168 1.1 isaki break; 169 1.1 isaki case 0xb: 170 1.1 isaki printf("ram$%x", SRAM_RAMADDR); 171 1.1 isaki break; 172 1.1 isaki } 173 1.1 isaki printf("\n"); 174 1.1 isaki } 175 1.1 isaki 176 1.1 isaki static void 177 1.1 isaki cmd_switch_show_rom(void) 178 1.1 isaki { 179 1.1 isaki uint32_t romaddr; 180 1.1 isaki 181 1.1 isaki romaddr = SRAM_ROMADDR; 182 1.1 isaki printf("rom=%s\n", romaddr_tostr(romaddr)); 183 1.1 isaki } 184 1.1 isaki 185 1.1 isaki static void 186 1.1 isaki cmd_switch_show_memory(void) 187 1.1 isaki { 188 1.1 isaki printf("memory=%d MB\n", SRAM_MEMSIZE / (1024 * 1024)); 189 1.1 isaki } 190 1.1 isaki 191 1.1 isaki /* return rom address as string with name if any */ 192 1.1 isaki static const char * 193 1.1 isaki romaddr_tostr(uint32_t addr) 194 1.1 isaki { 195 1.1 isaki static char buf[32]; 196 1.1 isaki const char *name; 197 1.1 isaki 198 1.1 isaki name = get_romaddr_name(addr); 199 1.1 isaki if (name) 200 1.1 isaki snprintf(buf, sizeof(buf), "$%x (%s)", addr, name); 201 1.1 isaki else 202 1.1 isaki snprintf(buf, sizeof(buf), "$%x", addr); 203 1.1 isaki 204 1.1 isaki return buf; 205 1.1 isaki } 206 1.1 isaki 207 1.1 isaki /* 208 1.1 isaki * return "inscsiN" / "exscsiN" if addr is in range of SCSI boot. 209 1.1 isaki * Otherwise return NULL. 210 1.1 isaki */ 211 1.1 isaki static const char * 212 1.1 isaki get_romaddr_name(uint32_t addr) 213 1.1 isaki { 214 1.1 isaki static char buf[8]; 215 1.1 isaki 216 1.1 isaki if (0xfc0000 <= addr && addr < 0xfc0020 && addr % 4 == 0) { 217 1.1 isaki snprintf(buf, sizeof(buf), "inscsi%d", (addr >> 2) & 7); 218 1.1 isaki } else if (0xea0020 <= addr && addr < 0xea0040 && addr % 4 == 0) { 219 1.1 isaki snprintf(buf, sizeof(buf), "exscsi%d", (addr >> 2) & 7); 220 1.1 isaki } else { 221 1.1 isaki return NULL; 222 1.1 isaki } 223 1.1 isaki return buf; 224 1.1 isaki } 225 1.1 isaki 226 1.1 isaki static void 227 1.1 isaki cmd_switch_boot(const char *arg) 228 1.1 isaki { 229 1.1 isaki int id; 230 1.1 isaki uint32_t romaddr; 231 1.1 isaki uint16_t bootdev; 232 1.1 isaki 233 1.1 isaki romaddr = 0xffffffff; 234 1.1 isaki 235 1.1 isaki if (strcmp(arg, "std") == 0) { 236 1.1 isaki bootdev = 0x0000; 237 1.1 isaki 238 1.1 isaki } else if (strcmp(arg, "rom") == 0) { 239 1.1 isaki bootdev = 0xa000; 240 1.1 isaki 241 1.1 isaki } else if (strncmp(arg, "inscsi", 6) == 0) { 242 1.1 isaki id = (arg[6] - '0') & 7; 243 1.1 isaki bootdev = 0xa000; 244 1.1 isaki romaddr = 0xfc0000 + id * 4; 245 1.1 isaki 246 1.1 isaki } else if (strncmp(arg, "exscsi", 6) == 0) { 247 1.1 isaki id = (arg[6] - '0') & 7; 248 1.1 isaki bootdev = 0xa000; 249 1.1 isaki romaddr = 0xea0020 + id * 4; 250 1.1 isaki 251 1.1 isaki } else if (strncmp(arg, "fd", 2) == 0) { 252 1.1 isaki id = (arg[2] - '0') & 3; 253 1.1 isaki bootdev = 0x9070 | (id << 8); 254 1.1 isaki 255 1.1 isaki } else { 256 1.1 isaki cmd_switch_help(); 257 1.1 isaki return; 258 1.1 isaki } 259 1.1 isaki 260 1.1 isaki sram_write_enable(); 261 1.1 isaki SRAM_BOOTDEV = bootdev; 262 1.1 isaki if (romaddr != 0xffffffff) 263 1.1 isaki SRAM_ROMADDR = romaddr; 264 1.1 isaki sram_write_disable(); 265 1.1 isaki 266 1.1 isaki cmd_switch_show_boot(); 267 1.1 isaki } 268 1.1 isaki 269 1.1 isaki static void 270 1.1 isaki cmd_switch_rom(const char *arg) 271 1.1 isaki { 272 1.1 isaki int id; 273 1.1 isaki uint32_t romaddr; 274 1.1 isaki 275 1.1 isaki if (strncmp(arg, "inscsi", 6) == 0) { 276 1.1 isaki id = (arg[6] - '0') & 7; 277 1.1 isaki romaddr = 0xfc0000 + id * 4; 278 1.1 isaki 279 1.1 isaki } else if (strncmp(arg, "exscsi", 6) == 0) { 280 1.1 isaki id = (arg[6] - '0') & 7; 281 1.1 isaki romaddr = 0xea0020 + id * 4; 282 1.1 isaki 283 1.1 isaki } else if (*arg == '$') { 284 1.1 isaki romaddr = hextoi(arg + 1); 285 1.1 isaki 286 1.1 isaki } else { 287 1.1 isaki cmd_switch_help(); 288 1.1 isaki return; 289 1.1 isaki } 290 1.1 isaki 291 1.1 isaki sram_write_enable(); 292 1.1 isaki SRAM_ROMADDR = romaddr; 293 1.1 isaki sram_write_disable(); 294 1.1 isaki 295 1.1 isaki cmd_switch_show_rom(); 296 1.1 isaki } 297 1.1 isaki 298 1.1 isaki static void 299 1.1 isaki cmd_switch_memory(const char *arg) 300 1.1 isaki { 301 1.1 isaki int num; 302 1.1 isaki 303 1.1 isaki num = atoi(arg); 304 1.1 isaki if (num < 1 || num > 12) { 305 1.1 isaki cmd_switch_help(); 306 1.1 isaki return; 307 1.1 isaki } 308 1.1 isaki 309 1.1 isaki sram_write_enable(); 310 1.1 isaki SRAM_MEMSIZE = num * (1024 * 1024); 311 1.1 isaki sram_write_disable(); 312 1.1 isaki 313 1.1 isaki cmd_switch_show_memory(); 314 1.1 isaki } 315