|
void run()
{
pwm_left_val = 150;
pwm_right_val = 150;
L_go;
R_go;
}
void stop()
{
L_stop;
R_stop;
}
void lefturn()
{
pwm_left_val = 150;
pwm_right_val = 130;
R_go;
L_back;
}
void righturn()
{
pwm_left_val = 130;
pwm_right_val = 150;
L_go;
R_back;
}
void xunji()
{
if((Left_led==0)&&(Right_led==0))
{
run();
delay_us(10);
}
else if((Left_led==1)&&(Right_led==1))
{
stop();
}
else if((Left_led==0)&&(Right_led==1))
{
righturn();
delay_us(10);
}
else if((Left_led==1)&&(Right_led==0))
{
lefturn();
delay_us(10);
}
} |
|