Fixed issues with stereo localisation, namely position shift, changed coords to vector and accessed directly, fixed optitrack coords