added comparison code, implemented lipshitz bounds, sped up contact points