Use kukaKDL for the model
Add missing variable
Fix getSegmentJacobian