mathlib: added LowPassFilter2p object

used in gyro and accel drivers for better filtering
Enabled mathlib