解决了必须坐标点重复才能稳定跟踪的问题，原因是算法里面适配之前坐标点重复的BUG，写了前视跳点和路径跳点。改成不跳点就好了。

yincheng.zhong

2025-12-11 26eb4faf2fb7b37f33a204d6a35814c725221e68

1
2
3
4
5
6
7
8
9
{
  "pose": [
    3.0,
    0.0,
    0.0,
    0.0
  ],
  "origin": "$GNGGA,080112.000,3949.90238860,N,11616.75692000,E,4,44,0.42,4,M,-6.684,M,1.0,0409*55"
}