夹紧角至任意范围

Question

彩色区域表示有效的角度范围。

• 在图像#1中，ang应固定为最大(-90)
  
• 在图像#2中，ang应固定在min(135)
  
• 在图像#3中，ang应被固定为min(135)
  

这是我目前所掌握的：

static float clamp_angle(float ang,float min,float max)
{
    ang = normalize_angle(ang); // normalize_angle transforms angle into [-180,180) range
    min = normalize_angle(min);
    max = normalize_angle(max);
    if(angle_in_range(ang,min,max) == false)
    {
        if(abs(get_angle_difference(ang,min)) < abs(get_angle_difference(ang,max))
            ang = min; // Clamp to min if we're closer to min than max
        else
            ang = max;
    }
    return ang;
}

Answer 1

您可以将ang变为0，min和max映射为[-180；180)，然后您可以检查angle是否在提供的范围内，如下所示：

float clamp_angle(const float ang, const float min, const float max)
{
    float n_min = normalize180(min-ang);
    float n_max = normalize180(max-ang);

    if (n_min <= 0 && n_max >= 0)
    {
        return ang;
    }
    if (abs(n_min) < abs(n_max))
        return min;
    return max;
}

在Coliru上直播