get contact points from mesh
add arm/leg group (for FTR cost)