Fixes and improvements
Merge branch 'digital_output_control' into rygy_custom

Conflicts:
	dio_control.c
	gcode.c
	protocol.c