se3.hpp

//
// Copyright (c) 2019 INRIA
//

#ifndef __pinocchio_serialization_se3_hpp__
#define __pinocchio_serialization_se3_hpp__

#include "pinocchio/spatial/se3.hpp"
#include "pinocchio/serialization/fwd.hpp"

#include <boost/serialization/split_free.hpp>
#include <boost/serialization/vector.hpp>

namespace boost
{
 namespace serialization
 {

 template<class Archive, typename Scalar, int Options>
 void
 save(Archive & ar, const pinocchio::SE3Tpl<Scalar, Options> & M, const unsigned int /*version*/)
 {
 ar & make_nvp("translation", make_array(M.translation().data(), 3));
 ar & make_nvp("rotation", make_array(M.rotation().data(), 9));
 }

 template<class Archive, typename Scalar, int Options>
 void load(Archive & ar, pinocchio::SE3Tpl<Scalar, Options> & M, const unsigned int /*version*/)
 {
 ar >> make_nvp("translation", make_array(M.translation().data(), 3));
 ar >> make_nvp("rotation", make_array(M.rotation().data(), 9));
 }

 template<class Archive, typename Scalar, int Options>
 void serialize(Archive & ar, pinocchio::SE3Tpl<Scalar, Options> & M, const unsigned int version)
 {
 split_free(ar, M, version);
 }

 } // namespace serialization
} // namespace boost

#endif // ifndef __pinocchio_serialization_se3_hpp__