EmaMaker
/
SPQR-Team-2019-REVAMPED
1
1
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

camera: filter fixed angles too

pull/2/head
emamaker 2022-07-07 22:02:20 +02:00
parent f10268aa6d
commit 1508853ebb
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/sensors/data_source_camera_conicmirror.cpp
View File

@ -100,6 +100,13 @@ void DataSourceCameraConic ::computeCoordsAngles()
yangle_fix = (yangle + tmp + 360) % 360;
bangle_fix = (bangle + tmp + 360) % 360;
#ifdef CAMERA_CONIC_FILTER_POINTS
if (CURRENT_DATA_WRITE.ySeen)
yangle_fix = filt_yangle_fix->calculate(yangle_fix);
if (CURRENT_DATA_WRITE.bSeen)
bangle_fix = filt_bangle_fix->calculate(bangle_fix);
#endif
// TODO: Maybe add a complementary filter on fixed angles ?
// Important: update status vector