Files
MuditaOS/module-cellular/Modem/MuxChannel.cpp

106 lines
3.0 KiB
C++

/*
* @file MuxChannel.cpp
* @author Mateusz Piesta (mateusz.piesta@mudita.com)
* @date 24.06.19
* @brief
* @copyright Copyright (C) 2019 mudita.com
* @details
*/
#include "MuxChannel.hpp"
#include "GSM0710.hpp"
#include "MuxDaemon.hpp"
#include "NotificationMuxChannel.hpp"
#include "CommunicationMuxChannel.hpp"
void MuxChannelWorker(void *pvp) {
MuxChannel *inst = reinterpret_cast<MuxChannel *>(pvp);
while (1) {
MuxChannel::MuxChannelMsg *msgReceived = nullptr;
xQueueReceive(inst->workerQueueHandle, &msgReceived, portMAX_DELAY);
switch (inst->type) {
case MuxChannel::MuxChannelType::Notification: {
NotificationMuxChannel *muxChan = reinterpret_cast<NotificationMuxChannel *>(pvp);
muxChan->ParseInMessage(msgReceived);
}
break;
case MuxChannel::MuxChannelType ::Communication:{
CommunicationMuxChannel *muxChan = reinterpret_cast<CommunicationMuxChannel *>(pvp);
muxChan->ParseInMessage(msgReceived);
break;
}
default:
// The rest of mux channels aren't currently supported
inst->ParseInMessage(msgReceived);
break;
}
delete (msgReceived);
}
}
MuxChannel::MuxChannel(MuxDaemon *mux, uint32_t logicalNumber, MuxChannelType type, const char *name,
uint32_t stackSize, uint32_t queueSize) :
v24signals(
static_cast<int >(MuxDefines::GSM0710_SIGNAL_DV ) | static_cast<int >(MuxDefines::GSM0710_SIGNAL_RTR) |
static_cast<int >(MuxDefines::GSM0710_SIGNAL_RTC) | static_cast<int >(MuxDefines::GSM0710_EA)),
frameAllowed(1),
disc_ua_pending(0),
workerQueueSize(queueSize),
workerStackSize(stackSize),
state(State::Closed),
type(type),
name(name),
mux(mux){
}
MuxChannel::~MuxChannel() {
}
int MuxChannel::Open() {
workerQueueHandle = xQueueCreate(workerQueueSize, sizeof(MuxChannelMsg *));
xTaskCreate(MuxChannelWorker, (name + "_Worker").c_str(), workerStackSize / 4, this, 0, &workerHandle);
// Send virtual channel request frame to GSM modem
mux->WriteMuxFrame(GetChannelNumber(), NULL, 0, static_cast<unsigned char>(MuxDefines::GSM0710_TYPE_SABM) |
static_cast<unsigned char>(MuxDefines::GSM0710_PF));
return 0;
}
int MuxChannel::Close() {
vQueueDelete(workerQueueHandle);
vTaskDelete(workerHandle);
mux->WriteMuxFrame(GetChannelNumber(), mux->closeChannelCmd, sizeof(mux->closeChannelCmd),
static_cast<unsigned char>(MuxDefines::GSM0710_TYPE_UIH));
return 0;
}
int MuxChannel::DistributeMsg(uint8_t *data, size_t size) {
MuxChannelMsg *msg = new MuxChannelMsg(data, size);
xQueueSend(workerQueueHandle, &msg, 500);
return size;
}
int MuxChannel::ParseInMessage(MuxChannel::MuxChannelMsg *msg) {
LOG_FATAL((name + " received message: " + msg->m_data).c_str());
return 0;
}