ALMATH: fix warning compilation

Change-Id: I00317f69be61026c3f9d24db1bffb487d41b8f7f
Merge remote-tracking branch 'origin/master' into team/agility/dev
ALMATH: add applyThreshold function
(remove from almathinternal applyThreshold and computeThreshold)

Change-Id: I53e25ab3568f55f9a05c42514220845596783d84
Revert "ALMATH: add applyThreshold function"

This reverts commit cebbbc0f3999638b7a63fd2677cfc87654c9727a.
ALMATH: optimize Position3D

Change-Id: I62d76ce4df4f9f77d0618f6b7cfdb4f8eda4ef31
ALMATH: optimize type

Change-Id: Ib76a610081d7e51e262428ef46418acd91678c25
import digitalfilter and pidcontroller

Change-Id: Icd7a63d2066a8029c20ca19dcb35a6380be96927
Merge commit 'refs/integration/team/agility/dev-18'