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

Fixed point math Implementation instead of floats

Browse source
This commit is contained in:
borisbstyle 2016-02-18 00:25:44 +01:00
parent 5435fd0cb7
commit 7fd88f060d
8 changed files with 82 additions and 37 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -337,3 +337,16 @@ void arraySubInt32(int32_t *dest, int32_t *array1, int32_t *array2, int count)
dest[i] = array1[i] - array2[i];
}
}
int16_t qPercent(q_number_t q) {
return 100 * q.num / q.den;
}
int16_t qMultiply(q_number_t q, int16_t input) {
return input * q.num / q.den;
}
void qConstruct(q_number_t *qNumber, int16_t num, int16_t den, int qType) {
qNumber->num = (1 << qType) / den;
qNumber->den = (1 << qType) / num;
}