Add Check Right and Left Sensors, Init everythings

Initial commit for Check_Right_Sensor, Check_Left_Sensor and
Init_Microcontroller