Updated sensor filtering code
Fixed orientation filtering and quaternion conversion