4 #define u8 unsigned char
5 #define u16 unsigned short
6 #define u32 unsigned int
8 #define noinline __attribute__((noinline))
9 #define _packed __attribute__((packed))
11 #define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0]))
18 #define GFX_DATA_PORT 0xC00000
19 #define GFX_CTRL_PORT 0xC00004
21 #define TILE_MEM_END 0xB000
24 #define TILE_FONT_BASE (TILE_MEM_END / 32 - FONT_LEN)
26 /* note: using ED menu's layout here.. */
27 #define WPLANE (TILE_MEM_END + 0x0000)
28 #define HSCRL (TILE_MEM_END + 0x0800)
29 #define SLIST (TILE_MEM_END + 0x0C00)
30 #define APLANE (TILE_MEM_END + 0x1000)
31 #define BPLANE (TILE_MEM_END + 0x3000)
34 *((volatile u8 *) (a))
36 *((volatile u16 *) (a))
38 *((volatile u32 *) (a))
39 #define write8(a, d) \
40 *((volatile u8 *) (a)) = (d)
41 #define write16(a, d) \
42 *((volatile u16 *) (a)) = (d)
43 #define write32(a, d) \
44 *((volatile u32 *) (a)) = (d)
46 #define GFX_WRITE_VRAM_ADDR(adr) \
47 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x00)
48 #define GFX_WRITE_VSRAM_ADDR(adr) \
49 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x10)
62 #define LEFT_BORDER 1 /* lame TV */
67 static noinline void VDP_drawTextML(const char *str, u16 plane_base,
70 const u8 *src = (const u8 *)str;
72 int max_len = 40 - LEFT_BORDER;
78 for (len = 0; str[len] && len < max_len; len++)
80 if (len > (PLANE_W - x))
83 addr = plane_base + ((x + (PLANE_W * y)) << 1);
84 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
87 write16(GFX_DATA_PORT,
88 basetile | ((*src++) - 32 + TILE_FONT_BASE));
92 static int printf_ypos;
94 static void printf_line(int x, const char *buf)
99 VDP_drawTextML(buf, APLANE, x, printf_ypos++ & (PLANE_H - 1));
101 if (printf_ypos >= CSCREEN_H) {
102 /* clear next line */
104 addr += (PLANE_W * (printf_ypos & (PLANE_H - 1))) << 1;
105 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
106 for (i = 0; i < 40 / 2; i++)
107 write32(GFX_DATA_PORT, 0);
110 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
111 write16(GFX_DATA_PORT, (printf_ypos - CSCREEN_H + 1) * 8);
115 #define PRINTF_LEN 40
117 static noinline int printf(const char *fmt, ...)
119 static const char hexchars[] = "0123456789abcdef";
120 static int printf_xpos;
121 char c, buf[PRINTF_LEN + 11 + 1];
130 for (d = 0; *fmt; ) {
141 printf_line(printf_xpos, buf);
157 while ('1' <= *fmt && *fmt <= '9') {
158 fwidth = fwidth * 10 + *fmt - '0';
168 ival = va_arg(ap, int);
173 for (i = 1000000000; i >= 10; i /= 10)
176 for (; i >= 10; i /= 10) {
177 buf[d++] = '0' + ival / i;
180 buf[d++] = '0' + ival;
183 uval = va_arg(ap, int);
184 while (fwidth > 1 && uval < (1 << (fwidth - 1) * 4)) {
185 buf[d++] = prefix0 ? '0' : ' ';
188 for (j = 1; j < 8 && uval >= (1 << j * 4); j++)
190 for (j--; j >= 0; j--)
191 buf[d++] = hexchars[(uval >> j * 4) & 0x0f];
194 s = va_arg(ap, char *);
195 while (*s && d < PRINTF_LEN)
199 // don't handle, for now
210 VDP_drawTextML(buf, APLANE, printf_xpos,
211 printf_ypos & (PLANE_H - 1));
218 static const char *exc_names[] = {
223 "Illegal Instruction",
227 "Privilege Violation", /* 8 8 */
229 "Line 1010 Emulator",
230 "Line 1111 Emulator",
234 "Uninitialized Interrupt",
243 "Spurious Interrupt", /* 18 24 */
256 u16 ecxnum; // from handler
268 } bae _packed; // bus/address error frame
272 int xtttt(void) { return sizeof(struct exc_frame); }
274 void exception(const struct exc_frame *f)
278 while (read16(GFX_CTRL_PORT) & 2)
280 write16(GFX_CTRL_PORT, 0x8000 | (VDP_MODE1 << 8) | 0x04);
281 write16(GFX_CTRL_PORT, 0x8000 | (VDP_MODE2 << 8) | 0x44);
283 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
284 write16(GFX_DATA_PORT,
285 printf_ypos >= CSCREEN_H ?
286 (printf_ypos - CSCREEN_H + 1) * 8 : 0);
288 printf("exception %i ", f->ecxnum);
289 if (f->ecxnum < ARRAY_SIZE(exc_names) && exc_names[f->ecxnum] != NULL)
290 printf("(%s)", exc_names[f->ecxnum]);
292 printf(" (%s)", (f->bae.fc & 0x10) ? "r" : "w");
296 printf(" PC: %08x SR: %04x \n", f->bae.pc, f->bae.sr);
297 printf("addr: %08x IR: %04x FC: %02x \n",
298 f->bae.addr, f->bae.ir, f->bae.fc);
301 printf(" PC: %08x SR: %04x \n", f->g.pc, f->g.sr);
303 for (i = 0; i < 8; i++)
304 printf(" D%d: %08x A%d: %08x \n", i, f->dr[i], i, f->ar[i]);
312 static int usb_read_while_ready(OsRoutine *ed,
313 void *buf_, unsigned int maxlen)
318 while (ed->usbRdReady() && r < maxlen)
319 buf[r++] = ed->usbReadByte();
324 static int usb_read(OsRoutine *ed, void *buf_, unsigned int maxlen)
330 buf[r++] = ed->usbReadByte();
335 static int usb_write(OsRoutine *ed, const void *buf_, unsigned int maxlen)
337 const u8 *buf = buf_;
341 ed->usbWriteByte(buf[r++]);
347 * TH = 1 : ?1CBRLDU 3-button pad return value (not read)
348 * TH = 0 : ?0SA00DU 3-button pad return value
349 * TH = 1 : ?1CBRLDU 3-button pad return value
350 * TH = 0 : ?0SA0000 D3-0 are forced to '0'
351 * TH = 1 : ?1CBMXYZ Extra buttons returned in D3-0
352 * TH = 0 : ?0SA1111 D3-0 are forced to '1'
354 static void test_joy_latency(int *min_out, int *max_out)
361 for (i = 0; i < 64; i++) {
362 read_joy_responses(rbuf);
364 for (b = 0; b < 8 * 4; b++) {
366 e = (b & 0x08) ? 0x0c : 0;
367 if ((rbuf[b] & 0x0c) == e) {
376 /* print out the last test */
377 for (b = 0; b < 8 * 5; b++) {
378 printf(" %02x", rbuf[b]);
388 static int do_test(OsRoutine *ed, u8 b3)
390 int min = 0, max = 0;
397 printf("reading..\n");
398 test_joy_read_log((void *)0x200000, 0x20000, 1);
399 //test_joy_read_log((void *)0xff0200, 0x0f000, 1);
403 printf("reading w/vsync..\n");
404 test_joy_read_log_vsync((void *)0x200000, 3600 * 2);
409 printf("3btn_idle test..\n");
410 p = (void *)0x200000;
412 test_joy_read_log(p, len, b3 == '3');
413 for (i = 0; i < len; i++) {
414 static const u8 e[2] = { 0x33, 0x7f };
417 printf("%06x: bad: %02x %02x\n", &p[i], p[i], v);
422 printf("3btn_idle data test..\n");
423 p = (void *)0x200000;
425 for (i = 0; i < len; i++) {
426 static const u8 e[2] = { 0x33, 0x7f };
429 printf("%06x: bad: %02x %02x\n", &p[i], p[i], v);
434 seed = read8(0xC00009);
435 printf("testing, seed=%02x\n", seed);
436 p = (void *)0x200000;
438 test_byte_write(p, len, seed);
439 for (t = 0; t < 2; t++) {
440 for (i = 0; i < len; i++) {
443 printf("%06x: bad: %02x %02x\n", &p[i], p[i], v);
445 printf("done (%d)\n", t);
449 test_joy_latency(&min, &max);
450 printf("latency: %d - %d\n\n", min, max);
459 static int do_custom(OsRoutine *ed, u8 b3)
469 usb_read(ed, &d, sizeof(d));
470 ed->usbWriteByte('k');
471 printf("sending %i bytes from %06x..\n", d.size, d.addr);
472 usb_write(ed, (void *)d.addr, d.size);
490 static int do_run(OsRoutine *ed, u8 b3, int tas_sync)
497 mapper = MTYPE_SMS | (7 << 4);
518 printf("syncing and starting mapper %x..\n", mapper);
520 while (read16(GFX_CTRL_PORT) & 2)
522 ed->VDP_setReg(VDP_MODE1, 0x04);
523 ed->VDP_setReg(VDP_MODE2, 0x44);
525 ed->usbWriteByte('k');
527 run_game(mapper, tas_sync);
528 /* should not get here.. */
535 u8 *mem = (u8 *)0xa00000;
541 while (read8(0xa11100) & 1)
544 /* must use byte access */
545 for (i = 0x2000; i > 0; i--)
548 /* console starts with reset on, busreq off,
549 * gens starts with busreq on, keep that for gmv.. */
559 ed = (OsRoutine *) *(u32 *)0x1A0;
560 ed->memInitDmaCode();
563 while (read16(GFX_CTRL_PORT) & 2)
566 ed->VDP_setReg(VDP_MODE1, 0x04);
567 ed->VDP_setReg(VDP_MODE2, 0x64);
568 ed->VDP_setReg(VDP_AUTOINC, 2);
569 ed->VDP_setReg(VDP_SCROLLSZ, 0x01);
571 /* clear name tables */
572 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(APLANE));
573 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
574 write32(GFX_DATA_PORT, 0);
576 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(BPLANE));
577 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
578 write32(GFX_DATA_PORT, 0);
581 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
582 write32(GFX_DATA_PORT, 0);
584 /* note: relying on ED menu's font setup here.. */
587 printf("version: %02x, hvc: %04x %04x\n",
588 read8(0xa10001), start_hvc, read16(0xc00008));
589 printf("ED os/fw: %d/%d\n\n", ed->osGetOsVersion(),
590 ed->osGetFirmVersion());
595 if (!ed->usbRdReady()) {
596 /* note: stop corrupts SDRAM */
597 //asm volatile("stop #0x2000");
599 "move.l #1000/10, %0\n"
600 "0: dbra %0, 0b\n" : "=r" (i) :: "cc");
604 buf[0] = ed->usbReadByte();
612 /* note: OS uses Twofgsr */
613 buf[1] = ed->usbReadByte();
616 ed->usbWriteByte('k');
619 len = ed->usbReadByte() * 128;
620 printf("loading %d bytes.. ", len * 512);
621 ed->usbWriteByte('k');
622 ed->usbReadDma((void *)0x200000, len);
623 ed->usbWriteByte('d');
628 buf[2] = ed->usbReadByte();
629 ret = do_run(ed, buf[2], buf[1] == 'R');
634 printf("run returned??\n");
639 buf[2] = ed->usbReadByte();
640 ret = do_test(ed, buf[2]);
645 ed->usbWriteByte('k');
648 buf[2] = ed->usbReadByte();
649 ret = do_custom(ed, buf[2]);
656 ed->usbWriteByte('k');
666 ret = usb_read_while_ready(ed, buf + d, sizeof(buf) - d);
668 printf("bad cmd: %s\n", buf);
669 /* consume all remaining data */
670 while (ed->usbRdReady())
671 usb_read_while_ready(ed, buf, sizeof(buf));
673 ed->usbWriteByte('b');
679 // vim:ts=4:sw=4:expandtab