Managed to forget this (important) file before.
Fix right hand geometies in atlas_chull.urdf
Evaluate closest distance derivatives by body