Add return value to updateTrajectoryCommand method

- Leverage this to discard invalid trajectory messages (eg. too old) and not
  preempt active goals when such invalid messages arrive.
HardwareInterfaceAdapter now also sets commands.