Cleaned code + pathfinding; adjusted Globals
Cleaned code; pathfinding; made differential_control