har med kalmanfiltrering
fungerer greit