Fix: recordreplay_planner index access error
Description
Fix vector access reported in #536 (closed)
Notes for Reviewer
As described in #536 (closed), the process dies when you record and publish the trajectory.
This MR can be tested on the LGSVL.
Checklist
Edited by takamasa horibe