Null space gain automatically reduces when EE is close to solution. Removed original KDL calculations