XYZ coordinates

[dkadish]

Create XYZ mapping system to shift coordinates to/from the 3-line coordinate system. Integrate with PID control (#3).