mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-21 09:22:18 +00:00
sensor_calibration: increase threshold for updating calibration offsets or scale
- this is to minimize needlessly writing negligible parameter changes and triggering unnecessary estimator bias resets
This commit is contained in:
@@ -125,7 +125,7 @@ void Accelerometer::SensorCorrectionsUpdate(bool force)
|
||||
|
||||
bool Accelerometer::set_offset(const Vector3f &offset)
|
||||
{
|
||||
if (Vector3f(_offset - offset).longerThan(0.001f)) {
|
||||
if (Vector3f(_offset - offset).longerThan(0.01f)) {
|
||||
_offset = offset;
|
||||
|
||||
_calibration_count++;
|
||||
@@ -137,7 +137,7 @@ bool Accelerometer::set_offset(const Vector3f &offset)
|
||||
|
||||
bool Accelerometer::set_scale(const Vector3f &scale)
|
||||
{
|
||||
if (Vector3f(_scale - scale).longerThan(0.001f)) {
|
||||
if (Vector3f(_scale - scale).longerThan(0.01f)) {
|
||||
_scale = scale;
|
||||
|
||||
_calibration_count++;
|
||||
|
||||
Reference in New Issue
Block a user