// Copyright 2020 Lukas Haubaum
//
// Licensed under MIT license
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

// set to true if you want to use NEOPIXEL (3 pins) instead of APA102 (4 pins)
#define NEOPIXEL true
// set to true for image test modus, this will change the segments every 1/2 second
#define TEST_STRIPES false

#include "images_2.h"

#if NEOPIXEL
#include <Adafruit_NeoPixel.h>
#else
#include <FastGPIO.h>
#define APA102_USE_FAST_GPIO
#include <APA102.h>
#endif

// CONFIGURE please configure next lines depending on your stripes arragmentment
#define HALL_PIN 5    // digital pin of hall sensor
#define ROUND_COUNT 1 // how many rounds to take time (minimum 1)

#define NUM_SEGMENTS 360 // how much segements to divide image (gives an angle precision of 360 / NUM_SEGMENTS)
#define LED_STRIPES 1    // how many LEDs stripes on wheel

#if ARDUINO_ARCH_ESP32
#define LED_BUILTIN 22
#define LED_BUILTIN_HIGH LOW
#define LED_BUILTIN_LOW HIGH
#else
#define LED_BUILTIN_HIGH HIGH
#define LED_BUILTIN_LOW LOW
#endif

int strip_matrix_offset[4] = {0, 0, NUM_SEGMENTS / 2, NUM_SEGMENTS / 2}; // given offset in segments for stripe
bool strip_matrix_invert[4] = {false, true, false, true};                // set LEDs in revert order for stripe
// \CONFIGURE

// LED stripes
#if NEOPIXEL
#define LED_PIN 32     // data pin for neopixel LED stripe
#define BRIGHTNESS 10 // brightness for LED strip [0-255]
Adafruit_NeoPixel ledStrip(LED_COUNT *LED_STRIPES, LED_PIN, NEO_GRB + NEO_KHZ800);
#else
#define LED_DATA_PIN 3  // data pin for LED strip
#define LED_CLOCK_PIN 2 // clock pin for LED strip
APA102<LED_DATA_PIN, LED_CLOCK_PIN> ledStrip;
#define BRIGHTNESS 10   // brightness for LED strip [0-31]
rgb_color color_buffer[LED_COUNT * LED_STRIPES];    // color buffer to write to LED stripe
#endif

float passed = 0;
int current_image_index = 3;

uint8_t *current_palette;
uint8_t *current_pixels;

int current_segment = 0;

void setup()
{
  Serial.begin(115200);                                                             // debug serial print
  pinMode(HALL_PIN, INPUT);                                                         // set hall pin as input
  pinMode(LED_BUILTIN, OUTPUT);                                                     // set build-in LED as output
  current_palette = (uint8_t *)pgm_read_ptr(&images[current_image_index].palette); // init palette for current image
  current_pixels = (uint8_t *)pgm_read_ptr(&images[current_image_index].pixels);   // init pixels for current image
#if NEOPIXEL
  ledStrip.begin();
  ledStrip.show();
  ledStrip.setBrightness(BRIGHTNESS);
#else
  for (int i = 0; i < LED_COUNT * LED_STRIPES; i++) // loop over all LEDs
  {
    color_buffer[i] = rgb_color(0, 0, 0); // set to black
  }
  ledStrip.write(color_buffer, LED_COUNT * LED_STRIPES, 0);          // write buffer to stripes
#endif
}

void loop()
{
  float start = micros();
  int count = 0;
  bool detected = false;
  while (count <= ROUND_COUNT) // keep in loop while not ROUND_COUNT reached
  {
    if (digitalRead(HALL_PIN) == LOW) // if hall sensor detect magnet
    {
      digitalWrite(LED_BUILTIN, LED_BUILTIN_HIGH); // use build-in LED as indicator for present magnet
      if (!detected)                   // check if magnet present first time
      {
        detected = true;
        count++; // count round
      }
    }
    else // if hall sensor not detect magnet
    {
      digitalWrite(LED_BUILTIN, LED_BUILTIN_LOW); // build-in LED indicator
      detected = false;               // reset magnet state
    }

    float current_diff = micros() - start; // get time passed in current loop

#if TEST_STRIPES                                      // testing stripes
    int segment = (micros() / 500000) % NUM_SEGMENTS; // calculate current segment as half seconds passed since runtime
    if (segment == current_segment)                   // do nothing if still in old segment
    {
      return;
    }
    Serial.println(current_segment); // debug print of current segment
    current_segment = segment;
#else
    current_segment = ((float)current_diff / ROUND_COUNT / passed  * NUM_SEGMENTS); // calculate current segment as percentage of time passed
#endif

    for (int strip = 0; strip < LED_STRIPES; strip++) // loop over all stripes
    {
      uint8_t pixel_color_index;
      // get pointer to current pixel of image as offset of current strip and offset of current segment
      uint8_t *current_pixel = (uint8_t *)&current_pixels[((current_segment + strip_matrix_offset[strip]) % NUM_SEGMENTS) * LED_COUNT];
      for (int i = 0; i < LED_COUNT; i++) // loop over all LEDs of current strip
      {
        pixel_color_index = pgm_read_byte(current_pixel++) * 3;                                           // read color palette index for current pixel
        uint8_t pixel_index = strip * LED_COUNT + (strip_matrix_invert[strip] ? (LED_COUNT - i - 1) : i); // calculate index of LED with offset and inversion
#if NEOPIXEL
        // set pixel of NEOPIXEL
        ledStrip.setPixelColor(pixel_index, pgm_read_byte(&current_palette[pixel_color_index]),
                               pgm_read_byte(&current_palette[pixel_color_index + 1]),
                               pgm_read_byte(&current_palette[pixel_color_index + 2]));
#else
        // set pixel of buffer
        color_buffer[pixel_index] = rgb_color(
            pgm_read_byte(&current_palette[pixel_color_index]),
            pgm_read_byte(&current_palette[pixel_color_index + 1]),
            pgm_read_byte(&current_palette[pixel_color_index + 2]));
#endif
      }
    }
#if NEOPIXEL
    ledStrip.show(); // update pixel
#else
    ledStrip.write(color_buffer, LED_COUNT * LED_STRIPES, BRIGHTNESS); // write buffer to stripes
#endif
  }

  passed = (micros() - start); // rounds done, caluclate duration
}