mirror of
https://github.com/BotChain-Robots/firmware.git
synced 2026-07-08 09:37:21 +02:00
Work on sensor
This commit is contained in:
31
components/flatbuffers/SensorMessageBuilder.cpp
Normal file
31
components/flatbuffers/SensorMessageBuilder.cpp
Normal file
@@ -0,0 +1,31 @@
|
||||
//
|
||||
// Created by Johnathon Slightham on 2025-06-30.
|
||||
//
|
||||
|
||||
#include "SensorMessageBuilder.h"
|
||||
#include "SerializedMessage.h"
|
||||
#include "flatbuffers_generated/SensorMessage_generated.h"
|
||||
|
||||
namespace Flatbuffers {
|
||||
|
||||
SerializedMessage SensorMessageBuilder::build_sensor_message(std::vector<SensorValueInstance>& values) {
|
||||
builder_.Clear();
|
||||
|
||||
std::vector<flatbuffers::Offset<void>> values_vec;
|
||||
std::vector<uint8_t> sensor_values_vec;
|
||||
|
||||
for (const auto& v : values) {
|
||||
values_vec.push_back(Messaging::CreateAngle(builder_, v.angle).Union());
|
||||
sensor_values_vec.push_back(Messaging::SensorValue_Angle);
|
||||
}
|
||||
|
||||
auto values_fb_vec = builder_.CreateVector(values_vec);
|
||||
const auto values_type_fb_vec = builder_.CreateVector(sensor_values_vec);
|
||||
|
||||
const auto message = Messaging::CreateSensorMessage(builder_, values_type_fb_vec, values_fb_vec);
|
||||
|
||||
builder_.Finish(message);
|
||||
|
||||
return { builder_.GetBufferPointer(), builder_.GetSize() };
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user