中级会员
- 积分
- 304
- 威望
- 218
- 贡献
- 22
- 兑换币
- 0
- 注册时间
- 2008-12-28
- 在线时间
- 32 小时
|
void SignalProcess(unsigned int signal1,unsigned int signal2)
{
int deviation;
deviation=signal1^signal2;
switch(deviation)
{
case 0:
{
Direction=1500;break;
}
......
case 64:
{
if(signal1>0)
{
Direction=3000;
}
else
{
Direction=0;
}
break;
}
default:
{
break;
}
}
......
if(Direction<462||Direction>2539)
{
Velocity=LOWSPEED;
}
else if(Direction<1385||Direction>1731)
{
Velocity=MIDSPEED;
}
else
{
Velocity=HIGHSPEED;
}
A,B采集,之后调用PWMout(Direction,Velocity)输出,但舵机在开机回正之后就不动了,事实上switch语句好象没起作用,Direction(初值1500)没变,Velocity总是为LOWSPEED;不解! |
|