新增 AR 导航功能 - 画面叠加导航箭头，支持智能方向指示

[Yancheng021]

修改的详细描述

• AR 导航箭头显示（按 I 键切换）
  • 智能导航箭头：根据前方路况动态调整方向
  • 颜色编码系统：
    • 绿色（转向角度<15°）：直行
    • 黄色（转向角度15-45°）：轻微转向
    • 橙色（转向角度>45°）：大角度转向
  • 实时距离显示：显示到下一个路点的距离（米）
  • 动态箭头偏移：根据转向角度横向移动，最大约90像素
  • 文字提示：显示转向方向（STRAIGHT/LEFT XX°/RIGHT XX°）
  • 半透明效果：箭头采用半透明叠加，不遮挡原画面

技术实现：

• 新增 draw_ar_navigation() 方法，负责绘制AR导航箭头
• 支持大小写 I 键切换显示/隐藏
• 使用 OpenCV 绘制多边形箭头和文字
• 实时获取路点数据计算导航方向
• 采用 alpha 混合实现半透明叠加效果

界面布局：

• 底部中央：AR导航箭头
• 右上角：HUD仪表盘（按 Y 键开启）
• 右下角：轨迹导航地图（按 D 键开启）
• 左侧：状态信息显示

控制指令更新：

• i/I - 切换 AR 导航显示/隐藏

兼容性：

• 与现有功能完全兼容，无冲突
• 不影响其他功能的正常使用

经过了什么样的测试?

1. 操作系统
2. Python版本等

运行效果

9.mp4