Added displacement algorithm, rename and add test script.