templated pose measurement on its auxiliary states

camera-imu calibration, world-vision frame and scale are now template parameters, such that we can use the pose measurement implementation for multiple measurements, incorporating the correct aux states.
Templates have default parameters, therefore the current implementation shouldn't be affected. Compiles, but still needs to be tested.