Fixed a couple of bugs in the computation of visual servoing parameters.

Fixed a bug in the world to center of mass transformation.
Also a bug in the computation of the liner term of the QP.
Added the display of visual features real and predicted.