Modify computed torque control algorithm
Modify computed torque control algorithm

Modify Coriolis compensation term.
KDL Coriolis term is not matrix but vector already multiplied by joint velocity.
CentroEPiaggio/kuka-lwr,carlosjoserg/kuka-lwr,carlosjoserg/kuka-lwr,CentroEPiaggio/kuka-lwr