Fix lattice planner segmentation fault#9

AlexisTM wants to merge 1 commit into

onlytailei:masteronlytailei/CppRobotics:masterfrom

AlexisTM:fix/state_lattice_planner_segmentation_faultCopy head branch name to clipboard