mapping.cpp

#include <stdio.h>
#include "config.h"
#include "mapping.h"
#include "leds.h"
#ifndef __EMSCRIPTEN__
#include <terminal.h>
#endif

// Current mapping
static uint8_t currentMapping = 0;

// This is the servo mappings
uint8_t mapping[12];

void colorize()
{
    if (!leds_are_custom()) {
        for (int i=0; i<6; i++) {
            led_set(mapping[i], LED_R|LED_G|LED_B);
        }
        for (int i=6; i<12; i++) {
            led_set(mapping[i], 0);
        }
    }
}

void remap(int direction)
{
    currentMapping = direction;
    for (int i=0; i<12; i++) {
        mapping[i] = servos_order[(i+3*direction)%12];
    }
}


#ifndef __EMSCRIPTEN__
TERMINAL_COMMAND(remap,
        "Changes the mapping")
{
    if (argc == 0) {
        terminal_io()->print("remap=");
        terminal_io()->println(currentMapping);
    } else {
        currentMapping = atoi(argv[0]);
        remap(currentMapping);
    }
}
#endif