Basic auto functions

Added the basic autonomous utility functions. Also added a battery level
check, and implemented the collision avoidance.