#include "test.h"

#include "../zes8p5066lib/basic.h"
#include "port.h"
void test_all_light(void) {
  static uint32_t lastprocess = 0;
  static uint8_t debug_led_state = 1;
  static int num;
  if (systicket_haspassedms(lastprocess) > 1000) {
    lastprocess = systicket_get_now_ms();
    debug_led_state = !debug_led_state;
    num++;
    port_debug_set(debug_led_state);
    port_led0_set(debug_led_state);
    port_led1_set(debug_led_state);
    port_led2_set(debug_led_state);
    port_led3_set(debug_led_state);

    if (num % 4 == 0) {
      port_led_r_set(true);
      port_led_g_set(false);
      port_led_b_set(false);
    }
    if (num % 4 == 1) {
      port_led_r_set(false);
      port_led_g_set(true);
      port_led_b_set(false);
    }
    if (num % 4 == 2) {
      port_led_r_set(false);
      port_led_g_set(false);
      port_led_b_set(true);
    }

    if (num % 4 == 3) {
      port_led_r_set(false);
      port_led_g_set(false);
      port_led_b_set(false);
    }
  }
}