Less stupid path intercept system

Doesn't require going point 1->2->3->4 etc. Just picks the nearest one.