MTX-2891 mpower: 2-3-4g switch implementation for Telit

2 files changed, 142 insertions, 0 deletions

diff --git a/src/MTS_IO_QuectelRadio.cpp b/src/MTS_IO_QuectelRadio.cpp
index f3227a5..c603d08 100644
--- a/src/MTS_IO_QuectelRadio.cpp
+++ b/src/MTS_IO_QuectelRadio.cpp
@@ -610,3 +610,15 @@ ICellularRadio::CODE QuectelRadio::setRadioNetworkMode(RADIO_NETWORK_MODE mode)
     }
     return SUCCESS;
 }
+
+ICellularRadio::CODE QuectelRadio::getAvailablePreferredNetworks(PREFERRED_NETWORKS &networks) {
+    return SUCCESS;
+}
+
+ICellularRadio::CODE QuectelRadio::getPreferredNetworks(PREFERRED_NETWORKS &networks) {
+    return SUCCESS;
+}
+
+ICellularRadio::CODE QuectelRadio::setPreferredNetworks(PREFERRED_NETWORKS networks) {
+    return SUCCESS;
+}
diff --git a/src/MTS_IO_TelitRadio.cpp b/src/MTS_IO_TelitRadio.cpp
index 340c0ac..2750b98 100644
--- a/src/MTS_IO_TelitRadio.cpp
+++ b/src/MTS_IO_TelitRadio.cpp
@@ -546,6 +546,7 @@ ICellularRadio::CODE TelitRadio::getRadioNetworkMode(RADIO_NETWORK_MODE &mode)
         printDebug("%s| AT+WS46? returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), cmdResult.c_str());
         return FAILURE;
     }
