Added low pass filter, updated the azmuth, pitch and roll.