Writinig a python programm to get the goal data as [x, y, R, P, Y] and compare it to the actual position
of the robot, given as [x, y, R, P, Y]. Calculate the distance and angle between the robot position and the goal.
Max allowed difference can be set as parameters.
V 1.0.0:
- first push
See jerk_metrics-repo for further information about creating a new metrics and implementing the needed launch and xml files.