Basic Algorithms for obstacle detection and avoidance for the automated platform

Summary
Basic Algorithms for obstacle detection and avoidance for the automated platform