Now working with a new Calibration and able to track itself with two beakons