云台0到360度旋转,判断到位方式

发布于 2023-04-11  554 次阅读


//获取当前角度和目标角度
currentAngle = 获取当前角度();
targetAngle = 获取当前角度();
//计算角度差
angleDifference = targetAngle - currentAngle;
//判断是否越过0度或360度
if(angleDifference > 180)
{
    angleDifference = angleDifference - 360;
}
else if(angleDifference < -180)
{
    angleDifference = angleDifference + 360;
}
//设置阈值判断范围
thresholdRange = 5;
//判断是否在误差阈值范围内
if(angleDifference <= thresholdRange && angleDifference >= -thresholdRange)
{
    //到位处理
}
else
{
    //未到位处理
}

一沙一世界,一花一天堂。君掌盛无边,刹那成永恒。