1 // vim:shiftwidth=2:expandtab
10 #include <sys/types.h>
13 #include <asm/ucontext.h>
17 #include <sys/resource.h>
20 #include "sys_cacheflush.h"
33 #define iolog_unh log_io
35 #define iolog_unh(...)
39 #define segvlog printf
44 #if defined(LOG_IO) || defined(LOG_IO_UNK)
45 #include "mmsp2-regs.h"
48 typedef unsigned int u32;
49 typedef unsigned short u16;
50 typedef unsigned char u8;
52 static pthread_mutex_t fb_mutex = PTHREAD_MUTEX_INITIALIZER;
53 static pthread_cond_t fb_cond = PTHREAD_COND_INITIALIZER;
55 struct uppermem_block {
59 struct uppermem_block *next;
62 static struct uppermem_block *upper_mem;
83 #define SRCCTRL_INVIDEO (1 << 8)
84 #define SRCCTRL_SRCENB (1 << 7)
85 #define CTRL_TRANSPARENCYENB (1 << 11)
98 u16 mlc_stl_pallt_d[256*2];
99 u32 mlc_stl_pallt_d32[256];
105 u32 btn_state; // as seen through /dev/GPIO
109 static u16 *host_screen;
110 static int host_stride;
113 #if defined(LOG_IO) || defined(LOG_IO_UNK)
114 static void log_io(const char *pfx, u32 a, u32 d, int size)
116 const char *fmt, *reg = "";
118 case 8: fmt = "%s %08x %02x %s\n"; d &= 0xff; break;
119 case 32: fmt = "%s %08x %08x %s\n"; break;
120 default: fmt = "%s %08x %04x %s\n"; d &= 0xffff; break;
123 if ((a & ~0xffff) == 0x7f000000)
124 reg = regnames[a & 0xffff];
126 printf(fmt, pfx, a, d, reg);
130 static void memset16(void *dst, u32 pattern, int count)
135 d = (u16 *)((long)dst & ~1);
141 pattern |= pattern << 16;
148 *(u16 *)dl = pattern;
151 static void blt_tr(void *dst, void *src, u32 trc, int w)
153 u16 *d = (u16 *)((long)dst & ~1);
154 u16 *s = (u16 *)((long)src & ~1);
157 for (; w > 0; d++, s++, w--)
162 #define dump_blitter() \
164 u32 *r = &blitter.dstctrl; \
166 for (i = 0; i < 4*4; i++, r++) { \
167 printf("%08x ", *r); \
173 static void *uppermem_lookup(u32 addr, u8 **mem_end)
175 struct uppermem_block *ub;
177 for (ub = upper_mem; ub != NULL; ub = ub->next) {
178 if (ub->addr <= addr && addr < ub->addr + ub->size) {
179 *mem_end = (u8 *)ub->mem + ub->size;
180 return (u8 *)ub->mem + addr - ub->addr;
187 static void blitter_do(void)
189 u8 *dst, *dste, *src = NULL, *srce = NULL;
190 int w, h, sstrd, dstrd;
194 w = blitter.size & 0x7ff;
195 h = (blitter.size >> 16) & 0x7ff;
196 sstrd = blitter.srcstride;
197 dstrd = blitter.dststride;
199 // XXX: need to confirm this..
200 addr = (blitter.dstaddr & ~3) | ((blitter.dstctrl & 0x1f) >> 3);
202 // use dst bpp.. How does it do blits with different src bpp?
203 bpp = (blitter.dstctrl & 0x20) ? 16 : 8;
206 if (((w == 320 && h == 240) || // blit whole screen
207 (w * h >= 320*240/2)) && // ..or at least half of the area
208 mmsp2.mlc_stl_adr <= addr && addr < mmsp2.mlc_stl_adr + 320*240*2)
211 dst = uppermem_lookup(addr, &dste);
213 // XXX: assume fill if no SRCENB, but it could be pattern blit..
214 if (blitter.srcctrl & SRCCTRL_SRCENB) {
215 if (!(blitter.srcctrl & SRCCTRL_INVIDEO))
218 addr = (blitter.srcaddr & ~3) | ((blitter.srcctrl & 0x1f) >> 3);
219 src = uppermem_lookup(addr, &srce);
223 if (src + sstrd * h > srce) {
224 err("blit %08x->%08x %dx%d did not fit src\n",
225 blitter.srcaddr, blitter.dstaddr, w, h);
226 h = (srce - src) / sstrd;
233 if (dst + dstrd * h > dste) {
234 err("blit %08x->%08x %dx%d did not fit dst\n",
235 blitter.srcaddr, blitter.dstaddr, w, h);
236 h = (dste - dst) / dstrd;
241 if (bpp == 16 && (blitter.ctrl & CTRL_TRANSPARENCYENB)) {
242 u32 trc = blitter.ctrl >> 16;
243 for (; h > 0; h--, dst += dstrd, src += sstrd)
244 blt_tr(dst, src, trc, w);
247 for (; h > 0; h--, dst += dstrd, src += sstrd)
248 memcpy(dst, src, w * bpp / 8);
252 // fill. Assume the pattern is cleared and bg color is used
253 u32 bgc = blitter.patbackcolor & 0xffff;
255 for (; h > 0; h--, dst += dstrd)
256 memset16(dst, bgc, w);
259 for (; h > 0; h--, dst += dstrd)
260 memset(dst, bgc, w); // bgc?
265 pthread_cond_signal(&fb_cond);
269 err("blit %08x->%08x %dx%d translated to %p->%p\n",
270 blitter.srcaddr, blitter.dstaddr, w, h, src, dst);
274 // TODO: hw scaler stuff
275 static void mlc_flip(u8 *src, int bpp)
277 u16 *dst = host_screen;
278 u16 *hpal = mmsp2.host_pal;
281 if (bpp <= 8 && mmsp2.dirty_pal) {
282 u32 *srcp = mmsp2.mlc_stl_pallt_d32;
285 for (i = 0; i < 256; i++, srcp++, dstp++) {
287 *dstp = ((t >> 8) & 0xf800) | ((t >> 5) & 0x07e0) | ((t >> 3) & 0x001f);
294 for (i = 0; i < 240; i++, dst += host_stride / 2 - 320) {
295 for (u = 320 / 2; u > 0; u--, src++) {
296 *dst++ = hpal[*src >> 4];
297 *dst++ = hpal[*src & 0x0f];
303 for (i = 0; i < 240; i++, dst += host_stride / 2 - 320) {
304 for (u = 320 / 4; u > 0; u--) {
305 *dst++ = hpal[*src++];
306 *dst++ = hpal[*src++];
307 *dst++ = hpal[*src++];
308 *dst++ = hpal[*src++];
314 for (i = 0; i < 240; i++, dst += host_stride / 2, src += 320*2)
315 memcpy(dst, src, 320*2);
323 host_screen = host_video_flip();
326 #define ts_add_nsec(ts, ns) { \
328 if (ts.tv_nsec >= 1000000000) { \
330 ts.tv_nsec -= 1000000000; \
334 static void *fb_sync_thread(void *arg)
336 int invalid_fb_addr = 1;
337 int manual_refresh = 0;
341 //ret = pthread_setschedprio(pthread_self(), -1);
342 //log("pthread_setschedprio %d\n", ret);
343 //ret = setpriority(PRIO_PROCESS, 0, -1);
344 //log("setpriority %d\n", ret);
346 ret = clock_gettime(CLOCK_REALTIME, &ts);
348 perror(PFX "clock_gettime");
353 u8 *gp2x_fb, *gp2x_fb_end;
356 ret = pthread_mutex_lock(&fb_mutex);
357 wait_ret = pthread_cond_timedwait(&fb_cond, &fb_mutex, &ts);
358 ret |= pthread_mutex_unlock(&fb_mutex);
361 err("fb_thread: mutex error: %d\n", ret);
365 if (wait_ret != 0 && wait_ret != ETIMEDOUT) {
366 err("fb_thread: cond error: %d\n", wait_ret);
371 if (wait_ret != ETIMEDOUT) {
372 clock_gettime(CLOCK_REALTIME, &ts);
373 ts_add_nsec(ts, 50000000);
375 if (manual_refresh == 2)
376 log("fb_thread: switch to manual refresh\n");
378 ts_add_nsec(ts, 16666667);
379 if (manual_refresh > 1)
380 log("fb_thread: switch to auto refresh\n");
384 mode = (mmsp2.mlc_stl_cntl >> 9) & 3;
385 bpp = mode ? mode * 8 : 4;
387 gp2x_fb = uppermem_lookup(mmsp2.mlc_stl_adr, &gp2x_fb_end);
388 if (gp2x_fb == NULL || gp2x_fb + 320*240 * bpp / 8 > gp2x_fb_end) {
389 if (!invalid_fb_addr) {
390 err("fb_thread: %08x is out of range\n", mmsp2.mlc_stl_adr);
396 mlc_flip(gp2x_fb, bpp);
400 static u32 xread8(u32 a)
402 iolog("r8 ", a, 0, 8);
403 iolog_unh("r8 ", a, 0, 8);
407 static u32 xread16(u32 a)
409 static u32 fudge, old_a;
412 if ((a & 0xffff0000) == 0x7f000000) {
420 // 0000 P000 VuVd00 0000 YXBA RLSeSt 0R0D 0L0U
421 // | GPIOD |GPIOC[8:15]|GPIOM[0:7]|
424 case 0x1184: // GPIOC
425 d = ~mmsp2.btn_state & 0xff00;
428 case 0x1186: // GPIOD
429 t = ~mmsp2.btn_state;
430 d = (t >> 9) & 0x0080;
431 d |= (t >> 11) & 0x0040;
432 d |= (t >> 7) & 0x0800;
435 case 0x1198: // GPIOM
436 mmsp2.btn_state = host_read_btns();
437 d = ~mmsp2.btn_state & 0xff;
440 case 0x1836: // reserved
443 case 0x2816: // DPC_X_MAX
446 case 0x2818: // DPC_Y_MAX
450 d = mmsp2.mlc_stl_cntl;
454 d = mmsp2.mlc_stl_adrl;
458 d = mmsp2.mlc_stl_adrh;
461 d = mmsp2.mlc_stl_pallt_a;
475 iolog_unh("r16", a, d & 0xffff, 16);
479 iolog("r16", a, d, 16);
483 static u32 xread32(u32 a)
486 if ((a & 0xfff00000) == 0x7f000000) {
489 case 0x0a00: // TCOUNT, 1/7372800s
494 if ((a & 0xfff00000) == 0x7f100000) {
495 u32 *bl = &blitter.dstctrl;
504 iolog_unh("r32", a, d, 32);
507 iolog("r32", a, d, 32);
511 static void xwrite8(u32 a, u32 d)
513 iolog("w8 ", a, d, 8);
514 iolog_unh("w8 ", a, d, 8);
517 static void xwrite16(u32 a, u32 d)
519 iolog("w16", a, d, 16);
520 if ((a & 0xfff00000) == 0x7f000000) {
524 mmsp2.mlc_stl_cntl = d | 0xaa;
528 // odd addresses don't affect LCD. What about TV?
531 mmsp2.mlc_stl_adrl = d;
534 mmsp2.mlc_stl_adrh = d;
535 if (mmsp2.mlc_stl_adr != mmsp2.old_mlc_stl_adr)
537 pthread_cond_signal(&fb_cond);
538 mmsp2.old_mlc_stl_adr = mmsp2.mlc_stl_adr;
541 mmsp2.mlc_stl_pallt_a = d & 0x1ff;
544 mmsp2.mlc_stl_pallt_d[mmsp2.mlc_stl_pallt_a++] = d;
545 mmsp2.mlc_stl_pallt_a &= 0x1ff;
550 iolog_unh("w16", a, d, 16);
553 static void xwrite32(u32 a, u32 d)
555 iolog("w32", a, d, 32);
557 if ((a & 0xfff00000) == 0x7f100000) {
558 u32 *bl = &blitter.dstctrl;
562 if (a_ == 0x34 && (d & 1))
567 iolog_unh("w32", a, d, 32);
570 #define LINKPAGE_SIZE 0x1000
571 #define LINKPAGE_COUNT 4
572 #define LINKPAGE_ALLOC (LINKPAGE_SIZE * LINKPAGE_COUNT)
584 void (*handler)(struct op_context *op_ctx);
588 static struct linkpage *g_linkpage;
589 static u32 *g_code_ptr;
590 static int g_linkpage_count;
592 static void *g_handler_stack_end;
594 #define BIT_SET(v, b) (v & (1 << (b)))
596 static void handle_op(struct op_context *op_ctx)
598 u32 *regs = g_linkpage->saved_regs;
600 u32 t, shift, ret, addr;
603 rd = (op & 0x0000f000) >> 12;
604 rn = (op & 0x000f0000) >> 16;
606 if ((op & 0x0f200090) == 0x01000090) { // AM3: LDRH, STRH
607 if (!BIT_SET(op, 5)) // !H
609 if (BIT_SET(op, 6) && !BIT_SET(op, 20)) // S && !L
612 if (BIT_SET(op, 22)) // imm offset
613 t = ((op & 0xf00) >> 4) | (op & 0x0f);
615 t = regs[op & 0x000f];
617 if (!BIT_SET(op, 23))
621 if (BIT_SET(op, 20)) { // Load
623 if (BIT_SET(op, 6)) { // S
625 ret = (signed int)ret >> 16;
630 xwrite16(addr, regs[rd]);
632 else if ((op & 0x0d200000) == 0x05000000) { // AM2: LDR[B], STR[B]
633 if (BIT_SET(op, 25)) { // reg offs
637 t = regs[op & 0x000f];
638 shift = (op & 0x0f80) >> 7;
639 switch ((op & 0x0060) >> 5) {
640 case 0: t = t << shift; break;
641 case 1: t = t >> (shift + 1); break;
642 case 2: t = (signed int)t >> (shift + 1); break;
643 case 3: goto unhandled; // I'm just lazy
649 if (!BIT_SET(op, 23))
653 if (BIT_SET(op, 20)) { // Load
654 if (BIT_SET(op, 22)) // Byte
661 if (BIT_SET(op, 22)) // Byte
662 xwrite8(addr, regs[rd]);
664 xwrite32(addr, regs[rd]);
671 if (addr != addr_check) {
672 fprintf(stderr, "bad calculated addr: %08x vs %08x\n", addr, addr_check);
679 err("unhandled IO op %08x @ %08x\n", op, op_ctx->pc);
682 static u32 make_offset12(u32 *pc, u32 *target)
686 lp_offs = (char *)target - (char *)pc - 2*4;
691 if (lp_offs >= LINKPAGE_SIZE) {
692 err("linkpage too far: %d\n", lp_offs);
696 return (u << 23) | lp_offs;
699 static u32 make_jmp(u32 *pc, u32 *target, int bl)
703 jmp_val = target - pc - 2;
704 if (jmp_val < (int)0xff000000 || jmp_val > 0x00ffffff) {
705 err("jump out of range (%p -> %p)\n", pc, target);
709 return 0xea000000 | (bl << 24) | (jmp_val & 0x00ffffff);
712 static void emit_op(u32 op)
717 static void emit_op_io(u32 op, u32 *target)
719 op |= make_offset12(g_code_ptr, target);
723 static void init_linkpage(void)
725 g_linkpage->handler = handle_op;
726 g_linkpage->handler_stack = g_handler_stack_end;
727 g_code_ptr = g_linkpage->code;
730 // r0 and r14 must be saved by caller, r0 is arg for handle_op
731 // on return everything is restored except lr, which is used to return
732 emit_op_io(0xe50f1000, &g_linkpage->saved_regs[1]); // str r1, [->saved_regs[1]] @ save r1
733 emit_op (0xe24f1000 + // sub r1, pc, =offs(saved_regs[2])
734 (g_code_ptr - &g_linkpage->saved_regs[2] + 2) * 4);
735 emit_op (0xe8813ffc); // stmia r1, {r2-r13}
736 emit_op_io(0xe51fd000, // ldr sp, [->handler_stack]
737 (u32 *)&g_linkpage->handler_stack);
738 emit_op (0xe2414008); // sub r4, r1, #4*2
739 emit_op (0xe10f1000); // mrs r1, cpsr
740 emit_op_io(0xe50f1000, &g_linkpage->cpsr); // str r1, [->cpsr]
741 emit_op (0xe1a0500e); // mov r5, lr
742 emit_op (0xe1a0e00f); // mov lr, pc
743 emit_op_io(0xe51ff000, (u32 *)&g_linkpage->handler); // ldr pc, =handle_op
744 emit_op_io(0xe51f1000, &g_linkpage->cpsr); // ldr r1, [->cpsr]
745 emit_op (0xe128f001); // msr cpsr_f, r1
746 emit_op (0xe1a0e005); // mov lr, r5
747 emit_op (0xe8943fff); // ldmia r4, {r0-r13}
748 emit_op (0xe12fff1e); // bx lr @ return
751 static void segv_sigaction(int num, siginfo_t *info, void *ctx)
753 struct ucontext *context = ctx;
754 u32 *regs = (u32 *)&context->uc_mcontext.arm_r0;
755 u32 *pc = (u32 *)regs[15];
756 struct op_context *op_ctx;
759 if (((regs[15] ^ (u32)&segv_sigaction) & 0xff000000) == 0 || // PC is in our segment or
760 (((regs[15] ^ (u32)g_linkpage) & ~(LINKPAGE_ALLOC - 1)) == 0) || // .. in linkpage
761 ((long)info->si_addr & 0xffe00000) != 0x7f000000) // faulting not where expected
763 // real crash - time to die
764 err("segv %d %p @ %08x\n", info->si_code, info->si_addr, regs[15]);
765 signal(num, SIG_DFL);
769 segvlog("segv %d %p @ %08x\n", info->si_code, info->si_addr, regs[15]);
772 op_ctx = (void *)g_code_ptr;
773 op_ctx->pc = (u32)pc;
775 g_code_ptr = &op_ctx->code[0];
777 // emit jump to code ptr
778 *pc = make_jmp(pc, g_code_ptr, 0);
781 // TODO: multithreading
782 emit_op_io(0xe50f0000, &g_linkpage->saved_regs[0]); // str r0, [->saved_regs[0]] @ save r0
783 emit_op_io(0xe50fe000, &g_linkpage->saved_regs[14]); // str r14, [->saved_regs[14]]
784 emit_op (0xe24f0000 + (g_code_ptr - (u32 *)op_ctx + 2) * 4); // sub r0, pc, #op_ctx
785 emit_op (make_jmp(g_code_ptr, &g_linkpage->code[0], 1)); // bl common_code
786 emit_op_io(0xe51fe000, &g_linkpage->saved_regs[14]); // ldr r14, [->saved_regs[14]]
787 emit_op (make_jmp(g_code_ptr, pc + 1, 0)); // jmp <back>
790 sys_cacheflush(pc, pc + 1);
791 sys_cacheflush(g_linkpage, g_code_ptr);
793 lp_size = (char *)g_code_ptr - (char *)g_linkpage;
794 segvlog("code #%d %d/%d\n", g_linkpage_count, lp_size, LINKPAGE_SIZE);
796 if (lp_size + 13*4 > LINKPAGE_SIZE) {
798 if (g_linkpage_count >= LINKPAGE_COUNT) {
799 err("too many linkpages needed\n");
802 g_linkpage = (void *)((char *)g_linkpage + LINKPAGE_SIZE);
805 //handle_op(regs[15], op, regs, (u32)info->si_addr);
809 void emu_init(void *map_bottom)
811 struct sigaction segv_action = {
812 .sa_sigaction = segv_sigaction,
813 .sa_flags = SA_SIGINFO,
819 g_handler_stack_end = (void *)((long)alloca(1536 * 1024) & ~0xffff);
820 log("handler stack @ %p (current %p)\n", g_handler_stack_end, &ret);
821 // touch it now. If we crash now we'll know why
822 *((char *)g_handler_stack_end - 4096) = 1;
824 g_linkpage = (void *)(((u32)map_bottom - LINKPAGE_ALLOC) & ~0xfff);
825 pret = mmap(g_linkpage, LINKPAGE_ALLOC, PROT_READ|PROT_WRITE, MAP_PRIVATE|MAP_ANONYMOUS, -1, 0);
826 if (pret != g_linkpage) {
827 perror(PFX "mmap linkpage");
830 log("linkpages @ %p\n", g_linkpage);
834 ret = host_video_init(&host_stride, 0);
836 err("can't alloc screen\n");
839 host_screen = host_video_flip();
841 ret = pthread_create(&tid, NULL, fb_sync_thread, NULL);
843 err("failed to create fb_sync_thread: %d\n", ret);
849 mmsp2.mlc_stl_adr = 0x03101000; // fb2 is at 0x03381000
851 sigemptyset(&segv_action.sa_mask);
852 sigaction(SIGSEGV, &segv_action, NULL);
855 int emu_read_gpiodev(void *buf, int count)
860 err("gpiodev read %d?\n", count);
864 btns = host_read_btns();
865 memcpy(buf, &btns, 4);
869 struct dev_fd_t emu_interesting_fds[] = {
870 [IFD_SOUND] = { "/dev/dsp", -1 },
874 static void *emu_mmap_dev(unsigned int length, int prot, int flags, unsigned int offset)
876 struct uppermem_block *umem;
881 if ((offset & ~0xffff) == 0xc0000000) {
882 return mmap((void *)0x7f000000, length, PROT_NONE,
883 MAP_PRIVATE|MAP_ANONYMOUS|MAP_FIXED|MAP_NORESERVE, -1, 0);
886 if ((offset & ~0xffff) == 0xe0020000) {
887 return mmap((void *)0x7f100000, length, PROT_NONE,
888 MAP_PRIVATE|MAP_ANONYMOUS|MAP_FIXED|MAP_NORESERVE, -1, 0);
891 if ((offset & 0xfe000000) != 0x02000000)
892 err("unexpected devmem mmap @ %08x\n", offset);
894 umem = calloc(1, sizeof(*umem));
902 umem->mem = mmap(NULL, length, prot, MAP_PRIVATE|MAP_ANONYMOUS, -1, 0);
903 if (umem->mem != MAP_FAILED)
906 log("upper mem @ %08x %d mmap fail, trying backing file\n", offset, length);
907 sprintf(name, "m%08x", offset);
908 fd = open(name, O_CREAT|O_RDWR, 0644);
909 lseek(fd, length - 1, SEEK_SET);
913 umem->mem = mmap(NULL, length, prot, MAP_SHARED, fd, 0);
914 if (umem->mem == MAP_FAILED) {
915 err("failed, giving up\n");
923 log("upper mem @ %08x %d\n", offset, length);
924 umem->next = upper_mem;
929 void *emu_do_mmap(unsigned int length, int prot, int flags, int fd, unsigned int offset)
931 if (fd == FAKEDEV_MEM)
932 return emu_mmap_dev(length, prot, flags, offset);
934 if (fd == FAKEDEV_FB0)
935 return emu_mmap_dev(length, prot, flags, offset + 0x03101000);
937 if (fd == FAKEDEV_FB1)
938 return emu_mmap_dev(length, prot, flags, offset + 0x03381000);
940 err("bad/ni mmap(?, %d, %x, %x, %d, %08x)", length, prot, flags, fd, offset);
945 #include <sys/ioctl.h>
946 #include <linux/soundcard.h>
948 static int emu_sound_ioctl(int fd, int request, void *argp)
953 dbg("snd ioctl(%d, %08x, %p)", fd, request, argp);
955 dbg_c(" [%d]", *arg);
959 /* People set strange frag settings on GP2X, which even manage
960 * to break audio on pandora (causes writes to fail).
961 * Catch this and set to something that works. */
962 if (request == SNDCTL_DSP_SPEED) {
963 int ret, bsize, frag;
965 // ~4ms. gpSP wants small buffers or else it stutters
966 // because of it's audio thread sync stuff
967 bsize = *arg / 250 * 4;
968 for (frag = 0; bsize; bsize >>= 1, frag++)
971 frag |= 16 << 16; // fragment count
972 ret = ioctl(fd, SNDCTL_DSP_SETFRAGMENT, &frag);
974 err("snd ioctl SETFRAGMENT %08x: ", frag);
978 else if (request == SNDCTL_DSP_SETFRAGMENT)
981 return ioctl(fd, request, argp);
984 #include <linux/fb.h>
986 int emu_do_ioctl(int fd, int request, void *argp)
988 if (fd == emu_interesting_fds[IFD_SOUND].fd)
989 return emu_sound_ioctl(fd, request, argp);
994 if (fd == FAKEDEV_FB0 || fd == FAKEDEV_FB1) {
996 case FBIOGET_FSCREENINFO: {
997 struct fb_fix_screeninfo *fix = argp;
999 memset(fix, 0, sizeof(*fix));
1000 strcpy(fix->id, "mmsp2_RGB0");
1001 fix->type = FB_TYPE_PACKED_PIXELS;
1002 fix->accel = FB_ACCEL_NONE;
1003 fix->smem_start = (fd == FAKEDEV_FB0) ? 0x03101000 : 0x03381000;
1004 fix->smem_len = 320*240*2;
1007 case FBIOGET_VSCREENINFO: {
1008 struct fb_var_screeninfo *var = argp;
1009 static const struct fb_bitfield fbb_red = { offset: 0, length: 4, };
1010 static const struct fb_bitfield fbb_green = { offset: 0, length: 4, };
1011 static const struct fb_bitfield fbb_blue = { offset: 0, length: 4, };
1013 memset(var, 0, sizeof(*var));
1014 var->activate = FB_ACTIVATE_NOW;
1016 var->xres_virtual = 320;
1018 var->yres_virtual = 240;
1021 var->vmode = FB_VMODE_NONINTERLACED;
1022 var->bits_per_pixel = 16;
1024 var->green = fbb_green;
1025 var->blue = fbb_blue;
1032 err("bad/ni ioctl(%d, %08x, %p)", fd, request, argp);