Forgot to add Ki to steering PID
Added check for pathplan size to prevent seg fault in some circumstances. Dialed up Pgain for steering controller. 1 Obstacle is enabled. Simulation is disabled.