Files
sbpl_lattice_planner/matlab/mprim/unicycle_highcost_5cm.mprim