Made several small modifications to aid in beginning path finding.