Merge branch 'MTX-2891-mpower-2g-3g-4g' into 'master'

Mtx 2891 mpower 2g 3g 4g

See merge request !2

1 files changed, 28 insertions, 0 deletions

diff --git a/src/MTS_IO_CellularRadio.cpp b/src/MTS_IO_CellularRadio.cpp
index 3f0c037..6df92e0 100644
--- a/src/MTS_IO_CellularRadio.cpp
+++ b/src/MTS_IO_CellularRadio.cpp
@@ -770,6 +770,34 @@ ICellularRadio::CODE CellularRadio::getRegistration(REGISTRATION& eRegistration)
     return SUCCESS;
 }
 
+ICellularRadio::CODE CellularRadio::getCellularMode(CELLULAR_MODES &networks) {
+    networks = CELLULAR_MODE_NA;
+    std::string cmdResult = sendCommand("AT+COPS?");
+    if (cmdResult.find(ICellularRadio::RSP_OK) == std::string::npos) {
+        printError("%s| AT+COPS returned unexpected response: AT+COPS? [%s]", getName().c_str(), cmdResult.c_str());
+        return FAILURE;
+    }
+
+    size_t cursor = 0;
+    const std::vector<std::string> &reply = MTS::Text::split(MTS::Text::getLine(MTS::Text::trim(cmdResult), cursor, cursor), ',');
+    uint8_t op;
+    if (reply.size() < 4 || !MTS::Text::parse(op, reply[3])) {
+        printError("%s| AT+COPS Error parsing reply [AT+COPS?][%s]", getName().c_str(), cmdResult.c_str());
+        return FAILURE;
+    }
+    if (op == 0) {
+        networks = CELLULAR_MODE_2G;
+    } else if (op >= 2 && op <= 6) {
+        networks = CELLULAR_MODE_3G;
+    } else if (op == 7) {
+        networks = CELLULAR_MODE_4G;
+    } else {
+        printError("%s| AT+COPS unknown Radio Access Technology [AT+COPS?][%s]", getName().c_str(), cmdResult.c_str());
+        return FAILURE;
+    }
+    return SUCCESS;
+}
+
 ICellularRadio::CODE CellularRadio::convertRegistrationToString(REGISTRATION eRegistration, std::string& sRegistration) {
 
     ICellularRadio::CODE eCode = FAILURE;