diff --git a/src/drivers/l3gd20/l3gd20.cpp b/src/drivers/l3gd20/l3gd20.cpp index a2533abde90..ed69387064f 100644 --- a/src/drivers/l3gd20/l3gd20.cpp +++ b/src/drivers/l3gd20/l3gd20.cpp @@ -1147,8 +1147,8 @@ L3GD20::test_error() int L3GD20::self_test() { - /* evaluate gyro offsets, complain if offset -> zero or larger than 25 dps */ - if (fabsf(_gyro_scale.x_offset) > L3GD20_MAX_OFFSET || fabsf(_gyro_scale.x_offset) < 0.000001f) { + /* evaluate gyro offsets, complain if offset larger than 25 dps */ + if (fabsf(_gyro_scale.x_offset) > L3GD20_MAX_OFFSET) { return 1; } @@ -1156,7 +1156,7 @@ L3GD20::self_test() return 1; } - if (fabsf(_gyro_scale.y_offset) > L3GD20_MAX_OFFSET || fabsf(_gyro_scale.y_offset) < 0.000001f) { + if (fabsf(_gyro_scale.y_offset) > L3GD20_MAX_OFFSET) { return 1; } @@ -1164,7 +1164,7 @@ L3GD20::self_test() return 1; } - if (fabsf(_gyro_scale.z_offset) > L3GD20_MAX_OFFSET || fabsf(_gyro_scale.z_offset) < 0.000001f) { + if (fabsf(_gyro_scale.z_offset) > L3GD20_MAX_OFFSET) { return 1; }