[TB] Develop the calculation function (for Worker module)

[UmangBR]

User story

1. As a SD
2. I want to develop the calculation function
3. So that I can calculate the direction and speed for the robot to reach the destination.

Acceptance criteria

• Calculate the direction and speed for the robot to reach the destination.

Definition of done (DoD)

• Linter & Checker were performed and passed
• Code Review has been completed
• Code was merged in sprint release candidate
• Updates are written in issue comments
• Feature builds and tests successfully
• Acceptance by product owner
• User Story & Acceptance Criteria fulfilled

DoD general criteria

• Feature has been fully implemented
• Feature has been merged into the mainline
• All acceptance criteria were met
• Product owner approved features
• All tests are passing
• Developers agreed to release

[nmarkert]

For now

Implemented the calculate_direction function in the worker node on the Turtlebot, so that it takes two points (tuples of x- and y- Coordinate) of the current position of the robot and the destination to drive and outputs the direction in which the destination lies.

For the future

• It has to be specified how exactly the output of this function should look like. Now it returns int values from ]-180000,180000] representing the direction in milli-degrees. This matches the heading values given from the SICK software. But it has to be researched which direction a degree of 0 would mean
• Maybe this function needs some more functionality (or other functions have to be implemented), but this depends on how the Driver Segment works and which information it needs