sandbox for checking that pose compositions are correct
added coordinate trasformation (without optimizing the state). Offline estimate is good, but online isn't