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

yincheng.zhong

2025-12-11 26eb4faf2fb7b37f33a204d6a35814c725221e68

 STM32H743/MDK-ARM/STM32H743.uvoptx

@@ -260,6 +260,36 @@
          <WinNumber>1</WinNumber>
          <ItemText>g_com_map,0x0A</ItemText>
        </Ww>
        <Ww>
          <count>20</count>
          <WinNumber>1</WinNumber>
          <ItemText>l_stGPGIG.m_dLatitude</ItemText>
        </Ww>
        <Ww>
          <count>21</count>
          <WinNumber>1</WinNumber>
          <ItemText>l_stGPRMI.m_dLatitude</ItemText>
        </Ww>
        <Ww>
          <count>22</count>
          <WinNumber>1</WinNumber>
          <ItemText>sol_status</ItemText>
        </Ww>
        <Ww>
          <count>23</count>
          <WinNumber>1</WinNumber>
          <ItemText>l_stGPRMI.m_u32StatusFlags</ItemText>
        </Ww>
        <Ww>
          <count>24</count>
          <WinNumber>1</WinNumber>
          <ItemText>g_motion_state</ItemText>
        </Ww>
        <Ww>
          <count>25</count>
          <WinNumber>1</WinNumber>
          <ItemText>state</ItemText>
        </Ww>
      </WatchWindow1>
      <MemoryWindow1>
        <Mm>