our admm implementation 1; add q and u in solver Not in Mantis or Panda