Minor fixes to commands for trajectory controller