Gcode by serial works but some bugs are still there