+ 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;
+ }
+ }
+}
+
+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;