first working version of local transform, based on the perfect odometry assumption (only works in simulation)