~aleteoryx/muditaos

ref: 97a2c8592674d5458a9caafd1d26f4185f9da13d muditaos/module-services/service-cellular/QMBNManager.cpp -rw-r--r-- 4.3 KiB
97a2c859 — Lefucjusz [MOS-1063] Fix device freeze after onboarding in Spanish 1 year, 9 months ago
                                                                                
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
// Copyright (c) 2017-2022, Mudita Sp. z.o.o. All rights reserved.
// For licensing, see https://github.com/mudita/MuditaOS/LICENSE.md

#include "QMBNManager.hpp"
#include <Utils.hpp>
#include "response.hpp"
#include <at/ATFactory.hpp>
#include <modem/mux/DLCChannel.h>

namespace at
{
    namespace response
    {
        bool parseQMBNCFGlist(const at::Result &resp, std::vector<at::response::qmbncfg::MBNConfig> &ret)
        {

            constexpr auto AT_QMBNCFGlist         = "+QMBNCFG: \"List\"";
            constexpr int QMBNCFGlist_TokensCount = 6;
            if (auto mtokens = at::response::getTokensForATResults(resp, AT_QMBNCFGlist); mtokens) {
                for (const auto &tokens : *mtokens) {
                    if (tokens.size() < QMBNCFGlist_TokensCount) {
                        return false;
                    }
                    at::response::qmbncfg::MBNConfig MBNCfg;
                    /// Omit index parameter
                    MBNCfg.selected  = utils::getNumericValue<unsigned short>(tokens[1]);
                    MBNCfg.activated = utils::getNumericValue<unsigned short>(tokens[2]);

                    MBNCfg.fileName = tokens[3];
                    utils::findAndReplaceAll(MBNCfg.fileName, at::response::StringDelimiter, "");
                    MBNCfg.version = tokens[4];
                    utils::findAndReplaceAll(MBNCfg.version, at::response::StringDelimiter, "");
                    MBNCfg.releaseDate = tokens[5];
                    utils::findAndReplaceAll(MBNCfg.releaseDate, at::response::StringDelimiter, "");

                    ret.push_back(MBNCfg);
                }
                return true; /// empty list no MBN files
            }
            return false;
        }

    } // namespace response
} // namespace at

at::Result::Code QMBNManager::list(std::vector<at::response::qmbncfg::MBNConfig> &ret)
{

    auto command = at::factory(at::AT::QMBNCFG) + "\"List\"";
    auto resp    = channel->cmd(command);
    if (resp.code != at::Result::Code::OK) {
        return resp.code;
    }
    return (at::response::parseQMBNCFGlist(resp, ret)) ? at::Result::Code::OK : at::Result::Code::ERROR;
}

at::Result::Code QMBNManager::select(const std::string &name)
{

    auto command = at::factory(at::AT::QMBNCFG) + "\"Select\",\"" + name + "\"";
    auto resp    = channel->cmd(command);
    return resp.code;
}

at::Result::Code QMBNManager::deactivate()
{
    auto command = at::factory(at::AT::QMBNCFG) + "\"Deactivate\"";
    auto resp    = channel->cmd(command);
    return resp.code;
}
at::Result::Code QMBNManager::setAutoSelect(at::response::qmbncfg::MBNAutoSelect value)
{
    auto command = at::factory(at::AT::QMBNCFG) + "\"autosel\"," + utils::to_string(static_cast<int>(value));
    auto resp    = channel->cmd(command);
    return resp.code;
}

at::Result::Code QMBNManager::writeNVByte(const std::string &nvfile, std::uint8_t byte)
{
    return writeNV(nvfile, utils::byteToHex<std::uint8_t>(byte));
}

at::Result::Code QMBNManager::writeNV(const std::string &nvfile, const std::string &hexvalue)
{
    auto command = at::factory(at::AT::QNVFW) + "\"" + nvfile + "\"," + hexvalue;
    auto resp    = channel->cmd(command);

    return resp.code;
}

at::Result::Code QMBNManager::readNVByte(const std::string &nvfile, std::uint8_t &byte)
{

    std::string buffer;
    auto result = readNV(nvfile, buffer);

    if (result == at::Result::Code::OK) {
        auto bytevec = utils::hexToBytes(buffer);
        if (bytevec.size() != 1)
            return at::Result::Code::ERROR;
        byte = bytevec[0];
    }

    return result;
}

bool parseQNVFR(const at::Result &resp, std::string &ret)
{

    const std::string_view AT_QNVFR = "+QNVFR:";
    if (auto tokens = at::response::getTokensForATCommand(resp, AT_QNVFR); tokens) {
        constexpr int QNVFR_TokensCount = 1;
        if ((*tokens).size() == QNVFR_TokensCount) {
            ret = (*tokens)[0];
            return true;
        }
    }
    return false;
}

at::Result::Code QMBNManager::readNV(const std::string &nvfile, std::string &hexret)
{

    auto command = at::factory(at::AT::QNVFR) + "\"" + nvfile + "\"";
    auto resp    = channel->cmd(command);

    if (resp.code == at::Result::Code::OK) {

        if (!parseQNVFR(resp, hexret)) {
            return at::Result::Code::ERROR;
        }
    }

    return resp.code;
}