conDisplacement function

Calculate net displacement from contacts