Added another variable for extra assurance that corners are found correctly, works on sim, but will probably need alteration for real robot