first version of position kalman filter (FilterPos)