change lanes maybe be easer/faster if the waypoints have one more dimension, be it a type within a type that defines the lane, or an Array that allows to use the current lane as one of the indicies.
If you keep it like this, where lane is a simple field in the type, you'd have to do a search for the right lane each time.
If you keep it like this, where lane is a simple field in the type, you'd have to do a search for the right lane each time.