Improve performances of QP solver

Allocate memory for singular value matrix once, rather than at each
cycle.
Print time taken by solver (2 ms) and by send of velocity commands to
the motors (9 ms).