Follow path logic improvements/rewrite

[pliam1105]

Switch to finding the line of green buoys & the line of red buoys (removing outliers) & then finding the midline (maybe as a spline, or just split the path into triangles & take midpoints of the inside edges like Motorsports does).