Adds code to attempt to limit error from collisions: UNTESTED
Some tests to find there error in the autonomous. Still not found