motion_base.h
Go to the documentation of this file.
1 /*
2  * Software License Agreement (BSD License)
3  *
4  * Copyright (c) 2011-2014, Willow Garage, Inc.
5  * Copyright (c) 2014-2016, Open Source Robotics Foundation
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  *
12  * * Redistributions of source code must retain the above copyright
13  * notice, this list of conditions and the following disclaimer.
14  * * Redistributions in binary form must reproduce the above
15  * copyright notice, this list of conditions and the following
16  * disclaimer in the documentation and/or other materials provided
17  * with the distribution.
18  * * Neither the name of Open Source Robotics Foundation nor the names of its
19  * contributors may be used to endorse or promote products derived
20  * from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
30  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33  * POSSIBILITY OF SUCH DAMAGE.
34  */
35 
38 #ifndef FCL_CCD_MOTION_BASE_H
39 #define FCL_CCD_MOTION_BASE_H
40 
43 #include "fcl/math/bv/RSS.h"
44 
45 namespace fcl
46 {
47 
48 template <typename S>
49 class BVMotionBoundVisitor;
50 
51 template <typename S>
53 
54 template <typename S>
55 class MotionBase
56 {
57 public:
58  MotionBase();
59 
60  virtual ~MotionBase();
61 
63  virtual bool integrate(S dt) const = 0;
64 
66  virtual S computeMotionBound(const BVMotionBoundVisitor<S>& mb_visitor) const = 0;
67 
69  virtual S computeMotionBound(const TriangleMotionBoundVisitor<S>& mb_visitor) const = 0;
70 
72  void getCurrentTransform(Matrix3<S>& R, Vector3<S>& T) const;
73 
74  void getCurrentTransform(Quaternion<S>& Q, Vector3<S>& T) const;
75 
76  void getCurrentRotation(Matrix3<S>& R) const;
77 
78  void getCurrentRotation(Quaternion<S>& Q) const;
79 
80  void getCurrentTranslation(Vector3<S>& T) const;
81 
82  virtual void getCurrentTransform(Transform3<S>& tf) const = 0;
83 
84  virtual void getTaylorModel(TMatrix3<S>& tm, TVector3<S>& tv) const = 0;
85 
86  const std::shared_ptr<TimeInterval<S>>& getTimeInterval() const;
87 protected:
88 
89  std::shared_ptr<TimeInterval<S>> time_interval_;
90 
91 };
92 
95 
96 template <typename S>
97 using MotionBasePtr = std::shared_ptr<MotionBase<S>>;
98 
99 } // namespace fcl
100 
102 
103 #endif
fcl::TriangleMotionBoundVisitor
Definition: motion_base.h:52
fcl::Transform3
Eigen::Transform< S, 3, Eigen::Isometry > Transform3
Definition: types.h:91
taylor_vector.h
fcl::MotionBase::getTaylorModel
virtual void getTaylorModel(TMatrix3< S > &tm, TVector3< S > &tv) const =0
fcl::MotionBase::getCurrentRotation
void getCurrentRotation(Matrix3< S > &R) const
Definition: motion_base-inl.h:84
fcl::Quaternion
Eigen::Quaternion< S > Quaternion
Definition: types.h:88
fcl::MotionBasePtr
std::shared_ptr< MotionBase< S > > MotionBasePtr
Definition: motion_base.h:97
fcl::MotionBase::computeMotionBound
virtual S computeMotionBound(const BVMotionBoundVisitor< S > &mb_visitor) const =0
Compute the motion bound for a bounding volume, given the closest direction n between two query objec...
fcl::MotionBase::integrate
virtual bool integrate(S dt) const =0
Integrate the motion from 0 to dt.
fcl::Vector3
Eigen::Matrix< S, 3, 1 > Vector3
Definition: types.h:70
fcl::Matrix3
Eigen::Matrix< S, 3, 3 > Matrix3
Definition: types.h:85
fcl::MotionBase
Definition: bv_motion_bound_visitor.h:45
fcl::MotionBase::getTimeInterval
const std::shared_ptr< TimeInterval< S > > & getTimeInterval() const
Definition: motion_base-inl.h:111
fcl::MotionBase::~MotionBase
virtual ~MotionBase()
Definition: motion_base-inl.h:60
fcl::BVMotionBoundVisitor
Compute the motion bound for a bounding volume, given the closest direction n between two query objec...
Definition: bv_motion_bound_visitor.h:62
fcl::MotionBase::MotionBase
MotionBase()
Definition: motion_base-inl.h:52
fcl::TMatrix3
Definition: taylor_matrix.h:48
fcl::TVector3
Definition: taylor_vector.h:48
fcl::MotionBase::time_interval_
std::shared_ptr< TimeInterval< S > > time_interval_
Definition: motion_base.h:89
fcl::MotionBase::getCurrentTransform
void getCurrentTransform(Matrix3< S > &R, Vector3< S > &T) const
Get the rotation and translation in current step.
Definition: motion_base-inl.h:64
fcl::MotionBase::getCurrentTranslation
void getCurrentTranslation(Vector3< S > &T) const
Definition: motion_base-inl.h:102
RSS.h
taylor_matrix.h
fcl
Main namespace.
Definition: broadphase_bruteforce-inl.h:45
motion_base-inl.h


fcl
Author(s):
autogenerated on Tue Dec 5 2023 03:40:48