Skip to content

Commit bc2fce9

Browse files
Use efficient sqrtf, avoid double on ARM
1 parent 68fd01d commit bc2fce9

File tree

1 file changed

+1
-1
lines changed

1 file changed

+1
-1
lines changed

src/MadgwickAHRS.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -109,7 +109,7 @@ void Madgwick::update(float gx, float gy, float gz, float ax, float ay, float az
109109
// Reference direction of Earth's magnetic field
110110
hx = mx * q0q0 - _2q0my * q3 + _2q0mz * q2 + mx * q1q1 + _2q1 * my * q2 + _2q1 * mz * q3 - mx * q2q2 - mx * q3q3;
111111
hy = _2q0mx * q3 + my * q0q0 - _2q0mz * q1 + _2q1mx * q2 - my * q1q1 + my * q2q2 + _2q2 * mz * q3 - my * q3q3;
112-
_2bx = sqrt(hx * hx + hy * hy);
112+
_2bx = sqrtf(hx * hx + hy * hy);
113113
_2bz = -_2q0mx * q2 + _2q0my * q1 + mz * q0q0 + _2q1mx * q3 - mz * q1q1 + _2q2 * my * q3 - mz * q2q2 + mz * q3q3;
114114
_4bx = 2.0f * _2bx;
115115
_4bz = 2.0f * _2bz;

0 commit comments

Comments
 (0)