Interpolation implementation

Angular velocity
work on circle detection