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;
}
