Changed contact algorithm - still debugging