https://github.com/SYSU-STAR/REMANI-Planner/blob/9c3b3e37cc11859738d08b0154f011840d52c50e/remani_planner/traj_opt/include/optimizer/poly_traj_optimizer.hpp#L34C1-L35C1 Why the dimension of ConstrainPoints is 3 x size_set but not 8 x size_set ?