#include "cubelet.h"

uint8_t bv1;

uint8_t bv2;

void setup(){

}
void loop(){
  bv1 = get_block_value(INSERT_BLOCK_ID);
  bv2 = get_block_value(INSERT_BLOCK_ID);
  if (bv1 <= 225 || bv2 <= 225) {
    set_drive(0);
    toggle_directions();
    wait(500);
    set_drive(125);
    wait(1200);
    set_drive(0);
    wait(200);
    toggle_directions();
    set_drive(5);
    wait(500);
    set_drive(0);
    wait(300);

  } else {
    set_drive(135);

  }

}