#include <Sparki.h>

void setup(){
    Serial1.begin(9600);
}

void loop(){
  Serial1.print("Distance = ");
  Serial1.print(sparki.ping());
  Serial1.println(" cm");

  delay(300);

  if (Serial1.available()){
    int inByte = Serial1.read();
    Serial1.print((char)inByte);

    switch((char)inByte){

      case '1': sparki.servo(SERVO_RIGHT); sparki.RGB(RGB_BLUE); break;
      case '2': sparki.servo(SERVO_CENTER); sparki.RGB(RGB_GREEN); break;
      case '3': sparki.servo(SERVO_LEFT); sparki.RGB(RGB_RED); break;
      default: break;
    }
  }

}