 
 void setup() {
   // Motor Right
-  pinMode(9, OUTPUT);
-  pinMode(10, OUTPUT);
+  pinMode(leftMotorPin1, OUTPUT);
+  pinMode(leftMotorPin2, OUTPUT);
 
   // Motor Left
-  pinMode(11, OUTPUT);
-  pinMode(12, OUTPUT);
+  pinMode(rightMotorPin1, OUTPUT);
+  pinMode(rightMotorPin2, OUTPUT);
+  
+  // Ultrason
+  pinMode(ultraTrig, OUTPUT);
+  digitalWrite(ultraTrig, LOW);
+  pinMode(ultraEcho, INPUT);
 
   // Serial
   Serial.begin(9600);

  digitalWrite(rightMotorPin1, LOW);
  digitalWrite(rightMotorPin2, HIGH);
}

void stopRight() {
  digitalWrite(rightMotorPin1, LOW);


#define leftMotorPin1 9
#define leftMotorPin2 10

#define ultraTrig 14
#define ultraEcho 15

#define starterServoPin 18

