1 #ifndef BT_FLATBUFFER_HELPER_H 2 #define BT_FLATBUFFER_HELPER_H 65 std::vector<flatbuffers::Offset<Serialization::TreeNode>> fb_nodes;
69 std::vector<uint16_t> children_uid;
70 if (
auto control = dynamic_cast<BT::ControlNode*>(node))
72 children_uid.reserve(control->children().size());
73 for (
const auto& child : control->children())
75 children_uid.push_back(child->UID());
78 else if (
auto decorator = dynamic_cast<BT::DecoratorNode*>(node))
80 const auto& child = decorator->child();
81 children_uid.push_back(child->UID());
84 std::vector<flatbuffers::Offset<Serialization::PortConfig>> ports;
85 for (
const auto& it : node->config().input_ports)
88 builder, it.first.c_str(), it.second.c_str()));
90 for (
const auto& it : node->config().output_ports)
93 builder, it.first.c_str(), it.second.c_str()));
105 fb_nodes.push_back(tn);
108 std::vector<flatbuffers::Offset<Serialization::NodeModel>> node_models;
110 for (
const auto& node_it: tree.
manifests)
112 const auto&
manifest = node_it.second;
113 std::vector<flatbuffers::Offset<Serialization::PortModel>> port_models;
115 for (
const auto& port_it:
manifest.ports)
117 const auto& port_name = port_it.first;
118 const auto& port = port_it.second;
126 port_models.push_back(port_model);
135 node_models.push_back(node_model);
142 builder.
Finish(behavior_tree);
154 SerializedTransition
buffer;
155 int64_t usec = duration_cast<microseconds>(timestamp).
count();
156 int64_t t_sec = usec / 1000000;
157 int64_t t_usec = usec % 1000000;
159 flatbuffers::WriteScalar(&buffer[0], t_sec);
160 flatbuffers::WriteScalar(&buffer[4], t_usec);
161 flatbuffers::WriteScalar(&buffer[8], UID);
171 #endif // BT_FLATBUFFER_HELPER_H
flatbuffers::Offset< PortModel > CreatePortModel(flatbuffers::FlatBufferBuilder &_fbb, flatbuffers::Offset< flatbuffers::String > port_name=0, Serialization::PortDirection direction=Serialization::PortDirection::INPUT, flatbuffers::Offset< flatbuffers::String > type_info=0, flatbuffers::Offset< flatbuffers::String > description=0)
static raw_event_t * buffer
void Finish(Offset< T > root, const char *file_identifier=nullptr)
Finish serializing a buffer by writing the root offset.
Offset< String > CreateString(const char *str, size_t len)
Store a string in the buffer, which can contain any binary data.
void CreateFlatbuffersBehaviorTree(flatbuffers::FlatBufferBuilder &builder, const BT::Tree &tree)
std::array< uint8_t, 12 > SerializedTransition
TreeNode * rootNode() const
Helper class to hold data needed in creation of a FlatBuffer. To serialize data, you typically call o...
Serialization::NodeType convertToFlatbuffers(BT::NodeType type)
std::string demangle(char const *name)
flatbuffers::Offset< TreeNode > CreateTreeNode(flatbuffers::FlatBufferBuilder &_fbb, uint16_t uid=0, flatbuffers::Offset< flatbuffers::Vector< uint16_t >> children_uid=0, Serialization::NodeStatus status=Serialization::NodeStatus::IDLE, flatbuffers::Offset< flatbuffers::String > instance_name=0, flatbuffers::Offset< flatbuffers::String > registration_name=0, flatbuffers::Offset< flatbuffers::Vector< flatbuffers::Offset< Serialization::PortConfig >>> port_remaps=0)
flatbuffers::Offset< BehaviorTree > CreateBehaviorTree(flatbuffers::FlatBufferBuilder &_fbb, uint16_t root_uid=0, flatbuffers::Offset< flatbuffers::Vector< flatbuffers::Offset< Serialization::TreeNode >>> nodes=0, flatbuffers::Offset< flatbuffers::Vector< flatbuffers::Offset< Serialization::NodeModel >>> node_models=0)
Struct used to store a tree. If this object goes out of scope, the tree is destroyed.
Abstract base class for Behavior Tree Nodes.
Offset< Vector< T > > CreateVector(const T *v, size_t len)
Serialize an array into a FlatBuffer vector.
static volatile int count
std::unordered_map< std::string, TreeNodeManifest > manifests
flatbuffers::Offset< NodeModel > CreateNodeModel(flatbuffers::FlatBufferBuilder &_fbb, flatbuffers::Offset< flatbuffers::String > registration_name=0, Serialization::NodeType type=Serialization::NodeType::UNDEFINED, flatbuffers::Offset< flatbuffers::Vector< flatbuffers::Offset< Serialization::PortModel >>> ports=0)
NodeType
Enumerates the possible types of nodes.
std::chrono::high_resolution_clock::duration Duration
void applyRecursiveVisitor(const TreeNode *root_node, const std::function< void(const TreeNode *)> &visitor)
flatbuffers::Offset< PortConfig > CreatePortConfigDirect(flatbuffers::FlatBufferBuilder &_fbb, const char *port_name=nullptr, const char *remap=nullptr)
SerializedTransition SerializeTransition(uint16_t UID, Duration timestamp, NodeStatus prev_status, NodeStatus status)