Files
MuditaOS/module-cellular/Modem/ATParser.cpp
Adam Dobrowolski 2a57cfccd5 [EGD-2571] SendCommand commonized between ATparser and DLC_channel
* option to handle response based on OK/ERROR
* better return value - Response code & response values
* common parent for common behaviour (TODO add ->cmd(...) to mux channels)
* better logging
* small fixups
2020-02-18 07:39:16 +00:00

123 lines
3.4 KiB
C++

/*
* @file ATParser.cpp
* @author Mateusz Piesta (mateusz.piesta@mudita.com)
* @date 17.07.19
* @brief
* @copyright Copyright (C) 2019 mudita.com
* @details
*/
#include "ATParser.hpp"
#include "Service/Bus.hpp"
#include "bsp/cellular/bsp_cellular.hpp"
#include "service-cellular/messages/CellularMessage.hpp"
#include "ticks.hpp"
#include <Utils.hpp>
#include <utility>
#include <vector>
ATParser::ATParser(bsp::Cellular *cellular) : cellular(cellular) {
isInitialized = true;
}
/// plz see 12.7 summary of urc in documentation
std::vector<ATParser::Urc> ATParser::ParseURC() {
std::vector<ATParser::Urc> resp;
size_t maxPos = 0, pos = 0;
cpp_freertos::LockGuard lock(mutex);
std::vector<std::pair<std::string, ATParser::Urc>> vals = {
{"RDY", ATParser::Urc::MeInitializationSuccessful},
{"+CFUN: 1", ATParser::Urc::FullFuncionalityAvailable},
{"+CPIN: READY", ATParser::Urc::SimCardReady},
{"+QIND: SMS DONE", ATParser::Urc::SMSInitializationComplete},
{"+QIND: PB DONE", ATParser::Urc::PhonebookInitializationComplete},
};
for (const auto &el : vals)
{
pos = responseBuffer.find(el.first);
if (pos != std::string::npos)
{
resp.push_back(el.second);
maxPos = std::max(pos + el.first.length(), maxPos);
LOG_DEBUG(("[URC]: " + el.first).c_str());
}
}
// manage string buffer
if(maxPos == 0){
}
else if (responseBuffer.size() >= maxPos) {
responseBuffer.erase();
} else {
responseBuffer = responseBuffer.substr(maxPos);
}
return resp;
}
int ATParser::ProcessNewData(sys::Service *service) {
char rawBuffer[256] = {0};
LOG_DEBUG("Receiving data from ProcessNewData");
auto length = cellular->Read(rawBuffer, sizeof(rawBuffer));
{
cpp_freertos::LockGuard lock(mutex);
LOG_DEBUG("Appending %i bytes to responseBuffer[%d]: %s", length, responseBuffer.size(), responseBuffer);
responseBuffer.append(reinterpret_cast<char *>(rawBuffer), length);
}
auto ret = ParseURC();
if (blockedTaskHandle) {
xTaskNotifyGive(blockedTaskHandle);
}
else if (ret.size())
{
urcs.insert(std::end(urcs),std::begin(ret),std::end(ret));
// GSM modem is considered as fully operational when it outputs URCs specified below:
// 1) RDY
// 2) +CFUN: 1
// 3) +CPIN: READY
// 4) +QIND: SMS DONE
// 5) +QIND: PB DONE
if (urcs.size() == 5) {
cpp_freertos::LockGuard lock(mutex);
auto msg = std::make_shared<CellularNotificationMessage>(CellularNotificationMessage::Type::PowerUpProcedureComplete);
sys::Bus::SendMulticast(msg, sys::BusChannels::ServiceCellularNotifications, service);
LOG_DEBUG("[!!!] Fucking away data");
responseBuffer.erase();
urcs.clear();
}
}
return 1;
}
void ATParser::cmd_init()
{
cpp_freertos::LockGuard lock(mutex);
responseBuffer.erase();
}
void ATParser::cmd_send(std::string cmd)
{
cellular->Write((void *)cmd.c_str(), cmd.size());
}
std::vector<std::string> ATParser::cmd_receive()
{
cpp_freertos::LockGuard lock(mutex);
return utils::split(responseBuffer, "\r\n");
}
void ATParser::cmd_post()
{
cpp_freertos::LockGuard lock(mutex);
responseBuffer.erase(); // TODO:M.P is it okay to flush buffer here ?
}