Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Math: fixed a few more single precision calls

This commit is contained in:
Andrew Tridgell 2021-07-09 14:03:04 +10:00
parent 56d9134e38
commit 168e860f70
3 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Math/tests/test_vector2.cpp
View File

@ -109,7 +109,7 @@ TEST(Vector2Test, angle)
{ {
EXPECT_FLOAT_EQ(M_PI/2, Vector2f(0, 1).angle()); EXPECT_FLOAT_EQ(M_PI/2, Vector2f(0, 1).angle());
EXPECT_FLOAT_EQ(M_PI/4, Vector2f(1, 1).angle()); EXPECT_FLOAT_EQ(M_PI/4, Vector2f(1, 1).angle());
EXPECT_FLOAT_EQ(0.0f, Vector2f(1, 0).angle()); EXPECT_FLOAT_EQ(0.0f, Vector2d(1, 0).angle());
EXPECT_FLOAT_EQ(M_PI*5/4, Vector2f(-1, -1).angle()); EXPECT_FLOAT_EQ(M_PI*5/4, Vector2f(-1, -1).angle());
EXPECT_FLOAT_EQ(M_PI*5/4, Vector2f(-5, -5).angle()); EXPECT_FLOAT_EQ(M_PI*5/4, Vector2f(-5, -5).angle());

2
libraries/AP_Math/vector2.cpp
View File

@ -161,7 +161,7 @@ T Vector2<T>::angle(const Vector2<T> &v2) const
template <typename T> template <typename T>
T Vector2<T>::angle(void) const T Vector2<T>::angle(void) const
{ {
return M_PI_2 + atan2f(-x, y); return M_PI_2 + atan2F(-x, y);
} }
// find the intersection between two line segments // find the intersection between two line segments

2
libraries/AP_Math/vector3.cpp
View File

@ -418,7 +418,7 @@ T Vector3<T>::angle(const Vector3<T> &v2) const
return 0.0f; return 0.0f;
} }
const T cosv = ((*this)*v2) / len; const T cosv = ((*this)*v2) / len;
if (fabsf(cosv) >= 1) { if (fabsF(cosv) >= 1) {
return 0.0f; return 0.0f;
} }
return acosF(cosv); return acosF(cosv);