Draft: Added allow lateral change to path control unit when routing

It was added a flag in follow route control strategy to indicate that the change lane is allowed or note when calculating the route given the waypoints