RobotLogic updated

- Absolute value on angle
- mapRoute updated: distance to in point calculated