 
       
 //------------------PINs---------------------
-#define TRIGGER_PIN1 A5
+#define TRIGGER_PIN1 A2
 #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 ECHO_PIN2 A3
 
 #define MAX_DISTANCE 200
 

int command_status = 1;
int motor_speed[2];
int ultrasonic1 = 0, ultrasonic2 = 0;

int irA_value = 0;
int irB_value = 0; 

int irA_counter = 0;
int irB_counter = 0;

int irA_block = 0;
int irB_block = 0;

//-------------------FUNCTIONs----------------
void stop_motor_ALL(){

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



