Skip to content

feat: add localization assist and VIO guard#171

Draft
xiaolefang-dm wants to merge 5 commits into
mainfrom
xiaole/auto-localization-assist-vio-guard
Draft

feat: add localization assist and VIO guard#171
xiaolefang-dm wants to merge 5 commits into
mainfrom
xiaole/auto-localization-assist-vio-guard

Conversation

@xiaolefang-dm

@xiaolefang-dm xiaolefang-dm commented Jun 23, 2026

Copy link
Copy Markdown
Contributor

Summary

  • add localization assist mode that yaw-sweeps until localization is achieved
  • gate assist changes behind nav-node state and expose Assist toggle in Operate UI
  • add looper-mode Insight VIO guard that stops nav on VIO loss and resumes remaining POIs after recovery/relocalization

Testing

  • jinhua factory
auto-location.mov

@github-actions

Copy link
Copy Markdown
cloc github.com/AlDanial/cloc v 2.04 T=0.17 s (242.8 files/s, 38247.6 lines/s)
Language files blank comment code
Python 13 669 312 3720
Markdown 4 155 6 426
C++ 4 60 38 409
Bourne Shell 15 41 9 272
Dockerfile 1 31 32 204
JSON 2 8 0 58
TOML 1 4 0 58
make 1 18 15 49
CMake 1 4 0 17
-------- -------- -------- -------- --------
SUM: 42 990 412 5213

xiaolefang-dm and others added 5 commits July 3, 2026 16:50
When the 'Assist' toggle is enabled on the Operate page:
- Nav ON starts map_node but NOT cmd_vel_control
- Backend runs a yaw sweep (±expanding angles, 5s dwell each)
- Once localized, sweep stops and cmd_vel_control starts normally

Backend changes (node_manager.py):
- _loc_assist_enabled / _loc_assist_thread / _loc_assist_stop_event state
- _loc_assist_loop(): expanding yaw sweep pattern via /cmd_vel
- _on_localization_achieved(): stops sweep, launches cmd_vel_control
- cmd_start_nav_nodes skips cmd_vel_control when assist is on
- cmd_stop_nav_nodes stops assist thread
- get_status() includes locAssistEnabled

API (routers/nav.py):
- POST /nav/loc-assist {enabled: bool} — toggle
- GET /nav/loc-assist — read state

Frontend:
- DeviceStatus.locAssistEnabled field
- _LocAssistToggle button on Operate page (bottom-right, above Nav)
@xiaolefang-dm
xiaolefang-dm force-pushed the xiaole/auto-localization-assist-vio-guard branch from 1def31e to dfc0a58 Compare July 3, 2026 08:51
@github-actions

github-actions Bot commented Jul 3, 2026

Copy link
Copy Markdown
cloc github.com/AlDanial/cloc v 2.04 T=0.18 s (237.3 files/s, 37579.2 lines/s)
Language files blank comment code
Python 13 671 306 3760
Markdown 4 155 6 426
C++ 4 60 38 409
Bourne Shell 15 41 9 272
Dockerfile 1 31 32 204
JSON 2 8 0 58
TOML 1 4 0 58
make 1 18 15 49
CMake 1 4 0 17
-------- -------- -------- -------- --------
SUM: 42 992 406 5253

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant