Path boundary

[LebronRemonJames]

Have you consider using precise path boundary , using four circles substitute for vehicle body may reduce the solution space ?

[LiJiangnanBit]

Indeed. But it's simpler :)