Program Listing for File pose.hpp

↰ Return to documentation for file (cosm/kin/pose.hpp)

#pragma once

/*******************************************************************************
 * Includes
 ******************************************************************************/
#include "rcppsw/math/orientation.hpp"
#include "rcppsw/math/vector3.hpp"
#include "rcppsw/al/multithread.hpp"

#include "cosm/cosm.hpp"

/*******************************************************************************
 * Namespaces/Decls
 ******************************************************************************/
namespace cosm::kin {

/*******************************************************************************
 * Class Definitions
 ******************************************************************************/
struct pose {
  rmath::vector3d position{};
  rmath::euler_angles orientation{};

  pose& operator+=(const pose &rhs) {
    this->position += rhs.position;
    this->orientation += rhs.orientation;

    return *this;
  }

};

} /* namespace cosm::kin */