Clone ContactImplicitTrajOpt
Initial bullet try