+    // TODO: replace with MTS::Text::parse
     switch (stoi(MTS::Text::split(cmdResult, ':')[1])) {
     case 12: mode = ICellularRadio::RADIO_NETWORK_MODE_GSM_ONLY; break;
     case 22: mode = ICellularRadio::RADIO_NETWORK_MODE_UMTS_ONLY; break;
@@ -664,3 +665,132 @@ ICellularRadio::CODE TelitRadio::getSimLockAttempts(int& iAttemptsPin, int& iAtt
 
     return SUCCESS;
 }
+
+ICellularRadio::CODE TelitRadio::getAvailablePreferredNetworks(PREFERRED_NETWORKS &networks) {
+    networks = PREFERRED_NETWORK_NA;
+    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;
+    }
+
+    if (cmdResult.find('(') == std::string::npos) {
+        printDebug("AT+WS46: error responce %s", cmdResult.c_str());
+        return FAILURE;
+    }
+    std::string s = MTS::Text::split(cmdResult, '(')[1];
+    s = MTS::Text::split(s, ')')[0];
+    std::vector<std::string>v = MTS::Text::split(s, ',');
+    std::vector<int> m;
+    for(const auto &it : v)
+    {
+        if (it.find("-") != std::string::npos) {
+            const std::vector<std::string> &r = MTS::Text::split(it, "-");
+            int begin, end;
+            if ( ! MTS::Text::parse(begin, r[0]) || ! MTS::Text::parse(end, r[1])) {
+                printDebug("AT+WS46: error parsing network mode range: %s-%s", r[0].c_str(), r[1].c_str());
+                return FAILURE;
+            }
+            for (int i = begin; i<=end; ++i) {
+                m.push_back(i);
+                if (m.size()>1024)
+                    break;
+            }
+        } else {
+            int v;
+            if ( ! MTS::Text::parse(v, it)) {
+                printDebug("AT+WS46: error parsing network mode: %s", it.c_str());
+                return FAILURE;
+            }
+            m.push_back(v);
+        }
+    }
+    if (m.size()>1024) {
+        printDebug("AT+WS46: network modes count overflow, parsing error");
+        return FAILURE;
+    }
+
+    // Now m contains all network modes
+    for(const auto &it : m) {
+        networks = preferredNetwork(networks, it);
+    }
+
+    return SUCCESS;
+}
+
+ICellularRadio::CODE TelitRadio::getPreferredNetworks(PREFERRED_NETWORKS &networks) {
+    networks = PREFERRED_NETWORK_NA;
+    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;
+    }
+    int wds;
+    size_t cursor;
+    if (MTS::Text::parse(wds, MTS::Text::trim(MTS::Text::getLine(MTS::Text::split(cmdResult, ':')[1], 0, cursor)))) {
+        networks = preferredNetwork(networks, wds);
+        return SUCCESS;
+    }
+    return FAILURE;
+}
+
+ICellularRadio::CODE TelitRadio::setPreferredNetworks(PREFERRED_NETWORKS networks) {
+    int wds = 0;
+    // 3GPP TS 27.007
+    // https://portal.3gpp.org/desktopmodules/Specifications/SpecificationDetails.aspx?specificationId=1515
+    switch (static_cast<int>(networks)) {
+    case PREFERRED_NETWORK_2G                                                                     : wds = 12; break;
+	case                        PREFERRED_NETWORK_3G                                              : wds = 22; break;
+	case PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G                       : wds = 25; break;
+	case                                               PREFERRED_NETWORK_4G                       : wds = 28; break;
+	case PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G                                              : wds = 29; break;
+	case PREFERRED_NETWORK_2G |                        PREFERRED_NETWORK_4G                       : wds = 30; break;
+	case                        PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G                       : wds = 31; break;
+    case PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G: wds = 35; break;
+    case                                                                      PREFERRED_NETWORK_5G: wds = 36; break;
+    case                                               PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G: wds = 37; break;
+    case                        PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G: wds = 38; break;
+    case PREFERRED_NETWORK_2G                        | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G: wds = 39; break;
+    case                        PREFERRED_NETWORK_3G                        | PREFERRED_NETWORK_5G: wds = 40; break;
+    case PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G                        | PREFERRED_NETWORK_5G: wds = 41; break;
+    case PREFERRED_NETWORK_2G                                               | PREFERRED_NETWORK_5G: wds = 42; break;
+    }
+    std::string sCmd("AT+WS46=");
+    sCmd += std::to_string(wds);
+    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;
+}
+
+ICellularRadio::PREFERRED_NETWORKS TelitRadio::preferredNetwork(PREFERRED_NETWORKS prefNetwork, int wds)
+{
+	int result = prefNetwork;
+    // 3GPP TS 27.007
+    // https://portal.3gpp.org/desktopmodules/Specifications/SpecificationDetails.aspx?specificationId=1515
+	switch (wds) {
+	case 12: result |= PREFERRED_NETWORK_2G;                                                                      break;
+	case 22: result |=                        PREFERRED_NETWORK_3G;                                               break;
+	case 25: result |= PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G;                        break;
+	case 28: result |=                                               PREFERRED_NETWORK_4G;                        break;
+	case 29: result |= PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G;                                               break;
+	case 30: result |= PREFERRED_NETWORK_2G |                        PREFERRED_NETWORK_4G;                        break;
+	case 31: result |=                        PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G;                        break;
+    case 35: result |= PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G; break;
+    case 36: result |=                                                                      PREFERRED_NETWORK_5G; break;
+    case 37: result |=                                               PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G; break;
+    case 38: result |=                        PREFERRED_NETWORK_3G | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G; break;
+    case 39: result |= PREFERRED_NETWORK_2G                        | PREFERRED_NETWORK_4G | PREFERRED_NETWORK_5G; break;
+    case 40: result |=                        PREFERRED_NETWORK_3G                        | PREFERRED_NETWORK_5G; break;
+    case 41: result |= PREFERRED_NETWORK_2G | PREFERRED_NETWORK_3G                        | PREFERRED_NETWORK_5G; break;
+    case 42: result |= PREFERRED_NETWORK_2G                                               | PREFERRED_NETWORK_5G; break;
+	default:
+		printDebug("AT+WS46: unhandled network mode: %d", wds);
+		break;
+	}
+	return static_cast<PREFERRED_NETWORKS>(result);
+}