rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

OSD G-force - requested changes

This commit is contained in:
leocb 2018-06-28 11:32:37 -03:00
parent e2eca1b762
commit 0ab2638b31
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/main/io/osd.c
View File

@ -46,6 +46,7 @@
#include "cms/cms.h" #include "cms/cms.h"
#include "cms/cms_types.h" #include "cms/cms_types.h"
#include "common/axis.h"
#include "common/maths.h" #include "common/maths.h"
#include "common/printf.h" #include "common/printf.h"
#include "common/typeconversion.h" #include "common/typeconversion.h"
@ -691,12 +692,12 @@ static bool osdDrawSingleElement(uint8_t item)
case OSD_G_FORCE: case OSD_G_FORCE:
{ {
float osdGForce = 0; float osdGForce = 0;
for (int axis = 0; axis < 3; axis++) { for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) {
const float a = accAverage[axis]; const float a = accAverage[axis];
osdGForce += a * a; osdGForce += a * a;
} }
osdGForce = sqrtf(osdGForce) / acc.dev.acc_1G * 10; osdGForce = pow_approx(osdGForce, 0.5) / acc.dev.acc_1G * 10;
tfp_sprintf(buff, "%01d.%01d%c", (uint8_t)osdGForce / 10, (uint8_t)osdGForce % 10, "G"); tfp_sprintf(buff, "%01d.%01d%c", osdGForce / 10, osdGForce % 10, "G");
break; break;
} }