Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-20 06:45:14 +03:00
Code Issues Wiki Activity

rescale deadbanded values to original range (#6925)

Browse source
This commit is contained in:
Alexander van Saase 2021-05-11 16:11:03 +02:00 • committed by GitHub
parent 004b3eab7c
commit 11d543f950
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
6 changed files with 21 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

12
src/main/common/maths.c
View file

@ -142,6 +142,18 @@ int32_t applyDeadband(int32_t value, int32_t deadband)
return value;
}
int32_t applyDeadbandRescaled(int32_t value, int32_t deadband, int32_t min, int32_t max)
{
if (ABS(value) < deadband) {
value = 0;
} else if (value > 0) {
value = scaleRange(value - deadband, 0, max - deadband, 0, max);
} else if (value < 0) {
value = scaleRange(value + deadband, min + deadband, 0, min, 0);
}
return value;
}
int32_t constrain(int32_t amt, int32_t low, int32_t high)
{
if (amt < low)