Testing the updated pose estimator from Kjeld