switch.c revision 1.2 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