#define LBALL_SENSOR 22
#define RBALL_SENSOR 16
#define WHITE 1
#define BLACK 0
#define GREEN 3
#define R_SERVO 4
#define L_SERVO 0
#define R_DOWN 2800
#define L_DOWN 200
#define R_UP 600
#define L_UP 2000
#define FORWARD 63
#define BACKWARD 39
#define SEARCHING 4
#define DONE  5
#define GOING_RIGHT 6
#define GOING_LEFT 7
#define HARD_RIGHT 8
#define HARD_LEFT 9
#define GOING_STRAIGHT 10
#define AT_HOME 11
#define GOING_HOME 12
#define LMOTOR_1_FD  3
#define LMOTOR_2_FD  2
#define RMOTOR_2_FD  0
#define RMOTOR_1_FD  1
#define LMOTOR_1_BK  0
#define LMOTOR_2_BK  1
#define RMOTOR_2_BK  3
#define RMOTOR_1_BK  2
int CURRENT_STATE;
int LB_THRESHOLD;
int RB_THRESHOLD;
int MB_THRESHOLD;

int LFB_THRESHOLD;
int RFB_THRESHOLD;
int MFB_THRESHOLD;

int LBB_THRESHOLD;
int RBB_THRESHOLD;
int MBB_THRESHOLD;

int LFB_VALUE;
int RFB_VALUE;
int MFB_VALUE;

int LBB_VALUE;
int RBB_VALUE;
int MBB_VALUE;

int LFW_VALUE;
int RFW_VALUE;
int MFW_VALUE;

int LBW_VALUE;
int RBW_VALUE;
int MBW_VALUE;

int LGREEN_BALL_VALUE;
int RGREEN_BALL_VALUE;
int LW_BALL_VALUE;
int RW_BALL_VALUE;
int F_BUMPER = 12; 
int B_BUMPER = 11;
int LGREEN_THRESHOLD;
int RGREEN_THRESHOLD;
int LMOTOR_1 = 3;
int LMOTOR_2 =2;
int RMOTOR_2= 0;
int RMOTOR_1 =1;

int ORIENTATION = 63;
int OURBALL = 3;

int LFL_SENSOR = 18;
int RFL_SENSOR = 20;
int MFL_SENSOR = 19;
int LBL_SENSOR = 27;
int RBL_SENSOR = 25;
int MBL_SENSOR = 29;
int LL_SENSOR = LFL_SENSOR;
int ML_SENSOR = MFL_SENSOR;
int RL_SENSOR = RFL_SENSOR;