if (CSB_data> 400)
{
LCD_write_string(7,1,"Err!");
}
else
{
change(CSB_data,Data);
LCD_write_string(7,1,Data);
LCD_write_string(12,1,"CM");
}
start_SB();
if ((L_BZ!=0)&&(CSB_data> =20)&&(R_BZ!=0))
{
pwm(250,250);
forward;
}
else if ((L_BZ!=0)&&(CSB_data <=20)&&(R_BZ!=0))
{
pwm(220,250);
back;
delay_nms(5);
}
else if((L_BZ==0)&&(CSB_data <=20)&&(R_BZ==0))
{
pwm(220,250);
back;
delay_nms(5);
}
else if((L_BZ==0)&&(CSB_data <=20)&&(R_BZ!=0))
{
pwm(250,250);
right;
delay_nms(5);
}
else if((L_BZ==0)&&(CSB_data> =20)&&(R_BZ!=0))
{
pwm(250,250);
right;
delay_nms(5);
}
else if((L_BZ==0)&&(CSB_data <=20)&&(R_BZ!=0))
{
pwm(250,250);
right;
delay_nms(5);
}
else if((L_BZ!=0)&&(CSB_data> =20)&&(R_BZ==0))
{
pwm(250,250);
left;
delay_nms(5);
}
else if((L_BZ!=0)&&(CSB_data <=20)&&(R_BZ==0))
{
pwm(250,250);
left;
delay_nms(5);
}
delay_nms(150);
}
}