Equations to find x and y velocity at points
Displacement equation added