habdec/code/Decoder/sentence_extract.cpp

71 wiersze
1.8 KiB
C++

/*
Copyright 2018 Michal Fratczak
This file is part of habdec.
habdec is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
habdec 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 General Public License for more details.
You should have received a copy of the GNU General Public License
along with habdec. If not, see <https://www.gnu.org/licenses/>.
*/
#include "sentence_extract.h"
#include <iostream>
namespace habdec
{
std::regex HABHUB_REGEX( R"_(.*?(\$+)([\w,\-]+?),(.+?)(\*|\$)(\w\w\w\w).*)_" );
std::map<std::string,std::string> extractSentence(std::string stream)
{
using namespace std;
// replace '\n' in stream with spaces, otherwise regex will fail (C++ 11 issue)
replace( stream.begin(), stream.end(), '\n', ' ');
map<string,string> result;
result["success"] = string("ERR");
const int CRC_LEN = 4; // usually 4 chars after *
if(stream.find("*") < string::npos-CRC_LEN)
{
smatch match;
regex_match(stream, match, HABHUB_REGEX);
if(match.size() >= 5)
{
const string callsign = match[2];
const string data = match[3];
const string data_end = match[4]; // * or another $
const string _crc = match[5];
const size_t cut = min( stream.size(), size_t(match.position(4)+CRC_LEN) );
stream = stream.substr( cut );
result["success"] = string("OK");
result["callsign"] = callsign;
result["data"] = data;
result["crc"] = _crc;
result["stream"] = stream;
}
}
return result;
}
} // namespace habdec