Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-15 20:35:33 +03:00
Code Issues Wiki Activity

Power 2 thrust compensation with 50% throttle compensation

Browse source 
^2 gain curve after discussions with Markus
Variable throttle compensation, more with higher TL for whoops
Calculator https://www.desmos.com/calculator/1rhq0pqoug
This commit is contained in:
ctzsnooze 2020-04-25 23:40:00 +10:00 • committed by mikeller
parent 596c21686c
commit 7cd83464d6
4 changed files with 7 additions and 10 deletions
Download patch file Download diff file Expand all files Collapse all files

2
src/main/cli/settings.c
View file

@ -1112,7 +1112,7 @@ const clivalue_t valueTable[] = {
#endif
#ifdef USE_THRUST_LINEARIZATION
{ "thrust_linear", VAR_UINT8 | MASTER_VALUE, .config.minmaxUnsigned = { 0, 100 }, PG_PID_PROFILE, offsetof(pidProfile_t, thrustLinearization) },
{ "thrust_linear", VAR_UINT8 | MASTER_VALUE, .config.minmaxUnsigned = { 0, 150 }, PG_PID_PROFILE, offsetof(pidProfile_t, thrustLinearization) },
#endif
#ifdef USE_AIRMODE_LPF
{ "transient_throttle_limit", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, 30 }, PG_PID_PROFILE, offsetof(pidProfile_t, transient_throttle_limit) },

9
src/main/flight/pid.c
View file

@ -290,7 +290,10 @@ void pidAcroTrainerInit(void)
float pidCompensateThrustLinearization(float throttle)
{
if (pidRuntime.thrustLinearization != 0.0f) {
throttle = throttle * (throttle * pidRuntime.thrustLinearization + 1.0f - pidRuntime.thrustLinearization);
// for whoops where a lot of TL is needed, allow more throttle boost
const float throttleCompensateAmount = (1.0f - 0.5f * thrustLinearization);
const float throttleReversed = (1.0f - throttle);
throttle /= 1.0f + throttleCompensateAmount * throttleReversed * throttleReversed * thrustLinearization;
}
return throttle;
}
@ -299,8 +302,8 @@ float pidApplyThrustLinearization(float motorOutput)
{
if (pidRuntime.thrustLinearization != 0.0f) {
if (motorOutput > 0.0f) {
motorOutput = sqrtf(motorOutput * pidRuntime.thrustLinearizationReciprocal +
pidRuntime.thrustLinearizationB * pidRuntime.thrustLinearizationB) - pidRuntime.thrustLinearizationB;
const float motorOutputReversed = (1.0f - motorOutput);
motorOutput *= 1.0f + motorOutputReversed * motorOutputReversed * thrustLinearization;
}
}
return motorOutput;

2
src/main/flight/pid.h
View file

@ -352,8 +352,6 @@ typedef struct pidRuntime_s {
#ifdef USE_THRUST_LINEARIZATION
float thrustLinearization;
float thrustLinearizationReciprocal;
float thrustLinearizationB;
#endif
#ifdef USE_AIRMODE_LPF

4
src/main/flight/pid_init.c
View file

@ -375,10 +375,6 @@ void pidInitConfig(const pidProfile_t *pidProfile)
#ifdef USE_THRUST_LINEARIZATION
pidRuntime.thrustLinearization = pidProfile->thrustLinearization / 100.0f;
if (pidRuntime.thrustLinearization != 0.0f) {
pidRuntime.thrustLinearizationReciprocal = 1.0f / pidRuntime.thrustLinearization;
pidRuntime.thrustLinearizationB = (1.0f - pidRuntime.thrustLinearization) / (2.0f * pidRuntime.thrustLinearization);
}
#endif
#if defined(USE_D_MIN)
for (int axis = FD_ROLL; axis <= FD_YAW; ++axis) {