add script for running traj opt with decreasing slack tol