Consider adding BT nodes for doing various operations to trajectories:
Combining 2 trajectories
Reversing a trajectory
Useful in a case where some operation fails when the robot is not at the home state (e.g., the call to start reconstruction fails). We could potentially reverse some known trajectory to return home
Populating joint trajectories (e.g., from motion planners) with the current state of all robot controller joints that are missing from the trajectory
Useful for drivers like MotoROS2 when multiple motion groups are present
Consider adding BT nodes for doing various operations to trajectories: