maj after pull
maj after pull
add constraints options in xml and optim
add cyclic motion
add jerk criteria
add ddq in optim constraint and modify jerk criteria
add cvs and modify criteria jerk and torquesquare