int RAMPSZStage::Home() { RAMPSHub* pHub = static_cast<RAMPSHub*>(GetParentHub()); pHub->PurgeComPortH(); int ret = pHub->SendCommand("G28 Z0"); if (ret != DEVICE_OK) { LogMessage("Homing command failed."); return ret; } std::string answer; ret = pHub->ReadResponse(answer, 50000); if (ret != DEVICE_OK) { LogMessage("error getting response to homing command."); return ret; } if (answer != "ok") { LogMessage("Homing command: expected ok."); return DEVICE_ERR; } return DEVICE_OK; }
int RAMPSZStage::SetAdapterOriginUm(double z) { RAMPSHub* pHub = static_cast<RAMPSHub*>(GetParentHub()); pHub->PurgeComPortH(); std::string xval = std::to_string((long double) z); std::string command = "G92 Z" + xval; int ret = pHub->SendCommand(command); if (ret != DEVICE_OK) { LogMessage("Origin command failed."); return ret; } std::string answer; ret = pHub->ReadResponse(answer); if (ret != DEVICE_OK) { LogMessage("error getting response to origin command."); return ret; } if (answer != "ok") { LogMessage("origin command: expected ok."); return DEVICE_ERR; } return DEVICE_OK; }