stable config with KDL as kinematic