Added integration method support to contact traj opt, updated brick test case.