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
14 #define GFX_DATA_PORT 0xC00000
15 #define GFX_CTRL_PORT 0xC00004
17 #define TILE_MEM_END 0xB000
20 #define TILE_FONT_BASE (TILE_MEM_END / 32 - FONT_LEN)
22 /* note: using ED menu's layout here.. */
23 #define WPLANE (TILE_MEM_END + 0x0000)
24 #define HSCRL (TILE_MEM_END + 0x0800)
25 #define SLIST (TILE_MEM_END + 0x0C00)
26 #define APLANE (TILE_MEM_END + 0x1000)
27 #define BPLANE (TILE_MEM_END + 0x3000)
30 *((volatile u8 *) (a))
32 *((volatile u16 *) (a))
34 *((volatile u32 *) (a))
35 #define write16(a, d) \
36 *((volatile u16 *) (a)) = (d)
37 #define write32(a, d) \
38 *((volatile u32 *) (a)) = (d)
40 #define GFX_WRITE_VRAM_ADDR(adr) \
41 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x00)
42 #define GFX_WRITE_VSRAM_ADDR(adr) \
43 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x10)
56 #define LEFT_BORDER 1 /* lame TV */
61 static void VDP_drawTextML(const char *str, u16 plane_base,
64 const u8 *src = (const u8 *)str;
66 int max_len = 40 - LEFT_BORDER;
72 for (len = 0; str[len] && len < max_len; len++)
74 if (len > (PLANE_W - x))
77 addr = plane_base + ((x + (PLANE_W * y)) << 1);
78 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
81 write16(GFX_DATA_PORT,
82 basetile | ((*src++) - 32 + TILE_FONT_BASE / 32));
86 static int printf_ypos;
88 static void printf_line(int x, const char *buf)
93 VDP_drawTextML(buf, APLANE, x, printf_ypos++ & (PLANE_H - 1));
95 if (printf_ypos >= CSCREEN_H) {
98 addr += (PLANE_W * (printf_ypos & (PLANE_H - 1))) << 1;
99 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
100 for (i = 0; i < 40 / 2; i++)
101 write32(GFX_DATA_PORT, 0);
104 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
105 write16(GFX_DATA_PORT, (printf_ypos - CSCREEN_H + 1) * 8);
109 #define PRINTF_LEN 40
111 static int printf(const char *fmt, ...)
113 static const char hexchars[] = "0123456789abcdef";
114 static int printf_xpos;
115 char c, buf[PRINTF_LEN + 11 + 1];
124 for (d = 0; *fmt; ) {
135 printf_line(printf_xpos, buf);
151 while ('1' <= *fmt && *fmt <= '9') {
152 fwidth = fwidth * 10 + *fmt - '0';
162 ival = va_arg(ap, int);
167 for (i = 1000000000; i >= 10; i /= 10)
170 for (; i >= 10; i /= 10) {
171 buf[d++] = '0' + ival / i;
174 buf[d++] = '0' + ival;
177 uval = va_arg(ap, int);
178 while (fwidth > 1 && uval < (1 << (fwidth - 1) * 4)) {
179 buf[d++] = prefix0 ? '0' : ' ';
182 for (j = 1; j < 8 && uval >= (1 << j * 4); j++)
184 for (j--; j >= 0; j--)
185 buf[d++] = hexchars[(uval >> j * 4) & 0x0f];
188 s = va_arg(ap, char *);
189 while (*s && d < PRINTF_LEN)
193 // don't handle, for now
204 VDP_drawTextML(buf, APLANE, printf_xpos,
205 printf_ypos & (PLANE_H - 1));
219 ed = (OsRoutine *) *(u32 *)0x1A0;
220 ed->memInitDmaCode();
222 ed->VDP_setReg(VDP_MODE1, 0x04);
223 ed->VDP_setReg(VDP_MODE2, 0x64);
224 ed->VDP_setReg(VDP_AUTOINC, 2);
225 ed->VDP_setReg(VDP_SCROLLSZ, 0x01);
227 /* clear name tables */
228 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(APLANE));
229 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
230 write32(GFX_DATA_PORT, 0);
232 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(BPLANE));
233 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
234 write32(GFX_DATA_PORT, 0);
237 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
238 write32(GFX_DATA_PORT, 0);
240 /* note: relying on ED menu's font setup here.. */
243 printf("MD version: %02x\n", read8(0xa10001));
244 printf("ED os/fw: %d/%d\n\n", ed->osGetOsVersion(),
245 ed->osGetFirmVersion());
247 seed = read8(0xC00009);
248 p = (void *)0x200000;
250 printf("filling SDRAM, seed=%02x.. ", seed);
253 for (i = 0; i < len; i++)
259 printf("executing stop.. ");
260 for (i = 0; i < 5 * 60; i++)
261 asm volatile("stop #0x2000");
264 printf("checking memory..\n");
267 for (i = 0; i < len; i++) {
269 printf("bad: %06x: got %02x, expected %02x\n",
276 printf("done. Try %d: test ", t);
284 /* there are not enough STOP opcodes in this world :D */
286 asm volatile("stop #0x2000");
291 // vim:ts=4:sw=4:expandtab