Create color wave effect in controller test

Author: RedFantom

libmk/libmkc.c

@@ -218,10 +218,7 @@ LibMK_Instruction* libmk_create_instruction_all(
     LibMK_Instruction* i = libmk_create_instruction();
     i->colors = (unsigned char*) malloc(
         sizeof(unsigned char) * LIBMK_MAX_ROWS * LIBMK_MAX_COLS * 3);
-    for (unsigned char row=0; row<LIBMK_MAX_ROWS; row++)
-        for (unsigned char col=0; col<LIBMK_MAX_COLS; col++)
-            for (unsigned char j=0; j<3; j++)
-                i->colors[row * LIBMK_MAX_COLS + j] = c[row][col][j];
+    memcpy(i->colors, c, LIBMK_MAX_ROWS * LIBMK_MAX_COLS * 3);
     i->type = LIBMK_INSTR_ALL;
     return i;
 }
@@ -264,7 +261,7 @@ LibMK_Result libmk_sched_instruction(
         c->instr->id = 1;
     } else {
         LibMK_Instruction* t = c->instr;
-        while (true) {
+        while (t != NULL) {
             if (t->next == NULL) {
                 t->next = i;
                 t->next->id = t->id + 1;

utils/ctrl.c

@@ -2,6 +2,10 @@
  * Author: RedFantom
  * License: GNU GPLv3
  * Copyright (c) 2018 RedFantom
+ *
+ * The HSV to RGB conversion algorithm was copied from:
+ *    https://stackoverflow.com/questions/3018313
+ *    The answer by Leszek Szary
 */
 #include "../libmk/libmkc.h"
 #include <stdio.h>
@@ -10,6 +14,62 @@
 #include "libusb.h"
 
 
+typedef struct RgbColor {
+    unsigned char r;
+    unsigned char g;
+    unsigned char b;
+} RgbColor;
+
+typedef struct HsvColor {
+    unsigned char h;
+    unsigned char s;
+    unsigned char v;
+} HsvColor;
+
+
+RgbColor* HsvToRgb(HsvColor* hsv) {
+    RgbColor* rgb = malloc(sizeof(RgbColor));
+    unsigned char region, remainder, p, q, t;
+    
+    if (hsv->s == 0) {
+        rgb->r = hsv->v;
+        rgb->g = hsv->v;
+        rgb->b = hsv->v;
+        return rgb;
+    }
+    
+    region = hsv->h / 43;
+    remainder = (hsv->h - (region * 43)) * 6;
+    
+    p = (hsv->v * (255 - hsv->s)) >> 8;
+    q = (hsv->v * (255 - ((hsv->s * remainder) >> 8))) >> 8;
+    t = (hsv->v * (255 - ((hsv->s * (255 - remainder)) >> 8))) >> 8;
+    
+    switch (region) {
+        case 0:
+            rgb->r = hsv->v; rgb->g = t; rgb->b = p;
+            break;
+        case 1:
+            rgb->r = q; rgb->g = hsv->v; rgb->b = p;
+            break;
+        case 2:
+            rgb->r = p; rgb->g = hsv->v; rgb->b = t;
+            break;
+        case 3:
+            rgb->r = p; rgb->g = q; rgb->b = hsv->v;
+            break;
+        case 4:
+            rgb->r = t; rgb->g = p; rgb->b = hsv->v;
+            break;
+        default:
+            rgb->r = hsv->v; rgb->g = p; rgb->b = q;
+            break;
+    }
+    return rgb;
+}
+
+
+
 int main(void) {
     libmk_init();
     printf("Detecting devices...\n");
@@ -35,18 +95,54 @@ int main(void) {
         libmk_start_controller(ctrl);
         printf("Done.\n");
 
-        fprintf(stdout, "  Scheduling instruction... ");
+        fprintf(stdout, "  Scheduling instructions... ");
 
-        unsigned char color[3] = {255, 0, 0};
-        LibMK_Instruction* full = libmk_create_instruction_flash(color, 10000, 255);
+        unsigned char red[3] = {255, 0, 0};
+        LibMK_Instruction* full = libmk_create_instruction_flash(red, 10000, 255);
         unsigned int n = libmk_sched_instruction(ctrl, full);
 
+        unsigned char yellow[3] = {255, 255, 0};
+        full = libmk_create_instruction_full(yellow);
+        full->duration = 1000000;
+        libmk_sched_instruction(ctrl, full);
+        
+        unsigned char blank[3] = {0};
+        LibMK_Instruction* wave = libmk_create_instruction_full(blank);
+        LibMK_Instruction* a, * b;
+        a = wave;
+        HsvColor color;
+        color.s = 255;
+        color.v = 255;
+        
+        unsigned char map[LIBMK_MAX_ROWS][LIBMK_MAX_COLS][3];
+        for (int i=0; i<1000; i++) {
+            for (int r=0; r<LIBMK_MAX_ROWS; r++) {
+                for (int c=0; c<LIBMK_MAX_COLS; c++) {
+                    color.h = (i+c) * (255 / (LIBMK_MAX_COLS+40));
+                    RgbColor* rgb = HsvToRgb(&color);
+                    map[r][c][0] = rgb->r;
+                    map[r][c][1] = rgb->g;
+                    map[r][c][2] = rgb->b;
+                    free(rgb);
+                }
+            }
+            b = libmk_create_instruction_all(map);
+            b->duration = 10000;
+            a->next = b;
+            a = b;
+        }
+        libmk_sched_instruction(ctrl, wave);
+        
+        
         printf("Done: %d.\n", full->id);
 
         fprintf(stdout, "  Awaiting controller... ");
         libmk_wait_controller(ctrl);
         printf("Done.\n");
 
+        printf("\n  Now the controller will automatically exit after all instructions are done.\n");
+        printf("  You can let your program do other stuff while the instructions execute.\n\n");
+        
         LibMK_Controller_State s = libmk_join_controller(ctrl, 40);
         if (s != LIBMK_STATE_STOPPED)
             printf("  Could not stop the Controller: %d\n", s);