/*
 * 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;
}