remove old trajOpt during addpath_drake