 float max_right;
 float min_left;
 float max_left;
+float min_up;
+float max_up;
 
 const long interval = 200;     
 long previousMillis = 0;

        digitalWrite(motor_left_forward, LOW);
        digitalWrite(motor_left_backward, HIGH);
    }
    Serial.write(motor_right_pwm);
    Serial.write(motor_left_pwm);
    Serial.flush();   
  }
}

const int motor_left_backward = 12;
const int motor_left_enable = 11;

const int motor_up_forward = 5;//TODO set the adequate value
const int motor_up_backward = 6;//TODO set the adequate value
const int motor_up_enable = 10;//TODO set the adequate value


byte motor_right_pwm = 0;
byte motor_left_pwm = 0;
byte motor_up_pwm = 0;

float motor_right_speed = 0;
float motor_left_speed = 0;
float motor_up_speed = 0;

char incomingByte_X = 0;
char incomingByte_Y = 0;
char incomingByte_Z = 0;

const float X_factor = 1.0;
const float Y_factor = 1.0;
const float Z_factor = 1.0;

