Remove most contact points with Bob/C++