X-Git-Url: http://git.squeep.com/?p=dcpu16;a=blobdiff_plain;f=hw_lem1802.c;h=f8004a38571670eb9e13443e80dc1a00d36f4743;hp=92e5149c64d5be7b42489b4f9a371222949b1b5f;hb=HEAD;hpb=e22bdfa072479f7ea72081808c0b1fa3602e726c diff --git a/hw_lem1802.c b/hw_lem1802.c index 92e5149..f8004a3 100644 --- a/hw_lem1802.c +++ b/hw_lem1802.c @@ -2,6 +2,7 @@ #include #include #include +#include #ifdef HAVE_LIBPNG #include @@ -17,28 +18,30 @@ #include "chargen-4x8.h" #include "hw_lem1802.h" -#undef DEBUG +/* lem1802 + * + * TODO: + * multiple vnc displays + */ + +#define MSG_(__level__, __vm__, ...) do { ((__vm__) ? ((struct dcpu16 *)(__vm__))->msg_cb_ : dcpu16_msg_)(__level__, __VA_ARGS__); } while (0) +#define MSG_INFO(__vm__, ...) MSG_(DCPU16_MSG_INFO, __vm__, __VA_ARGS__) +#define MSG_ERROR(__vm__, ...) MSG_(DCPU16_MSG_ERROR, __vm__, __VA_ARGS__) #ifdef DEBUG -#define TRACE(...) do { printf("[debug] "); printf(__VA_ARGS__); printf("\n"); } while (0) +#define MSG_DEBUG(__vm__, ...) MSG_(DCPU16_MSG_DEBUG, __vm__, __VA_ARGS__) #else /* DEBUG */ -#define TRACE(...) do {} while (0) +#define MSG_DEBUG(__vm__, ...) do { } while (0) #endif /* DEBUG */ -static dcpu16_hw_signal_t lem1802_reset_; -static dcpu16_hw_signal_t lem1802_cycle_; -static dcpu16_hw_signal_t lem1802_hwi_; -static struct dcpu16_hw hw_ = { - .name_ = "LEM1802 - Low Energy Monitor", - .id_l = 0xf615, - .id_h = 0x7349, - .ver = 0x1802, - .mfg_l = 0x8b36, - .mfg_h = 0x1c6c, - .hwi = lem1802_hwi_, - .cycle = lem1802_cycle_, - .reset = lem1802_reset_, - .data = (struct lem1802_ *)NULL -}; +#ifdef WANT_VARIADIC_VOIDP_CAST +#define VOIDP(__x__) ((void *)(__x__)) +#define VOIDFP(__x__) ((void *)(size_t)(__x__)) +#else +#define VOIDP(__x__) (__x__) +#define VOIDFP(__x__) (__x__) +#endif + +#define LEM1802_POWER_ON_CYCLES 100000 /* 'about one second' */ #define PIX_X 160 /* pixels in display */ #define PIX_Y 128 /* pixels in display */ @@ -65,18 +68,19 @@ static const DCPU16_WORD palette_default_[PALETTE_ENTRIES] = { 0x0f55, /* light red */ 0x0f5f, /* light magenta */ 0x0ff5, /* light yellow */ - 0x0fff, /* white */ + 0x0fff /* white */ }; struct pixel_ { unsigned char r; unsigned char g; unsigned char b; - unsigned char a; + unsigned char a; /* unused */ }; struct lem1802_ { - long long cycle_activated; /* for tracking 'turn on delay' */ + long long cycle_activated; /* running since */ + long long cycles_until_active_; /* for tracking power-up delay */ DCPU16_WORD video_base; DCPU16_WORD font_base; @@ -91,23 +95,55 @@ struct lem1802_ { unsigned int blink_tally_; /* tick */ unsigned int blink_state; + enum cycle_state_ { + CYCLE_IDLE, + CYCLE_COPY_TO_RAM, + } cycle_state_; + const DCPU16_WORD *cycle_state_copy_src_ptr_; + DCPU16_WORD cycle_state_copy_dst_addr_; + size_t cycle_state_copy_words_; + int (*render)(void *, struct pixel_ *, size_t, size_t); void *renderer_data; }; +static +long long power_on_cycles_(void) { + struct tv; + long long r = 0; + +#if WANT_DELAY_START + gettimeofday(&tv, NULL); + /* consider the 'about' in 'about one second' to be +/- 10% */ + r += LEM1802_POWER_ON_CYCLES - (LEM1802_POWER_ON_CYCLES / 10); + r += tv.tv_usec % (LEM1802_POWER_ON_CYCLES / 5); +#endif + + return r; +} + static inline void pixel_color_(struct pixel_ *pix, DCPU16_WORD color) { - pix->r = (color & 0x000f) | ((color & 0x000f) << 8); - pix->g = ((color & 0x00f0) >> 8) | (color & 0x00f0); - pix->b = ((color & 0x0f00) >> 8) | ((color & 0x0f00) >> 16); - pix->a = ((color & 0xf000) >> 16) | ((color & 0xf000) >> 24); + unsigned char x; + + x = (color >> 0) & 0x000f; + pix->r = x | (x << 4); + + x = (color >> 4) & 0x000f; + pix->g = x | (x << 4); + + x = (color >> 8) & 0x000f; + pix->b = x | (x << 4); + + x = (color >> 12) & 0x000f; + pix->a = x | (x << 4); } static void pixbuf_border_paint_(struct pixel_ *pixbuf, struct pixel_ *border) { size_t x, y, i; - TRACE("%s>> painted border", __func__); + MSG_DEBUG(NULL, "%s>> painting border", __func__); /* top */ for (y = 0; y < PIX_BORDER; y++) { @@ -133,10 +169,12 @@ void font_tile_paint_(struct pixel_ *p, struct pixel_ *fg, struct pixel_ *bg, DC size_t pix_x, pix_y; unsigned char *font_bitmap = (unsigned char *)tile; - TRACE("%s>> fg:(%u,%u,%u) bg:(%u,%u,%u) font_bitmap:%02x %02x %02x %02x", __func__, +#if 0 + MSG_DEBUG(NULL, "%s>> fg:(%u,%u,%u) bg:(%u,%u,%u) font_bitmap:%02x %02x %02x %02x", __func__, fg->r, fg->g, fg->b, bg->r, bg->g, bg->b, font_bitmap[0], font_bitmap[1], font_bitmap[2], font_bitmap[3]); +#endif for (pix_x = 0; pix_x < CELL_X_SZ; pix_x++) { for (pix_y = 0; pix_y < CELL_Y_SZ; pix_y++) { @@ -160,10 +198,12 @@ void pixbuf_addr_paint_(struct pixel_ *pixbuf, DCPU16_WORD *mem, DCPU16_WORD bas cell_x = (addr - base) % CELL_X; cell_y = (addr - base) / CELL_X; - TRACE("%s>> addr:0x%04x col:%u row:%u v:%hu", +#if 0 + MSG_DEBUG(NULL, "%s>> addr:0x%04x col:%u row:%u v:%hu", __func__, addr, cell_x, cell_y, mem[addr]); +#endif blink = mem[addr] & 0x0080; @@ -190,10 +230,18 @@ void lem1802_pixbuf_refresh_full_(struct lem1802_ *display, DCPU16_WORD *mem) { struct pixel_ border; size_t tile; - TRACE("%s>> video_base:0x%04x", __func__, display->video_base); +#if 0 + MSG_DEBUG(NULL, "%s>> video_base:0x%04x", __func__, display->video_base); +#endif + + if (display->cycles_until_active_) { + /* show cute power-up sequence.. */ + memset(display->pixbuf, 0, PIX_X * PIX_Y * sizeof *display->pixbuf); + return; + } if (display->video_base == 0) { - /* disconnected, blank display. static might be fun, too */ + /* disconnected, blank display */ memset(display->pixbuf, 0, PIX_X * PIX_Y * sizeof *display->pixbuf); return; } @@ -206,8 +254,8 @@ void lem1802_pixbuf_refresh_full_(struct lem1802_ *display, DCPU16_WORD *mem) { mem, display->video_base, display->video_base + tile, - display->palette_base ? mem + display->palette_base : palette_default_, - display->font_base ? mem + display->font_base : (unsigned short *)chargen_4x8_glyphs, + display->palette_base ? mem + display->palette_base : (DCPU16_WORD *)palette_default_, + display->font_base ? mem + display->font_base : (DCPU16_WORD *)chargen_4x8_glyphs, display->blink_state); } } @@ -232,14 +280,6 @@ int pixbuf_render_pnm_(void *data, struct pixel_ *pixbuf, size_t x, size_t y) { #ifdef HAVE_LIBPNG static -void pixbuf_render_png_user_warning_(png_structp png, png_const_charp msg) { - (void)png, (void)msg; -} -static -void pixbuf_render_png_user_error_(png_structp png, png_const_charp msg) { - (void)png, (void)msg; -} -static int pixbuf_render_png_(void *data, struct pixel_ *pixbuf, size_t x, size_t y) { FILE *f = (FILE *)data; int retval = 0; @@ -247,7 +287,7 @@ int pixbuf_render_png_(void *data, struct pixel_ *pixbuf, size_t x, size_t y) { png_infop info; size_t i; - png = png_create_write_struct(PNG_LIBPNG_VER_STRING, NULL, pixbuf_render_png_user_error_, pixbuf_render_png_user_warning_); + png = png_create_write_struct(PNG_LIBPNG_VER_STRING, NULL, NULL, NULL); if (png == NULL) { goto f_done; } @@ -282,60 +322,48 @@ f_done: #endif /* HAVE_LIBPNG */ #ifdef HAVE_LIBVNCSERVER -struct vnc_server_ { - rfbScreenInfoPtr rfbScreen; -}; - -/* create and return a new struct vnc_server_, for use as a vnc renderer's generic data */ -void *lem1802_vnc_init_data(int argc, char *argv[], struct dcpu16_hw *hw) { - struct vnc_server_ *s; - struct pixel_ *pixbuf = ((struct lem1802_ *)(hw->data))->pixbuf; +/* create and return a new screen, easiest to do here because we know the screen dimensions */ +static +rfbScreenInfoPtr lem1802_rfb_new_(int argc, char *argv[]) { + rfbScreenInfoPtr s; int paddedWidth = PIX_X + ( (PIX_X & 3) ? (4 - (PIX_X & 3)) : 0 ); int height = PIX_Y; int bitsPerSample = 8; int samplesPerPixel = 3; int bytesPerPixel = 4; - s = calloc(1, sizeof *s); + s = rfbGetScreen(&argc, argv, paddedWidth, height, bitsPerSample, samplesPerPixel, bytesPerPixel); if (s == NULL) return NULL; - s->rfbScreen = rfbGetScreen(&argc, argv, paddedWidth, height, bitsPerSample, samplesPerPixel, bytesPerPixel); - if (s->rfbScreen == NULL) { - free(s); - return NULL; - } - - s->rfbScreen->desktopName = "NYA ELEKTRISKA LEM1802"; - s->rfbScreen->alwaysShared = TRUE; + s->alwaysShared = TRUE; #if 0 - s->rfbScreen->kbdAddEvent = HandleKey; */ - s->rfbScreen->httpDir = "../classes"; + s->httpDir = "../classes"; #endif - s->rfbScreen->frameBuffer = (char *)pixbuf; - - rfbInitServer(s->rfbScreen); - - rfbRunEventLoop(s->rfbScreen,-1,TRUE); - - TRACE("%s>> initialized new vnc server", __func__); + MSG_DEBUG(NULL, "%s>> s:%p", __func__, VOIDP(s)); + MSG_DEBUG(NULL, "%s>> s->kbdAddEvent:%p s->frameBuffer:%p", __func__, VOIDFP(s->kbdAddEvent), s->frameBuffer); return s; } + +/* notify rfb server that pixels may have changed */ static int pixbuf_render_vnc_(void *data, struct pixel_ *pixbuf, size_t x, size_t y) { + rfbScreenInfoPtr s = (rfbScreenInfoPtr)data; int retval = 0; - struct vnc_server_ *s = (struct vnc_server_ *)data; (void)pixbuf; + MSG_DEBUG(NULL, "%s>> s:%p", __func__, s); + /* derp */ - rfbMarkRectAsModified(s->rfbScreen,0,0,x,y); + if (s) + rfbMarkRectAsModified(s, 0, 0, x, y); - TRACE("%s>>", __func__); + MSG_DEBUG(NULL, "%s>>", __func__); return retval; } @@ -343,8 +371,8 @@ int pixbuf_render_vnc_(void *data, struct pixel_ *pixbuf, size_t x, size_t y) { static -void lem1802_reset_(struct dcpu16 *vm, void *data) { - struct lem1802_ *display = (struct lem1802_ *)data; +void lem1802_reset_(struct dcpu16 *vm, struct dcpu16_hw *hw) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; (void)vm; @@ -360,21 +388,19 @@ void lem1802_reset_(struct dcpu16 *vm, void *data) { display->blink_tally_ = 0; display->blink_state = 0; -#if DEBUG - vm->trace_cb_("%s>>", __func__); -#endif /* DEBUG */ + display->cycle_state_ = 0; + + MSG_DEBUG(vm, "%s>>", __func__); } static -void lem1802_cycle_(struct dcpu16 *vm, void *data) { - struct lem1802_ *display = (struct lem1802_ *)data; +void lem1802_cycle_(struct dcpu16 *vm, struct dcpu16_hw *hw) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; (void)vm; /* - maybe just step through video memory (if set) - one word per clock..? could just cheat and - use accounting callbacks.. - + for more cycle-accuracy, could step through video memory, if set, + one word per clock.. for now just count cycles and issue a full refresh/render every so often */ @@ -383,68 +409,97 @@ void lem1802_cycle_(struct dcpu16 *vm, void *data) { if (display->blink_tally_ >= display->blink_rate) { display->blink_tally_ = 0; display->blink_state ^= 1; - TRACE("%s>> blink:%u (%u cycles)", __func__, display->blink_state, display->blink_rate); + MSG_DEBUG(vm, "%s>> blink:%u (%u cycles)", __func__, display->blink_state, display->blink_rate); } display->refresh_tally_++; if (display->refresh_tally_ >= display->refresh_rate) { display->refresh_tally_ = 0; if (display->render) - TRACE("%s>> refresh", __func__); + MSG_DEBUG(vm, "%s>> refresh", __func__); lem1802_pixbuf_refresh_full_(display, vm->ram); display->render(display->renderer_data, display->pixbuf, PIX_X, PIX_Y); } + + switch (display->cycle_state_) { + case CYCLE_IDLE: + break; + + case CYCLE_COPY_TO_RAM: + MSG_DEBUG(vm, "%s>> copy_to_ram words:%zu src:%p dst_addr:0x%04x", + __func__, + display->cycle_state_copy_words_, + VOIDP(display->cycle_state_copy_src_ptr_), + display->cycle_state_copy_dst_addr_); + vm->ram[display->cycle_state_copy_dst_addr_] = *display->cycle_state_copy_src_ptr_; + display->cycle_state_copy_dst_addr_++; + display->cycle_state_copy_src_ptr_++; + display->cycle_state_copy_words_--; + if (display->cycle_state_copy_words_ == 0) { + display->cycle_state_ = CYCLE_IDLE; + } + break; + } + + if (display->cycles_until_active_) { + display->cycles_until_active_--; + if (display->cycles_until_active_ == 0) { + MSG_DEBUG(vm, "%s>> display now active", __func__); + } + } } static -void lem1802_hwi_(struct dcpu16 *vm, void *data) { - struct lem1802_ *display = (struct lem1802_ *)data; +void lem1802_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; DCPU16_WORD reg_a = vm->reg[DCPU16_REG_A]; DCPU16_WORD reg_b = vm->reg[DCPU16_REG_B]; - size_t i; - TRACE("%s>> A:0x%04x B:0x%04x", __func__, reg_a, reg_b); + MSG_DEBUG(vm, "%s>> A:0x%04x B:0x%04x", __func__, reg_a, reg_b); switch (reg_a) { case 0: /* MEM_MAP_SCREEN */ if (display->cycle_activated == 0 && reg_b) { - display->cycle_activated = vm->cycle; + display->cycle_activated = vm->cycle_; + display->cycles_until_active_ = power_on_cycles_(); } display->video_base = reg_b; if (reg_b == 0) display->cycle_activated = 0; + MSG_DEBUG(vm, "%s>> video_base:0x%04x", __func__, reg_b); break; case 1: /* MEM_MAP_FONT */ display->font_base = reg_b; + MSG_DEBUG(vm, "%s>> font_base:0x%04x", __func__, reg_b); break; case 2: /* MEM_MAP_PALETTE */ display->palette_base = reg_b; + MSG_DEBUG(vm, "%s>> palette_base:0x%04x", __func__, reg_b); break; case 3: /* SET_BORDER_COLOR */ display->border_color = reg_b & 0x000f; + MSG_DEBUG(vm, "%s>> border_color_index:0x%01x", __func__, reg_b & 0x000f); break; case 4: /* MEM_DUMP_FONT */ - for (i = 0; i < 128 ; i++) { - vm->ram[reg_b] = chargen_4x8_glyphs[reg_b][0] << 8; - vm->ram[reg_b] |= chargen_4x8_glyphs[reg_b][1]; - reg_b += 1; - vm->ram[reg_b] = chargen_4x8_glyphs[reg_b][2] << 8; - vm->ram[reg_b] |= chargen_4x8_glyphs[reg_b][3]; - reg_b += 1; - } - vm->cycle += 256; + display->cycle_state_copy_src_ptr_ = (DCPU16_WORD *)chargen_4x8_glyphs; + display->cycle_state_copy_dst_addr_ = reg_b; + display->cycle_state_copy_words_ = 256; + display->cycle_state_ = CYCLE_COPY_TO_RAM; + MSG_DEBUG(vm, "%s>> copying default font into 0x%04x - 0x%04x", __func__, reg_b, reg_b + 256); + dcpu16_cycle_inc(vm, 256); break; case 5: /* MEM_DUMP_PALETTE */ - for (i = 0; i < 16; i++) { - vm->ram[reg_b] = palette_default_[i]; - reg_b += 1; - } - vm->cycle += 16; + display->cycle_state_copy_src_ptr_ = palette_default_; + display->cycle_state_copy_dst_addr_ = reg_b; + display->cycle_state_copy_words_ = 16; + display->cycle_state_ = CYCLE_COPY_TO_RAM; + MSG_DEBUG(vm, "%s>> copying default palette into 0x%04x - 0x%04x", __func__, reg_b, reg_b + 16); + dcpu16_cycle_inc(vm, 16); break; } } @@ -465,22 +520,8 @@ static struct renderer_ { { NULL, NULL, NULL } }; -int lem1802_renderer_set(struct dcpu16_hw *hw, const char *renderer, void *data) { - struct renderer_ *r; - - for (r = lem1802_renderers_; r->renderer; r++) { - if (strcmp(renderer, r->name) == 0) { - ((struct lem1802_ *)(hw->data))->render = r->renderer; - ((struct lem1802_ *)(hw->data))->renderer_data = data; - TRACE("%s>> renderer set to %s", __func__, renderer); - return 0; - } - } - - return -1; -} - -char *lem1802_renderers_iter(void **iterp, char **name, char **args) { +static +char *lem1802_renderers_iter_(void **iterp, char **name, char **args) { struct renderer_ **r = (struct renderer_ **)iterp; if (*r == NULL) @@ -499,52 +540,193 @@ char *lem1802_renderers_iter(void **iterp, char **name, char **args) { return (*r)->name; } -/* instantitate a new display */ -struct dcpu16_hw *lem1802_new(struct dcpu16 *vm) { - struct dcpu16_hw *hw; - - hw = calloc(1, sizeof *hw); - if (hw == NULL) { - vm->warn_cb_("%s():%s", "calloc", strerror(errno)); - return NULL; - } - - memcpy(hw, &hw_, sizeof *hw); +static +int lem1802_data_init_(struct dcpu16_hw *hw, void *data) { + (void)data; - hw->data = calloc(1, sizeof(struct dcpu16_hw)); + hw->data = calloc(1, sizeof(struct lem1802_)); if (hw->data == NULL) { - vm->warn_cb_("%s():%s", "calloc", strerror(errno)); - free(hw); - return NULL; + MSG_ERROR(hw->vm, "%s():%s", "calloc", strerror(errno)); + return -1; } - ((struct lem1802_ *)(hw->data))->pixbuf = calloc(1, PIX_X * PIX_Y * sizeof *((struct lem1802_ *)(hw->data))->pixbuf); + ((struct lem1802_ *)(hw->data))->pixbuf = calloc(PIX_X * PIX_Y, sizeof *((struct lem1802_ *)(hw->data))->pixbuf); if (((struct lem1802_ *)(hw->data))->pixbuf == NULL) { - vm->warn_cb_("%s():%s", "calloc", strerror(errno)); + MSG_ERROR(hw->vm, "%s():%s", "calloc", strerror(errno)); free(hw->data); - free(hw); - return NULL; + hw->data = NULL; + return -1; } ((struct lem1802_ *)(hw->data))->refresh_rate = 1666; - ((struct lem1802_ *)(hw->data))->blink_rate = 100000; + ((struct lem1802_ *)(hw->data))->blink_rate = 75000; - return hw; + return 0; } -void lem1802_del(struct dcpu16_hw **hw) { +static +void lem1802_data_free_(struct dcpu16_hw *hw) { if (hw) { - if (*hw) { - if ((*hw)->data) { - if (((struct lem1802_ *)(*hw)->data)->pixbuf) { - free(((struct lem1802_ *)(*hw)->data)->pixbuf); - ((struct lem1802_ *)(*hw)->data)->pixbuf = NULL; - } - free((*hw)->data); - (*hw)->data = NULL; + if (hw->data) { + if (((struct lem1802_ *)(hw->data))->pixbuf) { + free(((struct lem1802_ *)(hw->data))->pixbuf); + ((struct lem1802_ *)(hw->data))->pixbuf = NULL; } - free(*hw); + free(hw->data); + hw->data = NULL; } - *hw = NULL; } } + +static struct dcpu16_hw_ctl_cmd ctl_[] = { + { "blink_rate", "const unsigned int *", "unsigned int *", "sets or gets cycles per blink toggle" }, + { "refresh_rate", "const unsigned int *", "unsigned int *", "sets or gets cycles per screen refresh" }, +#ifdef HAVE_LIBVNCSERVER + { "new_rfbScreen", "struct { int argc; char **argv;} *", "rfbScreenInfoPtr *", "allocates a new rfb screen" }, + { "associate_rfbScreen", "rfbScreenInfoPtr", "NULL", "associates this lem1802 instance with an rfb display" }, +#endif /* HAVE_LIBVNCSERVER */ + { "renderers_iter", "void **", "struct {char *name; char *args;} *", "returns the next renderer this module is capable of using" }, + { "renderer", "const char *", "NULL", "sets this lem1802 instance to use renderer" }, + { "renderer_data", "void *", "NULL", "sets renderer-specific data" }, + { NULL, NULL, NULL, NULL } +}; + +static +int lem1802_data_ctl_(struct dcpu16_hw *hw, const char *cmd, void *data_in, void *data_out) { + if (strcmp(cmd, "blink_rate") == 0) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; + const unsigned int *rate_in = (const unsigned int *)data_in; + unsigned int *rate_out = (unsigned int *)data_out; + + if (rate_out) { + *rate_out = display->blink_rate; + } + + if (rate_in) { + display->blink_rate = *rate_in; + } + + MSG_DEBUG(hw->vm, "%s>> %s now:%u was:%u", __func__, "blink_rate", *rate_in, *rate_out); + + return 0; + } + + if (strcmp(cmd, "refresh_rate") == 0) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; + const unsigned int *rate_in = (const unsigned int *)data_in; + unsigned int *rate_out = (unsigned int *)data_out; + + if (rate_out) { + *rate_out = display->refresh_rate; + } + + if (rate_in) { + display->refresh_rate = *rate_in; + } + + MSG_DEBUG(hw->vm, "%s>> %s now:%u was:%u", __func__, "refresh_rate", *rate_in, *rate_out); + + return 0; + } + +#ifdef HAVE_LIBVNCSERVER + if (strcmp(cmd, "new_rfbScreen") == 0) { + struct args_ { int argc; char **argv;} *in = (struct args_ *)data_in; + rfbScreenInfoPtr *s_out = (rfbScreenInfoPtr *)data_out; + + if (in == NULL || s_out == NULL) + return -EFAULT; + + *s_out = lem1802_rfb_new_(in->argc, in->argv); + + MSG_DEBUG(NULL, "%s>> %s s:%p", __func__, "new_rfbScreen", *s_out); + + return 0; + } + + if (strcmp(cmd, "associate_rfbScreen") == 0) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; + rfbScreenInfoPtr rfbScreen = (rfbScreenInfoPtr)data_in; + (void)data_out; + + if (rfbScreen == NULL) + return -EFAULT; + + rfbScreen->desktopName = "NYA ELEKTRISKA LEM1802"; + rfbScreen->frameBuffer = (char *)display->pixbuf; + + MSG_DEBUG(hw->vm, "%s>> %s rfbScreen:%p", __func__, "associate_rfbScreen", rfbScreen); + + return 0; + } +#endif /* HAVE_LIBVNCSERVER */ + + if (strcmp(cmd, "renderers_iter") == 0) { + void **iterp = (void **)data_in; + struct packed_out_ { + char *name; + char *args; + } *parg = (struct packed_out_ *)data_out; + + if (iterp == NULL || parg == NULL) + return -EFAULT; + + (void)lem1802_renderers_iter_(iterp, &parg->name, &parg->args); + + MSG_DEBUG(hw->vm, "%s>> %s", __func__, "renderers_iter"); + + return 0; + } + + if (strcmp(cmd, "renderer") == 0) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; + char *renderer = (char *)data_in; + (void)data_out; + struct renderer_ *r; + + for (r = lem1802_renderers_; r->renderer; r++) { + if (strcmp(renderer, r->name) == 0) { + display->render = r->renderer; + MSG_DEBUG(hw->vm, "%s>> renderer set to %s", __func__, renderer); + return 0; + } + } + + MSG_ERROR(hw->vm, "unknown renderer '%s'", renderer); + + return -ENOENT; + } + + if (strcmp(cmd, "renderer_data") == 0) { + struct lem1802_ *display = (struct lem1802_ *)hw->data; + (void)data_out; + + display->renderer_data = data_in; + + MSG_DEBUG(hw->vm, "%s>> %s data:%p", __func__, "renderer_data", data_in); + + return 0; + } + + return -EINVAL; +} + + +struct dcpu16_hw_module dcpu16_hw_module_lem1802 = { + .name_ = "LEM1802 - Low Energy Monitor", + + .id_l = 0xf615, + .id_h = 0x7349, + .ver = 0x1802, + .mfg_l = 0x8b36, + .mfg_h = 0x1c6c, + .hwi = lem1802_hwi_, + .cycle = lem1802_cycle_, + .reset = lem1802_reset_, + + .data_init = lem1802_data_init_, + .data_free = lem1802_data_free_, + .ctl = lem1802_data_ctl_, + .ctl_cmd = ctl_, +}; +