经纬度转球面3D坐标算法在极点附近的异常问题求助

问题背景 #

假设球心位于[0,0,0]，实现了经纬度与球面3D点的互转逻辑，并通过相机射线检测获取目标点，控制物体沿球面移动。但在两极附近，移动逻辑出现异常：fr值趋近无穷大，导致目标永远无法到达，物体还会被推离极点区域。

现有实现代码 #

经纬度转3D点 #

public static Vector3 GetPointOnSphere(Vector2 coo, float radius)
{
    float lati = coo.x * Mathf.Deg2Rad;
    float longi = coo.y * Mathf.Deg2Rad;
    float x = radius * Mathf.Cos(lati) * Mathf.Cos(longi);
    float y = radius * Mathf.Cos(lati) * Mathf.Sin(longi);
    float z = radius * Mathf.Sin(lati);
    return new Vector3(x, y, z);
}

3D点转经纬度 #

public static Vector2 GetCoords(Vector3 point, float radius)
{
    float lati = Mathf.Asin(point.z / radius) * Mathf.Rad2Deg;
    float longi = Mathf.Atan2(point.y, point.x) * Mathf.Rad2Deg;

    return new Vector2(lati, longi);
}

移动控制逻辑 #

bool MoveTowardsPoint(Vector2 target, float stop_dist)
{
    Vector2 curr = GetCoords();
    if (CompareVector2(curr, target, stop_dist))
    {
        return true;
    }
    double angularDistance = Math.Acos(Math.Sin(curr.x * Math.PI / 180) * Math.Sin(target.x * Math.PI / 180) +
                                           Math.Cos(curr.x * Math.PI / 180) * Math.Cos(target.x * Math.PI / 180) *
                                           Math.Cos(Math.Abs(curr.y - target.y) * Math.PI / 180)) + 1e-6;
    double fr = MoveSpeed * Time.fixedDeltaTime / angularDistance;
    
    Vector2 coords = new Vector2(LerpAngle(curr.x, target.x, fr),
        LerpAngle(curr.y, target.y, fr));

    transform.position = GetPointOnSphere(coords);
        
    return false;
}

辅助方法 #

float LerpAngle(double a, double b, double t)
{
    double delta = Repeat((b - a), 360);
    if (delta > 180)
        delta -= 360;
    return (float)(a + delta * Clamp01(t));
}

double Repeat(double t, double length)
{
    return Clamp(t - Math.Floor(t / length) * length, 0.0f, length);
}

double Clamp(double value, double min, double max)
{
    if (value < min) return min;
    if (value > max) return max;
    return value;
}

double Clamp01(double value)
{
    if (value < 0.0) return 0.0;
    if (value > 1.0) return 1.0;
    return value;
}

问题原因 #

1. 极点处经纬度的奇点问题：当纬度接近±90°时，cos(lati)趋近于0，经度的变化对3D位置的影响几乎可以忽略，此时对经度进行插值会导致位置计算出现偏差。
2. angularDistance计算误差：在极点附近，cos(curr.x)和cos(target.x)都趋近于0，导致angularDistance的计算结果趋近于0（即使两点实际距离很近），进而使fr = MoveSpeed * Time.fixedDeltaTime / angularDistance变得极大，物体每次移动过度，无法收敛到目标点。

修复方案 #

放弃直接对经纬度进行插值，改用3D空间向量的球面插值（Slerp），完全绕开经纬度在极点的奇点问题。具体步骤：

1. 将当前经纬度和目标经纬度转换为3D向量
2. 计算两个向量之间的夹角，判断是否已到达目标（夹角小于停止阈值对应的弧度）
3. 计算本次移动的弧度步长：step = MoveSpeed * Time.fixedDeltaTime
4. 使用球面插值将当前向量向目标向量移动指定弧度步长
5. 将插值后的向量转换为物体位置（保持球面半径）

修改后的代码 #

优化后的移动控制逻辑 #

bool MoveTowardsPoint(Vector2 target, float stop_dist, float radius)
{
    // 获取当前位置的3D向量和目标位置的3D向量
    Vector3 currPoint = GetPointOnSphere(GetCoords(transform.position, radius), radius);
    Vector3 targetPoint = GetPointOnSphere(target, radius);

    // 计算两个向量的夹角（弧度）
    float angle = Vector3.Angle(currPoint, targetPoint) * Mathf.Deg2Rad;
    
    // 判断是否到达目标（stop_dist是角度阈值，转换为弧度）
    if (angle < stop_dist * Mathf.Deg2Rad)
    {
        transform.position = targetPoint;
        return true;
    }

    // 计算本次移动的弧度步长
    float step = MoveSpeed * Time.fixedDeltaTime;
    // 限制步长不超过剩余角度，避免过冲
    step = Mathf.Min(step, angle);

    // 球面插值：从当前向量向目标向量移动step弧度
    Vector3 newPoint = Vector3.SlerpUnclamped(currPoint.normalized, targetPoint.normalized, step / angle);
    newPoint *= radius; // 恢复球面半径

    transform.position = newPoint;
    return false;
}

说明 #

• 使用Vector3.SlerpUnclamped进行球面插值，确保移动路径是球面上的最短弧
• 通过限制step不超过剩余夹角，避免物体越过目标点
• 完全基于3D向量计算，彻底解决极点附近的经纬度奇点问题

内容的提问来源于stack exchange，提问作者smsware