mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 22:03:33 +08:00
Parameter update - Rename variables in modules/fw_pos_control
using parameter_update.py script
This commit is contained in:
@@ -67,7 +67,7 @@ int BlockLocalPositionEstimator::sonarMeasure(Vector<float, n_y_sonar> &y)
|
||||
_time_last_sonar = _timeStamp;
|
||||
y.setZero();
|
||||
matrix::Eulerf euler(matrix::Quatf(_sub_att.get().q));
|
||||
y(0) = (d + _sonar_z_offset.get()) *
|
||||
y(0) = (d + _param_lpe_snr_off_z.get()) *
|
||||
cosf(euler.phi()) *
|
||||
cosf(euler.theta());
|
||||
return OK;
|
||||
@@ -90,7 +90,7 @@ void BlockLocalPositionEstimator::sonarCorrect()
|
||||
|
||||
if (cov < 1.0e-3f) {
|
||||
// use sensor value if reasoanble
|
||||
cov = _sonar_z_stddev.get() * _sonar_z_stddev.get();
|
||||
cov = _param_lpe_snr_z.get() * _param_lpe_snr_z.get();
|
||||
}
|
||||
|
||||
// sonar measurement matrix and noise matrix
|
||||
|
||||
Reference in New Issue
Block a user