1 files changed, 36 insertions, 0 deletions
diff --git a/src/MTS_IO_TelitRadio.cpp b/src/MTS_IO_TelitRadio.cpp
index ae885e9..2d0422d 100644
--- a/src/MTS_IO_TelitRadio.cpp
+++ b/src/MTS_IO_TelitRadio.cpp
@@ -538,6 +538,42 @@ bool TelitRadio::getHardwareVersionFromFirmware(const std::string& sFirmware, st
 
 }
 
+ICellularRadio::CODE TelitRadio::getRadioMode(RADIOMODE &mode)
+{
+    std::string sCmd("AT+WS46?");
+    std::string cmdResult = sendCommand(sCmd);
+    if (cmdResult.find("+WS46:") == std::string::npos) {
+        printDebug("%s| AT+WS46? returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), cmdResult.c_str());
+        return FAILURE;
+    }
+    switch (stoi(MTS::Text::split(cmdResult, ':')[1])) {
+    case 12: mode = ICellularRadio::RADIOMODE_GSM_ONLY; break;
+    case 22: mode = ICellularRadio::RADIOMODE_UMTS_ONLY; break;
+    case 25: mode = ICellularRadio::RADIOMODE_AUTO; break;
+    default: mode = ICellularRadio::RADIOMODE_UNKNOWN; break;
+    }
+    return SUCCESS;
+}
+
+ICellularRadio::CODE TelitRadio::setRadioMode(RADIOMODE mode)
+{
+    std::string value;
+    switch (mode) {
+    case ICellularRadio::RADIOMODE_GSM_ONLY: value = "12"; break;
+    case ICellularRadio::RADIOMODE_UMTS_ONLY: value = "22"; break;
+    case ICellularRadio::RADIOMODE_AUTO: value = "25"; break;
+    default: return FAILURE;
+    }
+    std::string sCmd("AT+WS46=");
+    sCmd += value;
+    std::string cmdResult = sendCommand(sCmd);
+    if (cmdResult.find(ICellularRadio::RSP_OK) == std::string::npos) {
+        printDebug("%s| AT+WS46? returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), cmdResult.c_str());
+        return FAILURE;
+    }
+    return SUCCESS;
+}
+
 CellularRadio::CODE TelitRadio::getIsSimInserted(bool& bData) {
     printTrace("%s| Get SIM insertion status", getName().c_str());
     std::string sCmd("AT#SIMDET?");