fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 04:21:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

removed unused code - _constrainOneSide and _constrainAbs

Browse Source
This commit is contained in:
CR
2022-06-22 23:21:16 +02:00
committed by Matthias Grob
parent 479c85047f
commit ffb0097052
1 changed files with 0 additions and 20 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/motion_planning/PositionSmoothing.cpp
-20
View File
@@ -84,26 +84,6 @@ bool PositionSmoothing::_isTurning(const Vector3f &target) const
&& pos_to_target.longerThan(_target_acceptance_radius)); && pos_to_target.longerThan(_target_acceptance_radius));
} }
/* Constrain some value vith a constrain depending on the sign of the constraint
* Example: - if the constrain is -5, the value will be constrained between -5 and 0
* - if the constrain is 5, the value will be constrained between 0 and 5
*/
inline float _constrainOneSide(float val, float constraint)
{
const float min = (constraint < FLT_EPSILON) ? constraint : 0.f;
const float max = (constraint > FLT_EPSILON) ? constraint : 0.f;
return math::constrain(val, min, max);
}
inline float _constrainAbs(float val, float max)
{
return matrix::sign(val) * math::min(fabsf(val), fabsf(max));
}
float PositionSmoothing::_getMaxXYSpeed(const Vector3f(&waypoints)[3]) const float PositionSmoothing::_getMaxXYSpeed(const Vector3f(&waypoints)[3]) const
{ {
Vector3f pos_traj(_trajectory[0].getCurrentPosition(), Vector3f pos_traj(_trajectory[0].getCurrentPosition(),