draw kalman filtered path