/*
 * Copyright (C) 2019 by Multi-Tech Systems
 *
 * This file is part of libmts-io.
 *
 * libmts-io is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published by
 * the Free Software Foundation, either version 2 of the License, or
 * (at your option) any later version.
 *
 * libmts-io is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public License
 * along with libmts-io.  If not, see <http://www.gnu.org/licenses/>.
 *
 */


#include <mts/MTS_IO_EG95Radio.h>

#include <climits>

#include <mts/MTS_Logger.h>
#include <mts/MTS_Text.h>

using namespace MTS::IO;

const std::string EG95Radio::MODEL_NAME("EG95");

EG95Radio::EG95Radio(const std::string& sPort)
: QuectelRadio(MODEL_NAME, sPort)
{

}

EG95Radio::~EG95Radio() {

}

ICellularRadio::CODE EG95Radio::setRxDiversity(const Json::Value& jArgs) {
    /* Command string for EG95 radios:  AT+QCFG="diversity",(0-1) */
    if (jArgs["enabled"].asString() != "1" && jArgs["enabled"].asString() != "0") {
        return FAILURE;
    }
    std::string sCmd = "AT+QCFG=\"diversity\",";
    sCmd += jArgs["enabled"].asString();

    return sendBasicCommand(sCmd);
}

ICellularRadio::CODE EG95Radio::getSupportedCellularModes(CELLULAR_MODES &networks) {
    networks = static_cast<CELLULAR_MODES>(CELLULAR_MODE_2G | CELLULAR_MODE_3G | CELLULAR_MODE_4G);
    return SUCCESS;
}

ICellularRadio::CODE EG95Radio::setCellularMode(CELLULAR_MODES networks) {
    std::string prefNet;
    unsigned int prefOnly = 0, prefCount = 0;
    for (int i = sizeof(networks)*CHAR_BIT-1; i>=0; --i){
        switch (1<<i & networks) {
        case ICellularRadio::CELLULAR_MODE_2G: prefNet += "01"  ; prefOnly = 1; prefCount++; break;
        case ICellularRadio::CELLULAR_MODE_3G: prefNet += "0302"; prefOnly = 2; prefCount++; break;
        case ICellularRadio::CELLULAR_MODE_4G: prefNet += "04"  ; prefOnly = 3; prefCount++; break;
        }
    }

    std::string sCmd;
    if (prefCount == 1) { // *g-only
        sCmd = "AT+QCFG=\"nwscanmode\"," + std::to_string(prefOnly);
    } else { // preferred
        sCmd = "AT+QCFG=\"nwscanmode\",0";
    }
    std::string cmdResult = sendCommand(sCmd);
    if (cmdResult.find(ICellularRadio::RSP_OK) == std::string::npos) {
        printError("%s| AT+QCFG=\"nwscanmode\" returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), cmdResult.c_str());
        return FAILURE;
    }

    sCmd = "AT+QCFG=\"nwscanseq\"," + prefNet;
    cmdResult = sendCommand(sCmd);
    if (cmdResult.find(ICellularRadio::RSP_OK) == std::string::npos) {
        printError("%s| AT+QCFG=\"nwscanseq\" returned unexpected response: [%s][%s]", getName().c_str(), sCmd.c_str(), cmdResult.c_str());
        return FAILURE;
    }
    return SUCCESS;
}

ICellularRadio::REGISTRATION parseRegResponse(std::string sResult)
{
    size_t start = sResult.find(',');
    size_t stop = sResult.find(' ', start);
    std::string sRegStat = sResult.substr(start + 1, stop - start - 1);
    int32_t value;
    sscanf(sRegStat.c_str(), "%d", &value);

    return (ICellularRadio::REGISTRATION)value;
}

ICellularRadio::CODE EG95Radio::getRegistration(REGISTRATION& eRegistration) {
    std::string sCmd;
    std::string sResp;

    // On the EG95 we need to check CREG, CGREG, and CEREG for possible success.
    // Depending on the carrier, roaming, and some other factors the registration
    // will come back differently depending on the type of connection that is possible.

    sCmd = "AT+CREG?";
    sResp = "+CREG: ";
    std::string sResult = sendCommand(sCmd, DEFAULT_BAIL_STRINGS, 5000);
    if (sResult.find(sResp) == std::string::npos) {
        if(sResult.size() == 0) {
            printDebug("%s| Registration command returned no response: [EG95]");
        }
        printDebug("%s| Registration command returned unexpected response: [EG95]");
    }

    eRegistration = parseRegResponse(sResult);
    if (eRegistration == REGISTERED) {
    	return SUCCESS;
    }


    sCmd = "AT+CGREG?";
    sResp = "+CGREG: ";
    sResult = sendCommand(sCmd, DEFAULT_BAIL_STRINGS, 5000);
    if (sResult.find(sResp) == std::string::npos) {
        if(sResult.size() == 0) {
            printDebug("%s| Registration command returned no response: [EG95]");
        }
        printDebug("%s| Registration command returned unexpected response: [EG95]");
    }


    eRegistration = parseRegResponse(sResult);
    if (eRegistration == REGISTERED) {
    	return SUCCESS;
    }

    sCmd = "AT+CEREG?";
    sResp = "+CEREG: ";
    sResult = sendCommand(sCmd, DEFAULT_BAIL_STRINGS, 5000);
    if (sResult.find(sResp) == std::string::npos) {
        if(sResult.size() == 0) {
            printDebug("%s| Registration command returned no response: [EG95]");
            return NO_RESPONSE;
        }
        printDebug("%s| Registration command returned unexpected response: [EG95]");
        return FAILURE;
    }

    eRegistration = parseRegResponse(sResult);
    if (eRegistration == REGISTERED) {
    	return SUCCESS;
    }

    return SUCCESS;
}