Hello, I've noticed with PX4 1.14 that sending TrajectorySetpoint messages causes "jittery", nearly unstable, behavior unless vehicle is in "offboard" mode. For background, consider there are two flight modes set to choose from: "Position" and "Offboard"; a custom modification of the px4_ros_com example has been created that removes programmatic arming and programmatic flight mode changes and only continually publishes TrajectorySetpoint and OffboardControlMode messages at 20 Hz. The "offboard_mode" field in voxl-vision-hub.conf has been set to "off" so there shouldn't be a conflict there.
Expected behavior: PX4 stack should ignore TrajectorySetpoint and OffboardControlMode messages while vehicle flight mode is in "position" control, then should start following the trajectory setpoints according to the offboardcontrolmode settings when flipped into "offboard"mode.
Observed behavior: When sending TrajectorySetpoint messages in "position" mode, vehicle becomes extremely jittery with reduced controllability, as if it's trying to implement these setpoints. Sending OffboardControlMode messages does NOT affect behavior whether in "position" or "offboard" mode and hence can be used as the "offboard heartbeat signal" to keep offboard mode active. Sending TrajectorySetpoint messages in offboard mode works as expected. This has been observed using both the VOXL2+VOXL2IO+m500 frame as well as the Starling.
Question: Are we to expect in PX4 1.14 that this behavior is correct and we need to only send TrajectorySetpoint messages as soon as offboard mode is switched on or is this a bug in the firmware?
Thanks!
-Joe