Basic path finding
General Improvements