We found a problem with the velocity calculated by the trajectory optimization. The location of this bug starts from
https://github.com/edmundwsy/RO47005-PDM-Final/blob/1de0e3881e45259eec06f59941ca23651a6cb557/src/planner/traj_opt/src/corridor_minisnap.cpp#L146
to line 158.
I've fixed this bug in another private repo but not published yet.
We found a problem with the velocity calculated by the trajectory optimization. The location of this bug starts from
https://github.com/edmundwsy/RO47005-PDM-Final/blob/1de0e3881e45259eec06f59941ca23651a6cb557/src/planner/traj_opt/src/corridor_minisnap.cpp#L146
to line 158.
I've fixed this bug in another private repo but not published yet.