[JTC] Accept larger number of `joints` than `command_joints` #809

christophfroehlich · 2023-10-30T19:14:29Z

This PR softens the condition that the number of joints and command_joints have to be equal: JTC now supports having less command_joints than joints.

This gives the opportunity to track the state and error of passive joints, especially joints that are not command_joints but a degree-of-freedom of the physical system.

As an example, see the cart-pole example in the following video (a pendulum on a cart). Now it is possible to send a swing-up trajectory of the pendulum including values of the cart and the pendulum joint, JTC will do the trajectory interpolation and publishes the full state including the desired values for the pendulum joint, but it finally only can command the cart-joint.

swingup_gh.mp4

This PR does not directly address passive joints being part of a closed-loop kinematic chain, i.e., joints not being a degree-of-freedom of the system. One could track the trajectory of all joints being part of the closed loop, but the kinematics need to be solved in the hardware interface, e.g., by means of a transmission interface.

A future PR will propose a possibility to implement different control laws than PID, e.g., a state-space controller, which is in fact necessary to control the pendulum from the example above.

More implementation details

command_joints must be a subset of joints if they don't have the same size.
If they have the same size, a 1:1 mapping is assumed independent of the values of command_joints. (see check_interface_names_with_command_joints test)
~/controller_state topic uses a single joint_names vector for all fields. Hence, entries of the output field being not included in command_joints will be NaN.

This would break rqt_joint_trajectory_controller, I used now the required state interface instead of claimed hardware interfaces from the contoller_manager msg.

codecov · 2023-10-30T19:58:11Z

Codecov Report

Attention: Patch coverage is 98.72611% with 2 lines in your changes missing coverage. Please review.

Project coverage is 84.43%. Comparing base (694d6f1) to head (0e8f70b).

Files with missing lines	Patch %	Lines
...ory_controller/src/joint_trajectory_controller.cpp	97.67%	1 Missing ⚠️
...ajectory_controller/joint_trajectory_controller.py	0.00%	1 Missing ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##           master     #809      +/-   ##
==========================================
+ Coverage   84.19%   84.43%   +0.23%     
==========================================
  Files         123      123              
  Lines       11322    11442     +120     
  Branches      956      966      +10     
==========================================
+ Hits         9533     9661     +128     
+ Misses       1473     1468       -5     
+ Partials      316      313       -3

Flag	Coverage Δ
unittests	`84.43% <98.72%> (+0.23%)`	⬆️

Flags with carried forward coverage won't be shown. Click here to find out more.

Files with missing lines	Coverage Δ
...jectory_controller/joint_trajectory_controller.hpp	`100.00% <100.00%> (ø)`
...include/joint_trajectory_controller/trajectory.hpp	`87.50% <ø> (+12.50%)`	⬆️
...ectory_controller/test/test_trajectory_actions.cpp	`97.76% <ø> (ø)`
...ory_controller/test/test_trajectory_controller.cpp	`99.77% <100.00%> (+0.03%)`	⬆️
...ntroller/test/test_trajectory_controller_utils.hpp	`83.97% <100.00%> (+0.05%)`	⬆️
...ory_controller/src/joint_trajectory_controller.cpp	`84.82% <97.67%> (+0.93%)`	⬆️
...ajectory_controller/joint_trajectory_controller.py	`0.00% <0.00%> (ø)`

... and 1 file with indirect coverage changes

saikishor

LGTM

mergify · 2023-11-15T11:21:28Z