Collision avoidance complete.

Collision avoidance complete.
Certain cases where more than one obstacles are detected cause issues!!
Overall the system functions as expected in all four directions avoiding
obstacles to the left and right.