Skip to content

Anbit/guidance#698

Open
anbit-adhi wants to merge 100 commits intomainfrom
anbit/guidance
Open

Anbit/guidance#698
anbit-adhi wants to merge 100 commits intomainfrom
anbit/guidance

Conversation

@anbit-adhi
Copy link
Copy Markdown
Contributor

This PR adds the los_guidance package and integrates it into the autopilot setup for waypoint-based guidance of the AUV. The node computes guidance references from the current vehicle state and a target waypoint, and sends the desired yaw, pitch, and surge to the downstream controller.

The package also has overwritten the old simulator test with need changes for it to work with the new guidance. Most of the implementation details, usage, and configuration are described in the README.

Anbit and others added 30 commits October 19, 2025 15:56
* ci(pre-commit): add CI workflow for checking pre-commit hooks

* ci(pre-commit): add hooks for cpp and CMake

* refactor(pre-commit.yml): now uses the workflow on main

* docs(README.md): update status badge for pre-commit

* refactor(ci): move local hooks into a different config file

* docs(README.md): update status badge for pre-commit

* refactor(ci): pre-commit.yml now only runs on pull_request and workflow_dispatch

* ci(pre-commit-local): ignore build/include_order in ament_cpplint since conflict with clang-format

* refactor: fix ament_cpplint and cppcheck warnings

* ci(pre-commit-config-local): increase line length to 120 for ament_cpplint due to some lines being longer

* refactor: fix ament_cpplint and cppcheck warnings

* chore(pre-commit): exclude test dirs from ament_cppcheck to avoid false positives

* ci(pre-commit): update workflow to run on push to main and pull_request
* waypoint mode handling

* update tests with new message

* initial package setup

* ros interface function declaration

* node setup

* working prototype

* reentrant cb, multithreaded

* single threaded impl

* conv threshold action goal

* default thresholdref conv value

* removed switching logic

* removed timer execution

* sim test utils

* waypoint_manager_test setup

* no rendering test arg

* waypoint tests, timeout error

* test refactor

* format

* rename utils package

* test suite and description

* first waypoint test

* removed unused function

* renamed service field to priority. Added simple tests

* waypoint manager readme

* uniform attitude naming convention

* fix pr requests

* update tests with new service fields

* four corner test

* update util func name

* update with new action def

* removed failing build type

* test dependencies

* ignore failing yasmin package

* remove __init__ files

* quat_to_euler in make_pose helper

* added __init__ file

* removed sim deps for test packages

* added action shutdown handling

* removed waypoint manager set setup

* added waypoint manager node tests

* waypoint manager 4 corner sim test

* added missing launch testing test dependency

* add sleep for topic discovery

* fix action member field name

* removed unnecessary if here
* waypoint mode handling

* update tests with new message

* initial package setup

* ros interface function declaration

* node setup

* working prototype

* reentrant cb, multithreaded

* single threaded impl

* conv threshold action goal

* default thresholdref conv value

* removed switching logic

* removed timer execution

* sim test utils

* waypoint_manager_test setup

* no rendering test arg

* waypoint tests, timeout error

* test refactor

* format

* rename utils package

* test suite and description

* first waypoint test

* removed unused function

* renamed service field to priority. Added simple tests

* waypoint manager readme

* uniform attitude naming convention

* fix pr requests

* update tests with new service fields

* four corner test

* update util func name

* update with new action def

* removed failing build type

* test dependencies

* ignore failing yasmin package

* remove __init__ files

* quat_to_euler in make_pose helper

* added __init__ file

* removed sim deps for test packages

* added action shutdown handling

* removed waypoint manager set setup

* added waypoint manager node tests

* waypoint manager 4 corner sim test

* added missing launch testing test dependency

* add sleep for topic discovery

* fix action member field name

* updated to new utils type names

* renamed variables to match types

* update function arg to reflect vortex type

* update variable name in tests

* renamed function arg names
* refactor to new utils ros packages

* added utils dep for velocity controller

* fix typo
Copy link
Copy Markdown
Contributor

@Q3rkses Q3rkses left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

initial comments, fix them and i can review again

Comment thread guidance/los_guidance/include/los_guidance/lib/adaptive_los.hpp Outdated
Comment thread guidance/los_guidance/include/los_guidance/lib/adaptive_los.hpp Outdated
Comment thread guidance/los_guidance/include/los_guidance/lib/adaptive_los.hpp Outdated
Comment thread guidance/los_guidance/include/los_guidance/lib/adaptive_los.hpp Outdated
Comment thread guidance/los_guidance/include/los_guidance/lib/integral_los.hpp Outdated
Comment thread guidance/los_guidance/test/test_main.cpp
Comment thread guidance/los_guidance/README.md Outdated
Comment thread guidance/los_guidance/README.md Outdated
Comment thread guidance/los_guidance/README.md Outdated
Comment thread guidance/los_guidance/README.md
@anbit-adhi anbit-adhi requested a review from Q3rkses March 31, 2026 11:42
Copy link
Copy Markdown
Contributor

@vortexuser vortexuser left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

first of round of reviews

Comment thread guidance/los_guidance/launch/los_guidance.launch.py
Comment thread guidance/los_guidance/launch/los_guidance.launch.py Outdated
Comment thread guidance/los_guidance/launch/guidance_test.launch.py
Comment thread guidance/los_guidance/package.xml
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.

5 participants