Transform turn dimWeight into a MatrixXd.
Also avoid some allocation during Q and C computation.
Fix an error when taking back the short jacobian of a task.
Remove some allocation during constraint computation.
It appear that using a non diagonal weight matrix is a bad idea, so come back vector for dimWeight.