Automatic window size for sliding window filtering + Possibility to filter...

Automatic window size for sliding window filtering + Possibility to filter angular velocity (off for now) + v_filt_bis_ is now of size 6 to handle angular part