77 lines
2.1 KiB
C++
77 lines
2.1 KiB
C++
/* ----------------------------------------------------------------------------
|
|
|
|
* GTSAM Copyright 2010, Georgia Tech Research Corporation,
|
|
* Atlanta, Georgia 30332-0415
|
|
* All Rights Reserved
|
|
* Authors: Frank Dellaert, et al. (see THANKS for the full author list)
|
|
|
|
* See LICENSE for the license information
|
|
|
|
* -------------------------------------------------------------------------- */
|
|
|
|
/**
|
|
* @file concepts.h
|
|
*
|
|
* @brief Concept-checking macros for geometric objects
|
|
* Each macro instantiates a concept check structure, which
|
|
* includes a static function that will fail to compile
|
|
* if the concept does not pass. Functions are made static
|
|
* to ensure they get instantiated.
|
|
*
|
|
* @date Oct 6, 2011
|
|
* @author Alex Cunningham
|
|
*/
|
|
|
|
#pragma once
|
|
|
|
#include <gtsam/base/Matrix.h>
|
|
#include <boost/optional.hpp>
|
|
|
|
namespace gtsam {
|
|
|
|
/**
|
|
* Pose Concept
|
|
* A must contain a translation and a rotation, with
|
|
* each structure accessable directly and a type provided
|
|
* for each.
|
|
*/
|
|
template<class POSE>
|
|
class PoseConcept {
|
|
public:
|
|
typedef typename POSE::Translation Translation;
|
|
typedef typename POSE::Rotation Rotation;
|
|
|
|
private:
|
|
static Rotation checkRotationMemberAccess(const POSE& p) {
|
|
return p.rotation();
|
|
}
|
|
|
|
static Translation checkTranslationMemberAccess(const POSE& p) {
|
|
return p.translation();
|
|
}
|
|
|
|
static std::pair<size_t, size_t> checkTranslationInterval() {
|
|
return POSE::translationInterval();
|
|
}
|
|
|
|
static std::pair<size_t, size_t> checkRotationInterval() {
|
|
return POSE::rotationInterval();
|
|
}
|
|
};
|
|
|
|
} // \namespace gtsam
|
|
|
|
/**
|
|
* Macros to use geometry concepts:
|
|
* - _INST macro: instantiates a struct: use in unit tests, but not in headers.
|
|
* - _TYPE macro: use in generic structures to validate the template arguments.
|
|
*
|
|
* NOTE: intentionally not in the gtsam namespace to avoid namespace complications
|
|
* when using with objects not inside gtsam namespace.
|
|
*/
|
|
|
|
/** Pose Concept macros */
|
|
#define GTSAM_CONCEPT_POSE_INST(T) template class gtsam::PoseConcept<T>
|
|
#define GTSAM_CONCEPT_POSE_TYPE(T) using _gtsam_PoseConcept##T = gtsam::PoseConcept<T>;
|
|
|