Fix bugs; some improvements. MarlinCmdG now works.
test-geom.py draws lines. robot_geom.py needs some calibration.

The lines are supposed to be straight, and x and y orthogonal, but they're not yet.
test-movez.py simple interactive pen drawer

Interactively finds the right z to draw with pen & draws a cross. Works (except x and y commands).