1

- Fixed IK calculation (elbow was all wrong)
- added better debug output
- changed home position so I don't need switches
- added M1000-1002 D[1/-1] to jog motors

3mm wood is too thin.  ramping velocity would reduce swing caused by
momentum.