perf: Improvements in lane related controllers

This MR improves lane related controllers by removing 2D assumptions hence they can now be used on roads which are banked or pitched

it also removes duplicate code as planned from lane location provider -> Please refer this conversation : !253 (comment 4054116)