Add joint bounds limitation for gradient and generated config,
Remove condition that prevented pathV definition,
Update coef (more ballance between gradients),
Correct spelling in KDTree