 int stop_button = 10;
 int command_status = 1;
 int motor_speed[2];
-
+int ultrasonic1 = 0, ultrasonic2 = 0;
 
 //-------------------FUNCTIONs----------------
 void stop_motor_ALL(){

          switch(input){
            
            case 'w':

              if(command_status == 1){
                //move_forward();
                variable_forward();

//------------------CODEs---------------------
void setup() {
        Serial.begin(9600);     // opens serial port, sets data rate to 9600 bps
        
        myservo.attach(5);
        
        enableInterrupt(stop_button, stop_motor_ALL , CHANGE);
