Skip to content

Fix the joint position move (homing) - #14

Merged
ZhuoyueLi merged 1 commit into
mainfrom
fix/homing-move
Nov 17, 2026
Merged

ZhuoyueLi merged 1 commit into
mainfrom
fix/homing-move

Conversation

@ngres

@ngres ngres commented Nov 17, 2026

Copy link
Copy Markdown
Collaborator

use robot_state.q_d instead of robot_state.q to prevent jumps in the desired configuration

…at the target

- Start the motion from q_d instead of q. Starting from the measured position makes the first
  command jump by q - q_d (audible jerk at the start, or a velocity/acceleration discontinuity
  abort when the gap is larger, e.g. after the arm sagged in Idle).
- Skip the move if the arm is already within tolerance. A motion that finishes in its first
  cycle is rejected by libfranka ("Motion finished commanded, but the robot is still moving").
- Stop retrying after a successful move. The loop ran 5 times even on success, each extra run
  started at the target and failed as above.
- Return false when all retries fail instead of reporting the target as reached.

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
@ZhuoyueLi
ZhuoyueLi merged commit 011c6f9 into main Nov 17, 2026
1 check failed
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.

2 participants