Fix getJacobianModel and orocos script
Fix KukaKDL usage
Disconnect setJointImpedance

For debug purpose