2 * This software is released into the public domain.
3 * See UNLICENSE file in top level directory.
8 #define u8 unsigned char
9 #define u16 unsigned short
10 #define u32 unsigned int
12 #define GFX_DATA_PORT 0xC00000
13 #define GFX_CTRL_PORT 0xC00004
15 #define TILE_MEM_END 0xB000
18 #define TILE_FONT_BASE (TILE_MEM_END - FONT_LEN * 32)
20 /* note: using ED menu's layout here.. */
21 #define WPLANE (TILE_MEM_END + 0x0000)
22 #define HSCRL (TILE_MEM_END + 0x0800)
23 #define SLIST (TILE_MEM_END + 0x0C00)
24 #define APLANE (TILE_MEM_END + 0x1000)
25 #define BPLANE (TILE_MEM_END + 0x3000)
28 *((volatile u8 *) (a))
30 *((volatile u16 *) (a))
32 *((volatile u32 *) (a))
33 #define write16(a, d) \
34 *((volatile u16 *) (a)) = (d)
35 #define write32(a, d) \
36 *((volatile u32 *) (a)) = (d)
38 #define GFX_WRITE_VRAM_ADDR(adr) \
39 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x00)
40 #define GFX_WRITE_VSRAM_ADDR(adr) \
41 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x10)
42 #define GFX_WRITE_CRAM_ADDR(adr) \
43 (((0xC000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x00)
45 #define VDP_setReg(r, v) \
46 write16(GFX_CTRL_PORT, 0x8000 | ((r) << 8) | (v))
51 VDP_NT_SCROLLA = 0x02,
53 VDP_NT_SCROLLB = 0x04,
64 #define LEFT_BORDER 1 /* lame TV */
69 static void VDP_drawTextML(const char *str, u16 plane_base,
72 const u8 *src = (const u8 *)str;
74 int max_len = 40 - LEFT_BORDER;
80 for (len = 0; str[len] && len < max_len; len++)
82 if (len > (PLANE_W - x))
85 addr = plane_base + ((x + (PLANE_W * y)) << 1);
86 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
89 write16(GFX_DATA_PORT,
90 basetile | ((*src++) - 32 + TILE_FONT_BASE / 32));
94 static int printf_ypos;
96 static void printf_line(int x, const char *buf)
101 VDP_drawTextML(buf, APLANE, x, printf_ypos++ & (PLANE_H - 1));
103 if (printf_ypos >= CSCREEN_H) {
104 /* clear next line */
106 addr += (PLANE_W * (printf_ypos & (PLANE_H - 1))) << 1;
107 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
108 for (i = 0; i < 40 / 2; i++)
109 write32(GFX_DATA_PORT, 0);
112 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
113 write16(GFX_DATA_PORT, (printf_ypos - CSCREEN_H + 1) * 8);
117 #define PRINTF_LEN 40
119 static int printf(const char *fmt, ...)
121 static const char hexchars[] = "0123456789abcdef";
122 static int printf_xpos;
123 char c, buf[PRINTF_LEN + 11 + 1];
132 for (d = 0; *fmt; ) {
143 printf_line(printf_xpos, buf);
159 while ('1' <= *fmt && *fmt <= '9') {
160 fwidth = fwidth * 10 + *fmt - '0';
170 ival = va_arg(ap, int);
175 for (i = 1000000000; i >= 10; i /= 10)
178 for (; i >= 10; i /= 10) {
179 buf[d++] = '0' + ival / i;
182 buf[d++] = '0' + ival;
185 uval = va_arg(ap, int);
186 while (fwidth > 1 && uval < (1 << (fwidth - 1) * 4)) {
187 buf[d++] = prefix0 ? '0' : ' ';
190 for (j = 1; j < 8 && uval >= (1 << j * 4); j++)
192 for (j--; j >= 0; j--)
193 buf[d++] = hexchars[(uval >> j * 4) & 0x0f];
196 s = va_arg(ap, char *);
197 while (*s && d < PRINTF_LEN)
201 // don't handle, for now
212 VDP_drawTextML(buf, APLANE, printf_xpos,
213 printf_ypos & (PLANE_H - 1));
220 extern u32 font_base[];
221 extern u8 test_data[];
222 extern u8 test_data_end[];
233 write16(0xa11100, 0x100);
234 write16(0xa11200, 0);
237 while (read16(GFX_CTRL_PORT) & 2)
240 VDP_setReg(VDP_MODE1, 0x04);
241 VDP_setReg(VDP_MODE2, 0x64);
242 VDP_setReg(VDP_MODE3, 0x00);
243 VDP_setReg(VDP_MODE4, 0x81);
244 VDP_setReg(VDP_NT_SCROLLA, APLANE >> 10);
245 VDP_setReg(VDP_NT_SCROLLB, BPLANE >> 13);
246 VDP_setReg(VDP_SAT_BASE, SLIST >> 9);
247 VDP_setReg(VDP_HSCROLL, HSCRL >> 10);
248 VDP_setReg(VDP_AUTOINC, 2);
249 VDP_setReg(VDP_SCROLLSZ, 0x01);
250 VDP_setReg(VDP_BACKDROP, 0);
252 /* clear name tables */
253 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(APLANE));
254 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
255 write32(GFX_DATA_PORT, 0);
257 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(BPLANE));
258 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
259 write32(GFX_DATA_PORT, 0);
262 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(SLIST));
263 write32(GFX_DATA_PORT, 0);
265 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(HSCRL));
266 write32(GFX_DATA_PORT, 0);
268 /* scroll plane vscroll */
269 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
270 write32(GFX_DATA_PORT, 0);
274 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(TILE_FONT_BASE));
275 for (i = 0; i < FONT_LEN * 32 / 4; i++)
276 write32(GFX_DATA_PORT, font_base[i]);
279 write32(GFX_CTRL_PORT, GFX_WRITE_CRAM_ADDR(0));
280 write32(GFX_DATA_PORT, 0);
281 write32(GFX_CTRL_PORT, GFX_WRITE_CRAM_ADDR(15 * 2)); // font
282 write16(GFX_DATA_PORT, 0xeee);
285 printf("MD version: %02x\n", read8(0xa10001));
286 printf("ROM writable? ");
288 vptr = (void *)0x120;
291 printf(*vptr == old ? "no" : "yes");
295 len = test_data_end - test_data;
298 printf("executing stop.. ");
299 for (i = 0; i < 5 * 60; i++)
300 asm volatile("stop #0x2000" ::: "cc");
303 printf("checking memory..\n");
306 for (i = 0; i < len; i++) {
308 printf("bad: %06x: got %02x, expected %02x\n",
315 printf("done. Try %d: test ", t);
323 write32(GFX_CTRL_PORT, GFX_WRITE_CRAM_ADDR(0));
324 write16(GFX_DATA_PORT, 0x008);
326 /* there are not enough STOP opcodes in this world :D */
328 asm volatile("stop #0x2000" ::: "cc");
333 // vim:ts=4:sw=4:expandtab