feat(route_handler): add unit test for lane change related functions · autowarefoundation/autoware_universe@819f137