M42 implementation in Repetier-Firmware