Implemented steering, still have to adjust waypoints to stick to a lane