Skip to content

aegis_grpc: Omit MoveIt2 call if the goal is close to the current pose#104

Merged
macmacal merged 3 commits intohumble-develfrom
feature/aegis_grpc/moveit_improvements
Feb 16, 2026
Merged

aegis_grpc: Omit MoveIt2 call if the goal is close to the current pose#104
macmacal merged 3 commits intohumble-develfrom
feature/aegis_grpc/moveit_improvements

Conversation

@macmacal
Copy link
Contributor

@macmacal macmacal commented Feb 16, 2026

Description

This PR introduces a check before calling the MoveIt2 planning pipeline, if the target joints/tcp goal is close enough to the current state of the robot.

In addition, some portions of the code has been refactored into more declarative style with lambdas.

Motivation and context

  • MoveIt-proof code for the aegis_gym development

How has this been tested?

  • Manually on the real robot

Checklist

  • All TODOs in the code have been resolved or linked to a proper issue.
  • Code has been (auto)formatted.
  • Documentation (e.g., README, CHANGELOG, Wiki) has been updated.
  • All automated checks have passed.

Clickup task: 869c46w0b

@macmacal macmacal requested a review from sivral February 16, 2026 15:20
@macmacal macmacal added enhancement New feature or request moveit2 Issue related to path planning with MoveIt2 framework grpc labels Feb 16, 2026
@macmacal macmacal marked this pull request as draft February 16, 2026 15:20
Base automatically changed from feature/aegis_grpc/minor_improvments to humble-devel February 16, 2026 16:26
@macmacal macmacal marked this pull request as ready for review February 16, 2026 16:26
Copy link
Contributor

@sivral sivral left a comment

Choose a reason for hiding this comment

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

Looks good to me.

@macmacal macmacal merged commit 4a1f92a into humble-devel Feb 16, 2026
1 check passed
@macmacal macmacal deleted the feature/aegis_grpc/moveit_improvements branch February 16, 2026 19:21
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

enhancement New feature or request grpc moveit2 Issue related to path planning with MoveIt2 framework

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants