 #include <EnableInterrupt.h>
 #include <NewPing.h>
 #include <Servo.h>
+#include <Wire.h>
+#include <I2CEncoder.h>
 
 //--------------ORIENTATION------------------ 
 /*


      
//------------------PINs---------------------
#define TRIGGER_PIN1 A5
#define ECHO_PIN1 2

//DO NOT USE PIN 1, IT CAUSES CONSTANT ZEROS
//DO NOT USE PIN 2 as an ECHO, IT WILL ALSO CAUSE CONSTANT ZEROS 
#define TRIGGER_PIN2 4
#define ECHO_PIN2 A4

#define MAX_DISTANCE 200


NewPing sonar1(TRIGGER_PIN1, ECHO_PIN1, MAX_DISTANCE);
NewPing sonar2(TRIGGER_PIN2, ECHO_PIN2, MAX_DISTANCE);
Servo myservo;
I2CEncoder encoder_B;
I2CEncoder encoder_A;



