agri-gaia/seerep

Use tf write methods from hdf5_core in seerep_hdf5_fb and seerep_hdf5_pb

Opened this issue · 0 comments

1125453 introduces write methods for the rotation, translation and timestamps of tfs. As most of the code revolves around settings up the extendible datasets and takes standard containers (std::array) as input, it makes sense to reuse them in seerep_hdf5_pb and seerep_hdf5_fb like it is done in seerep_hdf5_ros:

hdf5CoreTf_->writeTimestamp(datagroupPath, { transform.header.stamp.sec,
transform.header.stamp.nsec });
hdf5CoreTf_->writeTranslation(datagroupPath,
{ transform.transform.translation.x,
transform.transform.translation.y,
transform.transform.translation.z });
hdf5CoreTf_->writeRotation(
datagroupPath,
{ transform.transform.rotation.x, transform.transform.rotation.y,
transform.transform.rotation.z, transform.transform.rotation.w });