The robot can now finish correctly
*Removed time delay before turn
*Added a sensor delay instead,
it works much better