First implementation of QP to compute contact forces, to be tested yet