Merge branch 'mtr-mtq-sim-status' into quectel-radio

1 files changed, 91 insertions, 0 deletions

diff --git a/src/MTS_IO_TelitRadio.cpp b/src/MTS_IO_TelitRadio.cpp
index 7b5b18b..2d0422d 100644
--- a/src/MTS_IO_TelitRadio.cpp
+++ b/src/MTS_IO_TelitRadio.cpp
@@ -573,3 +573,94 @@ ICellularRadio::CODE TelitRadio::setRadioMode(RADIOMODE mode)
     }
     return SUCCESS;
 }
+
+CellularRadio::CODE TelitRadio::getIsSimInserted(bool& bData) {
+    printTrace("%s| Get SIM insertion status", getName().c_str());
+    std::string sCmd("AT#SIMDET?");
+    std::string sResult = sendCommand(sCmd);
+
+    const std::string sPrefix = "#SIMDET: ";
+    size_t start = sResult.find(sPrefix);
+    size_t end = sResult.rfind(ICellularRadio::RSP_OK);
+
+    if (end == std::string::npos) {
+        printWarning("%s| Unable to get SIM insertion status from radio using command [%s]", getName().c_str(), sCmd.c_str());
+        return FAILURE;
+    }
+
+    if (start == std::string::npos) {
+        printDebug("%s| AT#SIMDET? returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), sResult.c_str());
+        return FAILURE;
+    }
+
+    // #SIMDET: <mode>,<simin>
+    start += sPrefix.size();
+    std::vector<std::string> vParts = MTS::Text::split(MTS::Text::trim(sResult.substr(start, end-start)), ',');
+
+    if(vParts.size() != 2) {
+        printWarning("%s| Unable to parse SIM insertion status from response [%s]", getName().c_str(), sResult.c_str());
+        return FAILURE;
+    }
+
+    if (vParts[1] == "1") { // <simin>
+        bData = true;
+    } else {
+        bData = false;
+    }
+
+    return SUCCESS;
+}
+
+CellularRadio::CODE TelitRadio::getSimLockAttempts(int& iAttemptsPin, int& iAttemptsPuk) {
+    std::string sLockStatus;
+    CODE retCode;
+
+    retCode = getSimLockStatus(sLockStatus);
+    if (retCode != SUCCESS) {
+        printWarning("%s| Unable determine the number of SIM unlock attempts: SIM lock status is unavailable [%s]", getName().c_str(), sLockStatus.c_str());
+        return retCode;
+    }
+
+    return getSimLockAttempts(iAttemptsPin, iAttemptsPuk, sLockStatus);
+}
+
+CellularRadio::CODE TelitRadio::getSimLockAttempts(int& iAttemptsPin, int& iAttemptsPuk, const std::string& sLockStatus) {
+    printTrace("%s| Get SIM unlock attempts left", getName().c_str());
+    std::string sCmd("AT#PCT");
+    std::string sResult = sendCommand(sCmd);
+    std::string sValue;
+    int iValue;
+
+    const std::string sPrefix = "#PCT: ";
+    size_t start = sResult.find(sPrefix);
+    size_t end = sResult.rfind(ICellularRadio::RSP_OK);
+
+    if (end == std::string::npos) {
+        printWarning("%s| Unable to get SIM unlock attempts from radio using command [%s]", getName().c_str(), sCmd.c_str());
+        return FAILURE;
+    }
+
+    if (start == std::string::npos) {
+        printDebug("%s| AT#PCT? returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), sResult.c_str());
+        return FAILURE;
+    }
+
+    // #PCT: <n>
+    start += sPrefix.size();
+    sValue = MTS::Text::trim(sResult.substr(start, end-start));
+
+    if (!MTS::Text::parse(iValue, sValue)) {
+        printWarning("%s| Unable to parse SIM unlock attempts from response [%s]", getName().c_str(), sResult.c_str());
+        return FAILURE;
+    }
+
+    if (sLockStatus == "READY" || sLockStatus == "SIM PIN") {
+        iAttemptsPin = iValue;  // Some PIN attempts left, maximum PUK attempts left
+        iAttemptsPuk = 10;
+    } else {
+        iAttemptsPin = 0;  // No PIN attempts left
+        iAttemptsPuk = iValue;
+    }
+
+    return SUCCESS;
+}