Parsing commands is ok, we can control the CNC via serial now