Skip to content

Comments

Fix/dealing with continuous joints#131

Open
clementPene wants to merge 21 commits intoloco-3d:mainfrom
clementPene:fix/dealing_with_continuous_joints
Open

Fix/dealing with continuous joints#131
clementPene wants to merge 21 commits intoloco-3d:mainfrom
clementPene:fix/dealing_with_continuous_joints

Conversation

@clementPene
Copy link

@clementPene clementPene commented Jan 12, 2026

I ran into a problem when using LFC with Tiago. I wanted to control the wheels but it was a "continuous joint".
Problem was that in case of a continuous joint, Pinocchio will add 2 to nq (cos, sin).
So the modifications are mainly about :

  • provide a differentiation between pinocchio joint space dimension and hardware/ROS joint space dimension
  • conversion functions between pinocchio joint space dimension and hardware/ROS joint space dimension
  • fix code where these information are used
  • fix existing tests
  • modified tests with the case of a continuous joint
  • CHECK : I have a problem with gravity compensation for Tiago torso. Problems might be related to the prismatic joint.

@clementPene clementPene force-pushed the fix/dealing_with_continuous_joints branch 2 times, most recently from 02a12af to 0a1598d Compare January 13, 2026 12:33
@clementPene clementPene force-pushed the fix/dealing_with_continuous_joints branch from 0a1598d to d0a74b8 Compare January 13, 2026 12:44
@clementPene clementPene reopened this Jan 13, 2026
@clementPene clementPene marked this pull request as ready for review January 14, 2026 16:03
@MaximilienNaveau MaximilienNaveau self-requested a review January 15, 2026 07:58
Copy link
Collaborator

@MaximilienNaveau MaximilienNaveau left a comment

Choose a reason for hiding this comment

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

Thank you very much for the work!
In this work package one needs to be extra carefull about system calls like malloc which preempt the CPU. These call are not real-time safe.
Hence you should verify that you do not create unnecessary variables on the fly.

I will merge this PR once all comment have been resolved.

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