It finally worked! My problem was that the trigger for the camera and robots was triggering at the same time and it took a significant 900ms for the camera to process the picture, so ended up creating an array buffer and effectively 'moving' or delaying the trigger to the next, and then editing robot calibration and tracking distances back one flight and it finally worked
Thanks SkyeFire