Keyestudio 4WD Bluetooth Multi-functional Car - Page 112

keyestudio
www.keyestudio.com
110
void Show_DuoJiao(unsigned char Jiao)
{
lcd.setCursor(6,1);
lcd.print("C= ");
lcd.setCursor(8, 1);
lcd.print(Jiao,DEC);
Serial.print("\n JiaoDu = ");
Serial.print(Jiao,DEC);
}
void Self_Control(void)//self-going, ultrasonic obstacle avoidance
{
int H;
lcd.setCursor(0, 0); //setting cursor in the first row and column
lcd.print("Self_Ctr ");
Show_V(Lpwm_val);
Set_servopulse(DuoJiao);
Show_DuoJiao(DuoJiao);
H = Ultrasonic_Ranging(1);
delay(300);
if(Ultrasonic_Ranging(1) < 35)
{
stopp();
delay(100);
back();
delay(50);
}