opensteno_qmk/quantum/audio/muse.c

#include "muse.h"

enum {
  MUSE_OFF,
  MUSE_ON,
  MUSE_C_1_2,
  MUSE_C1,
  MUSE_C2,
  MUSE_C4,
  MUSE_C8,
  MUSE_C3,
  MUSE_C6,
  MUSE_B1,
  MUSE_B2,
  MUSE_B3,
  MUSE_B4,
  MUSE_B5,
  MUSE_B6,
  MUSE_B7,
  MUSE_B8,
  MUSE_B9,
  MUSE_B10,
  MUSE_B11,
  MUSE_B12,
  MUSE_B13,
  MUSE_B14,
  MUSE_B15,
  MUSE_B16,
  MUSE_B17,
  MUSE_B18,
  MUSE_B19,
  MUSE_B20,
  MUSE_B21,
  MUSE_B22,
  MUSE_B23,
  MUSE_B24,
  MUSE_B25,
  MUSE_B26,
  MUSE_B27,
  MUSE_B28,
  MUSE_B29,
  MUSE_B30,
  MUSE_B31
};

bool number_of_ones_to_bool[16] = {
  1, 0, 0, 1, 0, 1, 1, 0,
  0, 1, 1, 0, 1, 0, 0, 1
};

uint8_t muse_interval[4] = {MUSE_B7,  MUSE_B19, MUSE_B3,  MUSE_B28};
uint8_t muse_theme[4]    = {MUSE_B8, MUSE_B23, MUSE_B18, MUSE_B17};

bool muse_timer_1bit = 0;
uint8_t muse_timer_2bit = 0;
uint8_t muse_timer_2bit_counter = 0;
uint8_t muse_timer_4bit = 0;
uint32_t muse_timer_31bit = 0;

bool bit_for_value(uint8_t value) {
  switch (value) {
    case MUSE_OFF:
      return 0;
    case MUSE_ON:
      return 1;
    case MUSE_C_1_2:
      return muse_timer_1bit;
    case MUSE_C1:
      return (muse_timer_4bit & 1);
    case MUSE_C2:
      return (muse_timer_4bit & 2);
    case MUSE_C4:
      return (muse_timer_4bit & 4);
    case MUSE_C8:
      return (muse_timer_4bit & 8);
    case MUSE_C3:
      return (muse_timer_2bit & 1);
    case MUSE_C6:
      return (muse_timer_2bit & 2);
    default:
      return muse_timer_31bit & (1UL << (value - MUSE_B1));
  }
}

uint8_t muse_clock_pulse(void) {

  bool top = number_of_ones_to_bool[
    bit_for_value(muse_theme[0]) +
    (bit_for_value(muse_theme[1]) << 1) +
    (bit_for_value(muse_theme[2]) << 2) +
    (bit_for_value(muse_theme[3]) << 3)
  ];

  if (muse_timer_1bit == 0) {
    if (muse_timer_2bit_counter == 0) {
      muse_timer_2bit = (muse_timer_2bit + 1) % 4;
    }
    muse_timer_2bit_counter = (muse_timer_2bit_counter + 1) % 3;
    muse_timer_4bit = (muse_timer_4bit + 1) % 16;
    muse_timer_31bit = (muse_timer_31bit << 1) + top;
  }

  muse_timer_1bit = (muse_timer_1bit + 1) % 2;

  return
    bit_for_value(muse_interval[0]) +
    (bit_for_value(muse_interval[1]) << 1) +
    (bit_for_value(muse_interval[2]) << 2) +
    (bit_for_value(muse_interval[3]) << 3);

}