3 #define u8 unsigned char
4 #define u16 unsigned short
5 #define u32 unsigned int
7 #define noinline __attribute__((noinline))
11 #define GFX_DATA_PORT 0xC00000
12 #define GFX_CTRL_PORT 0xC00004
14 #define TILE_MEM_END 0xB000
17 #define TILE_FONT_BASE (TILE_MEM_END / 32 - FONT_LEN)
19 /* note: using ED menu's layout here.. */
20 #define WPLAN (TILE_MEM_END + 0x0000)
21 #define HSCRL (TILE_MEM_END + 0x0800)
22 #define SLIST (TILE_MEM_END + 0x0C00)
23 #define APLANE (TILE_MEM_END + 0x1000)
24 #define BPLANE (TILE_MEM_END + 0x3000)
26 #define write16(a, d) \
27 *((volatile u16 *) (a)) = (d)
28 #define write32(a, d) \
29 *((volatile u32 *) (a)) = (d)
31 #define GFX_WRITE_VRAM_ADDR(adr) \
32 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x00)
33 #define GFX_WRITE_VSRAM_ADDR(adr) \
34 (((0x4000 | ((adr) & 0x3FFF)) << 16) | ((adr) >> 14) | 0x10)
47 #define LEFT_BORDER 1 /* lame TV */
52 static noinline void VDP_drawTextML(const char *str, u16 plane_base,
55 const u8 *src = (const u8 *)str;
57 int max_len = 40 - LEFT_BORDER;
63 for (len = 0; str[len] && len < max_len; len++)
65 if (len > (PLANE_W - x))
68 addr = plane_base + ((x + (PLANE_W * y)) << 1);
69 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
72 write16(GFX_DATA_PORT,
73 basetile | ((*src++) - 32 + TILE_FONT_BASE));
77 static int printf_ypos;
79 static void printf_line(int x, const char *buf)
84 if (printf_ypos >= CSCREEN_H) {
87 VDP_drawTextML(buf, APLANE, x, printf_ypos++ & (PLANE_H - 1));
89 if (printf_ypos >= CSCREEN_H) {
92 addr += (PLANE_W * (printf_ypos & (PLANE_H - 1))) << 1;
93 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(addr));
94 for (i = 0; i < 40 / 2; i++)
95 write32(GFX_DATA_PORT, 0);
98 write32(GFX_CTRL_PORT, GFX_WRITE_VSRAM_ADDR(0));
99 write16(GFX_DATA_PORT, (printf_ypos - 27) * 8);
103 static noinline int printf(const char *fmt, ...)
105 static int printf_xpos;
113 for (d = 0; *fmt; ) {
116 if (buf[d] == '\n') {
119 printf_line(printf_xpos, buf);
134 ival = va_arg(ap, int);
139 for (i = 1000000000; i >= 10; i /= 10)
142 for (; i >= 10; i /= 10) {
143 buf[d++] = '0' + ival / i;
146 buf[d++] = '0' + ival;
149 // s = va_arg(ap, char *);
151 // don't handle, for now
163 VDP_drawTextML(buf, APLANE, printf_xpos,
164 printf_ypos & (PLANE_H - 1));
173 VDP_drawTextML("============", APLANE, 0, 0);
174 VDP_drawTextML(" exception! ", APLANE, 0, 1);
175 VDP_drawTextML("============", APLANE, 0, 2);
189 ed = (OsRoutine *) *(u32 *)0x1A0;
190 ed->memInitDmaCode();
192 ed->VDP_setReg(VDP_MODE1, 0x04);
193 ed->VDP_setReg(VDP_MODE2, 0x64);
194 ed->VDP_setReg(VDP_AUTOINC, 2);
195 ed->VDP_setReg(VDP_SCROLLSZ, 0x01);
197 /* clear name tables */
198 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(APLANE));
199 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
200 write32(GFX_DATA_PORT, 0);
202 write32(GFX_CTRL_PORT, GFX_WRITE_VRAM_ADDR(BPLANE));
203 for (i = 0; i < PLANE_W * PLANE_H / 2; i++)
204 write32(GFX_DATA_PORT, 0);
206 /* note: relying on ED menu's font setup here.. */
208 // VDP_drawTextML("hello", APLANE, 0, 0);
214 for (i = 0; i < 30; i++)
215 asm volatile("stop #0x2000");
217 printf("hello %d\n", j++);
223 // vim:ts=4:sw=4:expandtab