Map image to real-world coordinates

**Description: **Implement transformation from pixel space to robot-relative space.

User Story: As a roboticist, I want to convert image coordinates to real-world positions, so the robot can move accordingly.

DoR: Image coordinates available

DoD: Transformation function tested

Acceptance Criteria: Mapping error < 5%