reenable ik amp dist threshold
formatting
Merge branch 'groovy' of https://github.com/aurone/sbpl_manipulation into groovy