Autonomous drive

Changed STOP to modify speed to 0
Autonomous drive

Introduced constants for proximity and only allowed to move forward if
proximity is less than maximum distance
Autonomous drive

Basic collision avoidance with added Moving Average for Ping data.