//弯道入弯判断
DataL[50];
int R=0,L=0;
for(i=0;i<50;i++)
{
if(DataL[i]-8>+N1)R++;
if(DataL[i]-8<-N1)L++;
}
//判断是否是入弯还是直道,或者是已经处于S道
if(R>NN1 && L>NN1)
{
//已经进入小S道
//设置一个速度
}
if((L>NN1 && R<NN1) || (L<NN1 && R>NN1))
{
//处于大S道上
//设置一个速度
}
if(L<NN1 && R<NN1)
{
//直道
if(DataL[0]>NN3)
{
//即将入弯---偏右
//减速 转弯 延时 设定一个低速
}
else if(DataL[0]<-NN3)
{
//即将入弯----偏左
//减速 转弯 延时 设定一个低速
}
else
{
//还在直道上
//继续加速
}
}
- 1
- 2
前往页