Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-09 01:13:57 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: create and use INTERNAL_ERROR macro so we get line numbers

Browse Source
This commit is contained in:
Peter Barker 2020-04-30 10:40:46 +10:00 committed by Peter Barker
parent 7befe84f0c
commit 58a8e54d83
3 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Math/AP_Math.cpp
View File

@ -266,7 +266,7 @@ T constrain_value(const T amt, const T low, const T high)
// errors through any function that uses constrain_value(). The normal
// float semantics already handle -Inf and +Inf
if (isnan(amt)) {
AP::internalerror().error(AP_InternalError::error_t::constraining_nan);
INTERNAL_ERROR(AP_InternalError::error_t::constraining_nan);
return (low + high) / 2;
}

4
libraries/AP_Math/quaternion.cpp
View File

@ -368,14 +368,14 @@ void Quaternion::from_rotation(enum Rotation rotation)
case ROTATION_CUSTOM:
// Error; custom rotations not supported
AP::internalerror().error(AP_InternalError::error_t::flow_of_control);
INTERNAL_ERROR(AP_InternalError::error_t::flow_of_control);
return;
case ROTATION_MAX:
break;
}
// rotation invalid
AP::internalerror().error(AP_InternalError::error_t::bad_rotation);
INTERNAL_ERROR(AP_InternalError::error_t::bad_rotation);
}
// rotate this quaternion by the given rotation

4
libraries/AP_Math/vector3.cpp
View File

@ -253,13 +253,13 @@ void Vector3<T>::rotate(enum Rotation rotation)
}
case ROTATION_CUSTOM:
// Error: caller must perform custom rotations via matrix multiplication
AP::internalerror().error(AP_InternalError::error_t::flow_of_control);
INTERNAL_ERROR(AP_InternalError::error_t::flow_of_control);
return;
case ROTATION_MAX:
break;
}
// rotation invalid
AP::internalerror().error(AP_InternalError::error_t::bad_rotation);
INTERNAL_ERROR(AP_InternalError::error_t::bad_rotation);
}
template <typename T>