[19.6 Ground Combat] Pathfinding doesn't include rotating TU cost

[HenryBlatbugIII]

The pathfinding algorithm in the game does not take into account the TU cost of rotating when trying to find the shortest route. (But it does correctly calculate the TU cost of the path it chooses.) This is especially noticeable when the soldier has to walk past multiple obstacles. The automatically calculated route will often turn left and right multiple times, preferring to walk orthogonally before diagonally where possible. By manually plotting out the route with only one 45 degree turn, you can often arrive at your destination with a few more TUs remaining.

This should be fixable by implementing the pathfinding in three dimensions (x, y, direction) instead of two.