Add the friction cone constraint to CoMPlanning. I must made some error somewhere in the code, now gurobi says it is infeasible