fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-03 17:28:54 +08:00
Code Issues Packages Projects Releases Wiki Activity

mathlib Functions: added SuperExpo function for stick feel enhancement

Browse Source
This commit is contained in:
Matthias Grob
2017-10-17 16:54:16 +02:00
parent 3ce5525b7c
commit 455ba0e1b5
1 changed files with 24 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/mathlib/math/Functions.hpp
+24 -1
View File
@@ -54,7 +54,11 @@ int sign(T val)
/*
* So called exponential curve function implementation.
* It is essentially a linear combination between a linear and a cubic function.
* It's used in the range [-1,1]
* @param value [-1,1] input value to function
* @param e [0,1] function parameter to set ratio between linear and cubic shape
* 0 - pure linear function
* 1 - pure cubic function
* @return result of function output
*/
template<typename _Tp>
inline const _Tp expo(const _Tp &value, const _Tp &e)
@@ -63,6 +67,25 @@ inline const _Tp expo(const _Tp &value, const _Tp &e)
return (1 - e) * x + e * x * x * x;
}
/*
* So called SuperExpo function implementation.
* It is a 1/(1-x) function to further shape the rc input curve intuitively.
* I enhanced it compared to other implementations to keep the scale between [-1,1].
* @param value [-1,1] input value to function
* @param e [0,1] function parameter to set ratio between linear and cubic shape (see expo)
* @param g [0,1) function parameter to set SuperExpo shape
* 0 - pure expo function
* 0.99 - very strong bent curve, stays zero until maximum stick input
* 1 - DO NOT USE, division by zero on maxima
* @return result of function output
*/
template<typename _Tp>
inline const _Tp superexpo(const _Tp &value, const _Tp &e, const _Tp &g)
{
_Tp x = constrain(value, (_Tp) - 1, (_Tp)1);
return expo(x, e) * (1 - g) / (1 - fabsf(x) * g);
}
template<typename _Tp>
inline const _Tp deadzone(const _Tp &value, const _Tp &dz)
{