Add punch detection

[FlorisVideler]

Priority: [ 2]
Time estimation: [6 ]

Description:
The dodge algoritm currently has a detection every half a second. This costs a lot of unnecessary calculation time.
So we need to add an algoritm that detects a punch, if so then he can calculate the trajectory.

Tasks:

• Determine distance between points and print if this distance is long #146
• The calculation of trajectory only works when distance is long #147

Definition of Done:
The program detects punches only when the distance is long enough