~aleteoryx/muditaos

ref: a405cad694b867fcd2498984830bd97d4b9bde2f muditaos/module-cellular/modem/mux/CellularMuxData.cpp -rw-r--r-- 2.8 KiB
a405cad6 — Aleteoryx trim readme 8 days 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

// Copyright (c) 2017-2024, Mudita Sp. z.o.o. All rights reserved.
// For licensing, see https://github.com/mudita/MuditaOS/blob/master/LICENSE.md

#include "CellularMuxData.h"
#include "CellularMuxFrame.h"
#include <cassert>

CellularMuxData::CellularMuxData(DLCI_t DLCI,
                                 DLC_ESTABL_SystemParameters_t sysParams,
                                 const std::vector<uint8_t> &userData,
                                 bsp::Cellular *cellular)
{
    assert(cellular != nullptr);

    pvCellular = cellular;

    request(DLCI, sysParams, userData);
}
/**
 * @param DLCI
 * @param userData
 */
void CellularMuxData::request(DLCI_t DLCI,
                              DLC_ESTABL_SystemParameters_t sysParams,
                              const std::vector<uint8_t> &userData)
{
    /*
    TE sends AT command "ATI<CR>" through DLC 1
        TE→MS   F9 05 EF 09 41 54 49 0D 58 F9   UIH Frame
    MS feeds back through DLC 1
        TE←MS   F9 05 EF 09 41 54 49 0D 58 F9
                F9 05 EF 9B 0D 0A 53 49 4D 43
                4F 4D 5F 4C 74 64 0D 0A 53 49
                4D 43 4F 4D 5F 53 49 4D 33 30
                30 0D 0A 52 65 76 69 73 69 6F 6E
                3A 53 49 4D 33 30 30 4D 33 32 28
                53 50 41 4E 53 49 4F 4E 29 5F 56
                31 30 2E 30 2E 38 5F 42 55 49
                4C 44 30 33 0D 0A 0D 0A 47 F9   UIH Frame
*/
    auto constexpr maximumFrameLength = 127;
    CellularMuxFrame::frame_t frame;
    frame.Address = static_cast<uint8_t>(DLCI << 2) /*| (1 << 1)*/; // set C/R = 1 - command
    frame.Control = static_cast<uint8_t>(TypeOfFrame_e::UIH);

    if (userData.size() <= static_cast<size_t>(maximumFrameLength)) {
        frame.data = userData;
        CellularMuxFrame frame_c(frame);
        // UartSend(frame_c.getSerData().data(), frame_c.getSerData().size());
        pvCellular->write(static_cast<void *>(frame_c.getSerData().data()), frame_c.getSerData().size());
    }
    else { // if data size > max frame size
        int dataLeft   = userData.size();
        auto i         = userData.begin();
        uint32_t parts = userData.size() / maximumFrameLength + 1; // add reminder
        LOG_DEBUG("SENDING %" PRIu32 " parts", parts);

        while ((parts--) != 0u) {
            auto last  = i + (dataLeft <= maximumFrameLength ? dataLeft : maximumFrameLength); // distinguish reminder
            frame.data = std::vector<uint8_t>(i, last);
            i          = last;

            CellularMuxFrame frame_c(frame);
            pvCellular->write(static_cast<void *>(frame_c.getSerData().data()), frame_c.getSerData().size());
            dataLeft -= (dataLeft <= maximumFrameLength ? dataLeft : maximumFrameLength);
        }
    }
}

/**
 * @param DLCI
 * @param User_data
 */
void CellularMuxData::indication(DLCI_t DLCI, std::vector<uint8_t> User_data)
{}