车辆跟踪App技术问题：行驶方向异常与路径坐标清除实现

嘿，我之前做过类似的打车类车辆跟踪App，刚好踩过这两个坑，给你分享下实用的解决方案！

问题a：车辆莫名旋转（Bearing计算错误） #

这个问题几乎是做路径移动的通病——大概率是你计算方向的逻辑没考虑到无效坐标点或者方向取反了。给你几个具体的修复思路：

• 用前进方向的连续点计算Bearing：别用车辆当前位置直接取下一个点算方向！应该用车辆已经走过的上一个有效点，和当前要前进的下一个点来计算。比如车辆在路径的第n个点和n+1个点之间移动时，用第n个点到n+1个点的方向作为车辆朝向，而不是当前实时位置到n+1个点的方向（不然车辆还没到下一个点就会提前转向，看起来像乱转）。
• 过滤过近的坐标点：如果路径里有两个相邻点距离特别近（比如小于1米），直接跳过计算Bearing，保持之前的方向。很多地图API返回的路径会有这种冗余点，导致方向突然抖动。
• 修正Bearing的范围：确保计算出来的Bearing在0-360度之间，避免出现负数角度导致的旋转异常。

给你一段Kotlin示例代码（适配Google Maps SDK，其他SDK逻辑通用）：

// 计算两点间的正确Bearing
fun calculateCorrectBearing(start: LatLng, end: LatLng): Float {
    val startLatRad = Math.toRadians(start.latitude)
    val startLngRad = Math.toRadians(start.longitude)
    val endLatRad = Math.toRadians(end.latitude)
    val endLngRad = Math.toRadians(end.longitude)

    val deltaLng = endLngRad - startLngRad
    val y = Math.sin(deltaLng) * Math.cos(endLatRad)
    val x = Math.cos(startLatRad) * Math.sin(endLatRad) -
            Math.sin(startLatRad) * Math.cos(endLatRad) * Math.cos(deltaLng)
    
    // 转换为0-360度的正角度
    val rawBearing = Math.toDegrees(Math.atan2(y, x))
    return (rawBearing + 360) % 360
}

// 更新车辆朝向的逻辑
fun updateCarOrientation(currentPath: List<LatLng>, currentStepIndex: Int) {
    if (currentStepIndex <= 0 || currentStepIndex >= currentPath.size - 1) return
    
    val prevPoint = currentPath[currentStepIndex - 1]
    val nextPoint = currentPath[currentStepIndex + 1]
    // 过滤距离过近的点，避免抖动
    if (SphericalUtil.computeDistanceBetween(prevPoint, nextPoint) > 1) {
        val correctBearing = calculateCorrectBearing(prevPoint, nextPoint)
        carMarker.rotation = correctBearing
    }
}

问题b：清除已行驶路径（Uber/Ola式路径更新） #

这个核心是维护两条Polyline：一条显示已行驶的灰色路径，一条显示剩余的蓝色路径，或者动态更新单条Polyline的坐标。这里推荐双Polyline方案，视觉效果更贴合Uber的风格：

• 维护核心变量：保存完整的路径点列表fullPathPoints，以及当前车辆已经到达的路径点索引currentProgressIndex。
• 实时判断到达状态：当车辆移动时，计算它和下一个路径点的距离，当距离小于阈值（比如5米），就认为车辆到达了这个点，更新currentProgressIndex。
• 更新两条路径：
  • 已行驶路径：取fullPathPoints中从0到currentProgressIndex的点，设置为灰色Polyline的坐标。
  • 剩余路径：取fullPathPoints中从currentProgressIndex到末尾的点，设置为蓝色Polyline的坐标。

示例代码如下：

// 初始化变量
private var fullPathPoints: List<LatLng> = emptyList()
private var currentProgressIndex = 0
private var traveledPolyline: Polyline? = null
private var remainingPolyline: Polyline? = null

// 设置初始路径
fun initializeRoutePath(path: List<LatLng>) {
    fullPathPoints = path
    currentProgressIndex = 0
    
    // 创建已行驶路径（初始只有起点）
    traveledPolyline = googleMap.addPolyline(
        PolylineOptions()
            .add(path.first())
            .color(Color.parseColor("#888888"))
            .width(12f)
    )
    
    // 创建剩余路径
    remainingPolyline = googleMap.addPolyline(
        PolylineOptions()
            .addAll(path)
            .color(Color.parseColor("#2196F3"))
            .width(12f)
    )
}

// 更新车辆位置并同步路径
fun updateCarAndPath(currentCarPos: LatLng) {
    // 已经到达终点就停止更新
    if (currentProgressIndex >= fullPathPoints.size - 1) {
        carMarker.position = fullPathPoints.last()
        return
    }
    
    val nextPathPoint = fullPathPoints[currentProgressIndex + 1]
    val distanceToNext = SphericalUtil.computeDistanceBetween(currentCarPos, nextPathPoint)
    
    // 到达下一个路径点，更新进度
    if (distanceToNext < 5) {
        currentProgressIndex += 1
        // 更新已行驶路径
        traveledPolyline?.points = fullPathPoints.subList(0, currentProgressIndex + 1)
        // 更新剩余路径
        remainingPolyline?.points = fullPathPoints.subList(currentProgressIndex, fullPathPoints.size)
    }
    
    // 移动车辆Marker到当前位置
    carMarker.position = currentCarPos
}

如果你的车辆是平滑插值移动（不是跳点），可以计算车辆在当前线段上的进度比例，当超过50%时就更新currentProgressIndex，这样路径更新会更流畅。

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