Skip to content
Snippets Groups Projects

Use msgpack for pose

Merged Nicolas Pope requested to merge feature/msgpackpose into master
4 files
+ 25
4
Compare changes
  • Side-by-side
  • Inline
Files
4
@@ -93,7 +93,12 @@ void FileSource::_processPose(ftl::codecs::Packet &pkt) {
Eigen::Matrix4d p = Eigen::Map<Eigen::Matrix4d>((double*)pkt.data.data());
host_->setPose(p);
} else if (pkt.codec == codec_t::MSGPACK) {
auto unpacked = msgpack::unpack((const char*)pkt.data.data(), pkt.data.size());
std::vector<double> posevec;
unpacked.get().convert(posevec);
Eigen::Matrix4d p(posevec.data());
host_->setPose(p);
}
}
Loading