Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-31 04:58:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: make is_nan const for quaternion and add .zero() for vector2

Browse Source
This commit is contained in:
Andrew Tridgell 2014-02-20 13:20:36 +11:00
parent 1123c40761
commit 009913ec60
2 changed files with 7 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Math/quaternion.h
View File

@ -47,7 +47,7 @@ public:
} }
// check if any elements are NAN // check if any elements are NAN
bool is_nan(void) bool is_nan(void) const
{ {
return isnan(q1) || isnan(q2) || isnan(q3) || isnan(q4); return isnan(q1) || isnan(q2) || isnan(q3) || isnan(q4);
} }

6
libraries/AP_Math/vector2.h
View File

@ -105,6 +105,12 @@ struct Vector2
// check if any elements are infinity // check if any elements are infinity
bool is_inf(void) const; bool is_inf(void) const;
// zero the vector
void zero()
{
x = y = 0;
}
// gets the length of this vector squared // gets the length of this vector squared
T length_squared() const T length_squared() const
{ {