Collision Correction

[Ayidana-Aboraah]

When the robot collides during an autonomous path, allow the robot to adjust the path to reach the intended point.

• [ ] collision detection
• [ ] on the fly path correction
• [ ] following newly generated path

Maybe allow this to be done with cone-cube tracking as well.