Add some code for confuration registers and gcode buffer