Keyestudio 4WD Bluetooth Multi-functional Car - Page 88

keyestudio
www.keyestudio.com
86
digitalWrite(pinRB,LOW); //making motor move towards right rear
digitalWrite(pinRF,HIGH);
digitalWrite(pinLB,HIGH);
digitalWrite(pinLF,LOW); //making motor move towards left front
}
void left() //turning left(single wheel)
{
digitalWrite(pinRB,HIGH);
digitalWrite(pinRF,LOW ); //making motor move towards right front
digitalWrite(pinLB,LOW); //making motor move towards left rear
digitalWrite(pinLF,HIGH);
}
void back() //going backward
{
digitalWrite(pinRB,HIGH); //making motor move towards right rear
digitalWrite(pinRF,LOW);
digitalWrite(pinLB,HIGH); //making motor move towards left rear
digitalWrite(pinLF,LOW);
}
void detection() //measuring 3 angles(0.90.179)
{
int delay_time = 250; // time for servo motor turning backward
ask_pin_F(); // reading out the front distance
if(Fspeedd < 20) // assuming the front distance less than 10cm