Fixes lane change bug
Refactored the lane change algorithm to fix the lane change/cam rotation bug!