注册会员
- 积分
- 66
- 威望
- 50
- 贡献
- 6
- 兑换币
- 21
- 注册时间
- 2013-2-27
- 在线时间
- 5 小时
- 毕业学校
- 东华大学
|
这个是查表的,有点弱。核心代码如下。跟大家分享一下~
void signal_Ctrl() //signal capture and dispose
{
middle=Mult_covert(5);
right=Mult_covert(1);
left=Mult_covert(7);
if((2000<middle)||(middle+left+right>5600))//Only middle can be detected
{
flag1=1;
Ctrl_pwm(7,7);
}
else if((1500<right)) //just right sensor capture the signal
{
flag2=1;
Ctrl_pwm(4,7); //turn right 21 degree
}
else if(1500<left)
{
flag2=1;
Ctrl_pwm(10,7); //turn left 21 degree
}
else if((600<left)&&((middle+right)<300)) //just left sensor capture the signal
{
flag3=1;
Ctrl_pwm(14,7); //turn left 35 degree
}
else if((600<right)&&((middle+left)<300))
{
flag3=1;
Ctrl_pwm(0,7); //turn right 35 degree
}
} |
|