mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-11-22 14:19:57 +08:00
* feat(sih): model the distance sensor range limits, quality and noise The simulated distance sensor reported a noise free reading with no signal quality, and saturated only against the upper range limit. Readings below the minimum range were passed through unchanged, which is not what a range finder does. Report the raw saturated value with a zero quality outside of the measurement range, derate the quality over the last 20% of the range, and add configurable Gaussian noise (SIH_DISTSNSR_NOI). The quality is decided on the true distance so that a measurement sitting at a range limit does not flicker in and out of validity. The sensor is now enabled with SIH_DISTSNSR_EN instead of by an out of band value of the override parameter, and the ground distance computation moves into a helper. * feat(sih): add optical flow simulation Simulate a downward facing optical flow sensor in SIH so that flow aided navigation can be exercised without a rendered camera image. The flow rate is the sum of the body rates and of the ground relative velocity scaled by the distance to the ground, integrated over one publication interval and published on sensor_optical_flow with configurable rate (SIH_OF_RATE) and noise (SIH_OF_NOISE). The sensor reports the integrated flow only: the flow module completes the sample with the vehicle gyro and the downward facing distance sensor, which therefore has to be enabled as well. Quality drops to zero above SIH_OF_H_MAX or when the flow rate exceeds what the sensor can correlate. The topic is advertised before the simulated clock starts, because the sensors module brings up its flow pipeline on the first appearance of the topic, and publishing during startup deadlocks the lockstep clock this thread advances. Add the quadx_flow and standard_vtol_flow models with matching airframes: SYS_AUTOSTART 10046 flies the multicopter on flow only with no GNSS, 10047 fuses the flow next to GNSS on a VTOL. * prune configs Signed-off-by: RomanBapst <bapstroman@gmail.com> * more config cleanup Signed-off-by: RomanBapst <bapstroman@gmail.com> * added EKF2_HGT_REF to vtol flow config Signed-off-by: RomanBapst <bapstroman@gmail.com> * feat(simulation): added tests for optical flow for both quadx and stanard vtol modes and enable them in CI - for the test we monitor error on ground truth position and velocity Signed-off-by: RomanBapst <bapstroman@gmail.com> * feat(docs): document addition of optical flow in SIH Signed-off-by: RomanBapst <bapstroman@gmail.com> * fix(mavsdk_tests): unsubscribe flow ground truth comparison on destruction The ground truth comparison callbacks capture `this` and touch members of AutopilotTesterFlow. If a REQUIRE fails between start and stop, the tester is destroyed during unwinding while the subscriptions are still active, so a callback could run on the destroyed mutex and sample buffers. Make stop idempotent and call it from the destructor, and stop any running comparison before starting a new one. Assisted-by: Claude:claude-opus-5-5 Signed-off-by: RomanBapst <bapstroman@gmail.com> * tests for python * fix(mavsdk_tests): start the VTOL flow loiter already on its radius The loiter was centered on the vehicle's position right after the transition, so it started at the center and had to fly straight out to the commanded radius before the lateral guidance curved onto the track. Assisted-by: Claude:claude-sonnet-5 * fix(mavsdk_tests): resend the flow test EKF origin until it is taken The SITL startup script starts ekf2 after MAVLink. When MAVSDK connected first, the single SET_GPS_GLOBAL_ORIGIN was published before ekf2 existed and MAVSDK's RUN_PREARM_CHECKS followed it. Ekf2 then subscribed, saw only the newest vehicle command and never got an origin. The Coverage build starts slowly enough to hit this every time. Assisted-by: Claude:claude-opus-5-5 * ci(sitl_tests): run the VTOL flow test without coverage As a Coverage job it built with coverage on every PR and uploaded the sitl-vtol flag from PRs, which replaced main's carried-forward VTOL coverage with the flow-only flight. The quadx_flow entry also sat between the Coverage comment and the standard_vtol entry it describes. Assisted-by: Claude:claude-opus-5-5 * fix(mavsdk_tests): sum the flow test heading sweep with its sign Adding up the absolute heading changes counted yaw oscillation toward the 360 degrees, so the wait could end before a full orbit was flown. Assisted-by: Claude:claude-opus-5-5 * refactor(airframes): keep only the non-default params in the SIH flow airframes SIH_OF_H_MAX, SIH_DISTSNSR_EN and EKF2_OF_CTRL were set to their defaults and SENS_EN_GPSSIM is already set by the quadx base airframe. The quadx forced EKF2_RNG_CTRL to 2 while the VTOL used the conditional default for no stated reason, so both now use the default. Assisted-by: Claude:claude-opus-5-5 * docs(sim_sih): mark the SIH flow airframes as new in PX4 v2.0 release/1.18 has branched, so these airframes first ship in v2.0, not v1.17. Assisted-by: Claude:claude-opus-5-5 --------- Signed-off-by: RomanBapst <bapstroman@gmail.com> Co-authored-by: RomanBapst <bapstroman@gmail.com> Co-authored-by: Jacob Dahl <dahl.jakejacob@gmail.com>