Keyestudio 4WD Bluetooth Multi-functional Car - Page 76

keyestudio
www.keyestudio.com
74
lcd.backlight();
lcd.clear();
}
void Sensor_IO_Config()
{
pinMode(SensorLeft,INPUT);
pinMode(SensorMiddle,INPUT);
pinMode(SensorRight,INPUT);
}
void Sensor_Scan(void)
{
SL = digitalRead(SensorLeft);
SM = digitalRead(SensorMiddle);
SR = digitalRead(SensorRight);
}
void M_Control_IO_config(void)//initialized function of IO of motor driver
{
pinMode(pinLB,OUTPUT); // pin 2--IN1 of motor driver board
pinMode(pinLF,OUTPUT); // pin 4--IN2 of motor driver board
pinMode(pinRB,OUTPUT); // pin 7--IN3 of motor driver board
pinMode(pinRF,OUTPUT); // pin 8--IN4 of motor driver board
pinMode(Lpwm_pin,OUTPUT); // pin 5 (PWM) --ENA of motor driver board
pinMode(Rpwm_pin,OUTPUT); // pin 10 (PWM) --ENB of motor driver board
}
void Set_Speed(unsigned char Left,unsigned char Right)//setting function of speed
{