- Revert clean-up changes (will introduce again later)

- Changed G29 P0 map to G33 P1 V3 gcode. Formerly used "enqueue" functions
  but changed to actually replace the command (in the command buffer) to
  guarantee that gcode executes ahead of the remaining commands in the
  command buffer.