21#include "cc_tools_qt/ToolsExtraInfoMessage.h"
22#include "cc_tools_qt/ToolsFrameCommon.h"
23#include "cc_tools_qt/ToolsInvalidMessage.h"
24#include "cc_tools_qt/ToolsRawDataMessage.h"
25#include "cc_tools_qt/property/message.h"
27#include <QtCore/QJsonObject>
28#include <QtCore/QJsonDocument>
29#include <QtCore/QByteArray>
39template <
typename TMsgBase,
class TProtFrame,
typename TMsgFactory,
typename TTransportMsg>
40class ToolsFrameBase :
public ToolsFrameCommon<TMsgBase>
42 using Base = ToolsFrameCommon<TMsgBase>;
44 using ProtInterface =
typename Base::ProtInterface;
45 using DataSeq =
typename Base::DataSeq;
47 using TransportMsg = TTransportMsg;
50 using InvalidMsg = ToolsInvalidMessage<TMsgBase>;
52 using RawDataMsg = ToolsRawDataMessage<TMsgBase>;
55 using ExtraInfoMsg = ToolsExtraInfoMessage<TMsgBase>;
57 using ProtFrame = TProtFrame;
59 ToolsFrameBase() =
default;
62 virtual ToolsMessagesList readDataImpl(
const ToolsDataInfo& dataInfo,
bool final)
override
64 m_inData.reserve(m_inData.size() + dataInfo.m_data.size());
65 m_inData.insert(m_inData.end(), dataInfo.m_data.begin(), dataInfo.m_data.end());
67 ToolsMessagesList allMsgs;
68 std::size_t consumed = 0U;
70 auto checkGarbageFunc =
73 if (m_garbage.empty()) {
78 updateRawDataInternal(m_garbage, *invalidMsgPtr);
79 allMsgs.push_back(std::move(invalidMsgPtr));
84 using ProtMsgPtr =
typename ProtFrame::MsgPtr;
85 using ReadIter =
typename ProtInterface::ReadIterator;
86 while (consumed < m_inData.size()) {
89 ReadIter readIterBeg = m_inData.data() + consumed;
90 ReadIter readIter = readIterBeg;
91 auto remLen = m_inData.size() - consumed;
101 comms::protocol::msgId(msgId),
102 comms::protocol::msgIndex(idx));
104 if (es == comms::ErrorStatus::NotEnoughData) {
108 if (es == comms::ErrorStatus::MsgAllocFailure) {
109 [[maybe_unused]]
static constexpr bool Must_not_be_happen =
false;
110 assert(Must_not_be_happen);
114 if (es != comms::ErrorStatus::Success) {
115 m_garbage.push_back(*readIterBeg);
116 static constexpr std::size_t GarbageLimit = 512;
117 if (GarbageLimit <= m_garbage.size()) {
127 auto diff =
static_cast<std::size_t
>(std::distance(readIterBeg, readIter));
130 auto toolsMsg = m_factory.createMessage(msgId,
static_cast<unsigned>(idx));
132 [[maybe_unused]]
static constexpr bool Protocol_and_Tools_Frames_Out_of_Sync =
false;
133 assert(Protocol_and_Tools_Frames_Out_of_Sync);
135 m_garbage.reserve(m_garbage.size() + diff);
136 m_garbage.insert(m_garbage.end(), readIterBeg, readIter);
141 toolsMsg->assignProtMessage(msgPtr.get());
143 DataSeq data(readIterBeg, readIter);
144 updateTransportInternal(data, *toolsMsg);
145 updateRawDataInternal(data, *toolsMsg);
146 allMsgs.push_back(std::move(toolsMsg));
149 static_cast<void>(
final);
151 assert(consumed <= m_inData.size());
152 m_inData.erase(m_inData.begin(), m_inData.begin() + consumed);
154 if (
final && (!m_inData.empty())) {
155 m_garbage.reserve(m_garbage.size() + m_inData.size());
156 m_garbage.insert(m_garbage.end(), m_inData.begin(), m_inData.end());
161 if (!dataInfo.m_extraProperties.isEmpty()) {
162 auto jsonObj = QJsonObject::fromVariantMap(dataInfo.m_extraProperties);
163 QJsonDocument doc(jsonObj);
164 auto jsonData = doc.toJson();
165 DataSeq jsonRawBytes(jsonData.begin(), jsonData.end());
167 for (
auto& m : allMsgs) {
168 property::message::ToolsMsgExtraInfo().setTo(dataInfo.m_extraProperties, *m);
169 updateExtraInfoInternal(jsonRawBytes, *m);
176 virtual void updateMessageImpl(ToolsMessage& msg)
override
178 auto data = msg.encodeFramed(*
this);
179 updateTransportInternal(data, msg);
180 updateRawDataInternal(data, msg);
182 auto extraProps = property::message::ToolsMsgExtraInfo().getFrom(msg);
183 bool extraInfoMsgIsForced = property::message::ToolsMsgForceExtraInfoExistence().getFrom(msg);
184 if (extraProps.isEmpty() && (!extraInfoMsgIsForced)) {
185 property::message::ToolsMsgExtraInfoMsg().setTo(
ToolsMessagePtr(), msg);
189 auto extraInfoMsgPtr = std::make_unique<ExtraInfoMsg>();
190 if (extraProps.isEmpty()) {
191 property::message::ToolsMsgExtraInfoMsg().setTo(
ToolsMessagePtr(extraInfoMsgPtr.release()), msg);
195 auto jsonObj = QJsonObject::fromVariantMap(extraProps);
196 QJsonDocument doc(jsonObj);
197 auto jsonData = doc.toJson();
198 DataSeq jsonRawBytes(jsonData.begin(), jsonData.end());
199 updateExtraInfoInternal(jsonRawBytes, msg);
217 virtual ToolsMessagesList createAllMessagesImpl()
override
219 return m_factory.createAllMessages();
222 virtual ToolsMessagePtr createMessageImpl(
const QString& idAsString,
unsigned idx)
override
224 return m_factory.createMessage(idAsString, idx);
227 virtual DataSeq writeProtMsgImpl(
const ProtInterface& msg)
override
230 data.reserve(m_frame.length(msg));
232 auto writeIter = std::back_inserter(data);
233 auto es = m_frame.write(msg, writeIter, data.max_size());
234 if (es == comms::ErrorStatus::UpdateRequired) {
235 auto updateIter = data.data();
236 es = m_frame.update(msg, updateIter, data.size());
239 if (es != comms::ErrorStatus::Success) {
240 [[maybe_unused]]
static constexpr bool Unexpected_write_update_failure =
false;
241 assert(Unexpected_write_update_failure);
249 void updateTransportInternal(
const DataSeq& data, ToolsMessage& msg)
252 if (!transportMsg->decodeData(data)) {
253 std::cerr <<
"ERROR: Failed to decode transport message: " << std::hex;
254 std::copy(data.begin(), data.end(), std::ostream_iterator<unsigned>(std::cerr,
" "));
255 std::cerr << std::dec << std::endl;
257 [[maybe_unused]]
static constexpr bool Must_not_be_happen =
false;
258 assert(Must_not_be_happen);
261 property::message::ToolsMsgTransportMsg().setTo(std::move(transportMsg), msg);
264 void updateRawDataInternal(
const DataSeq& data, ToolsMessage& msg)
267 if (!rawDataMsg->decodeData(data)) {
268 std::cerr <<
"ERROR: Failed to decode raw data message: " << std::hex;
269 std::copy(data.begin(), data.end(), std::ostream_iterator<unsigned>(std::cerr,
" "));
270 std::cerr << std::dec << std::endl;
272 [[maybe_unused]]
static constexpr bool Must_not_be_happen =
false;
273 assert(Must_not_be_happen);
276 property::message::ToolsMsgRawDataMsg().setTo(std::move(rawDataMsg), msg);
279 void updateExtraInfoInternal(
const DataSeq& jsonRawBytes, ToolsMessage& msg)
282 if (!extraInfoMsg->decodeData(jsonRawBytes)) {
283 std::cerr <<
"ERROR: Failed to decode extra info:\n";
284 std::copy(jsonRawBytes.begin(), jsonRawBytes.end(), std::ostream_iterator<char>(std::cerr,
" "));
285 std::cerr << std::endl;
287 [[maybe_unused]]
static constexpr bool Must_not_be_happen =
false;
288 assert(Must_not_be_happen);
291 property::message::ToolsMsgExtraInfoMsg().setTo(std::move(extraInfoMsg), msg);
295 TMsgFactory m_factory;