Keyestudio 4WD Bluetooth Multi-functional Car - Page 145

keyestudio
www.keyestudio.com
143
int Ldistance = pulseIn(inputPin, HIGH);
Ldistance= Ldistance/58; // Transform pulse time to distance
if(Mode==2){
lcd.setCursor(11, 1);
lcd.print("L= ");
lcd.setCursor(13, 1);
lcd.print(Ldistance,DEC);
Serial.print("\n L = ");
Serial.print(Ldistance,DEC);
return Ldistance;
}
else return Ldistance;
}
int ask_pin_R(unsigned char Mode)
{
int old_Rdistance;
digitalWrite(outputPin, LOW);
delayMicroseconds(2);
digitalWrite(outputPin, HIGH); //
delayMicroseconds(10);
digitalWrite(outputPin, LOW);
int Rdistance = pulseIn(inputPin, HIGH);
Rdistance= Rdistance/58; // Transform pulse time to distance
if(Mode==3){
lcd.setCursor(11, 1);
lcd.print("R= ");