added IMU data filtering + angle calculation