#include <Arduino.h>
// #include "esp32-hal.h"
#include "motors.h"
#include "rgb.h"
#include "buzzer.h"

#include "oled.h"
#include "animations.h"


RGB rgb;
BUZZER buzzer;
MOTORS motors; 
OLED oled;



void setup() {
  motors.init();
  rgb.init();
  
  rgb.setColorRGB(0, 0, 0, true);

  oled.init();
  delay(2000);
}

void loop() {
  oled.showAnimation(animacja1[0], animacja1FrameCount, animacja1Width,
                     animacja1Height, 160);
  oled.showAnimation(animacja1[0], animacja1FrameCount, animacja1Width + 20,
                     animacja1Height, 50); // fajny efekt
  // oled.showAnimation(animacja2[0], animacja2FrameCount, animacja2Width,
  //                    animacja2Height, 160);
  // oled.showAnimation(animacja2[0], animacja2FrameCount, animacja2Width,
  //                    animacja2Height, 80);
  rgb.rainbowCycle(2000, 7);

  motors.rightForward(100,4000);
  motors.leftForward(100,4000);
}