新手上路
- 积分
- 39
- 金钱
- 39
- 注册时间
- 2019-7-22
- 在线时间
- 10 小时
|
1金钱
各位大佬,我自己在做一个循迹小车,循迹用的是红外线模块,用了3个传感器,下地跑的时候小车不动,红外线传感器检测不到地上的黑线,但是我自己放在桌上一个一个传感器测的时候并没有什么问题,每个传感器都可以检测到。
程序:
int main(void)
{
LED_Init();
KEY_Init();
delay_init(); //延时函数初始化
MH_Init();
TIM4_PWM_Init(99,719); //不分频。PWM频率=72000000/720=100Khz
while(1)
{
LED1=0;
if(MH_MIDDLE==1) //中间检测到黑线,直走
{
cnt=1;
GO_FORWARD(40);
}
if(MH_LEFT==1 || (MH_LEFT==1 && MH_MIDDLE==1)) //左侧发现黑线,左拐
{
cnt=2;
GO_LEFT(40);
delay_ms(50);
}
else if(MH_RIGHT==1 || (MH_MIDDLE==1 && MH_RIGHT==1 )) //右侧发现黑线,右拐
{
cnt=3;
GO_RIGHT(40);
delay_ms(50);
}
else if( MH_RIGHT==1 && MH_LEFT==1 && MH_MIDDLE==1 )
{
cnt=4;
GO_FORWARD(50);
delay_ms(50);
}
else
{
GO_STOP(0);
}
}
}
|
|