Added gcode for utilities and fixed encoder direction