Add firmware G code support for pause, and message display

The method and gcode here worked to get close enough to level.

I usually do not use or need the automatic leveling feature.