                      |                                           |
                      |                                           |
          RIGHT       |                                           |    LEFT
-     SENSOR 1,ARD 2  |                                           |    SENSOR 1, ARD 1
+     SENSOR 2,ARD 2  |                                           |    SENSOR 2, ARD 1
           SERVO      |                                           |    SERVO
                      |                                           |
                      |    ARD 2                    RASPBERRY     |

                     |                                           |
                      -------------------------------------------
                                        FRONT
                                        Sensor 0 Ard 2




          switch(input){
            
            case 'w':
              if(command_status == 1){
                //move_forward();
                variable_forward();
