Motion Change

Improved motion algorithm to be checking for euclidean distance first
rather than angle