Finished (but not tested) relative marker transform calib. Finished observation update function.