code works on test.gcode but not on 5mm cube