pinocchio  2.2.1-dirty
frames.hpp
1 //
2 // Copyright (c) 2015-2019 CNRS INRIA
3 //
4 
5 #ifndef __pinocchio_frames_hpp__
6 #define __pinocchio_frames_hpp__
7 
8 #include "pinocchio/multibody/model.hpp"
9 #include "pinocchio/multibody/data.hpp"
10 
11 namespace pinocchio
12 {
13 
24  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl>
25  inline void updateFramePlacements(const ModelTpl<Scalar,Options,JointCollectionTpl> & model,
26  DataTpl<Scalar,Options,JointCollectionTpl> & data);
27 
39  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl>
40  inline const typename DataTpl<Scalar,Options,JointCollectionTpl>::SE3 &
41  updateFramePlacement(const ModelTpl<Scalar,Options,JointCollectionTpl> & model,
42  DataTpl<Scalar,Options,JointCollectionTpl> & data,
43  const typename ModelTpl<Scalar,Options,JointCollectionTpl>::FrameIndex frame_id);
44 
45 
57  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl, typename ConfigVectorType>
58  inline void framesForwardKinematics(const ModelTpl<Scalar,Options,JointCollectionTpl> & model,
59  DataTpl<Scalar,Options,JointCollectionTpl> & data,
60  const Eigen::MatrixBase<ConfigVectorType> & q);
61 
62 
74  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl>
75  PINOCCHIO_DEPRECATED
78  {
79  updateFramePlacements(model,data);
80  }
81 
82 
95  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl>
99  const typename ModelTpl<Scalar,Options,JointCollectionTpl>::FrameIndex frame_id);
100 
113  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl>
117  const typename ModelTpl<Scalar,Options,JointCollectionTpl>::FrameIndex frame_id);
118 
139  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl, typename Matrix6xLike>
142  const typename ModelTpl<Scalar,Options,JointCollectionTpl>::FrameIndex frame_id,
143  const ReferenceFrame rf,
144  const Eigen::MatrixBase<Matrix6xLike> & J);
145 
166  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl, typename ConfigVectorType, typename Matrix6Like>
169  const Eigen::MatrixBase<ConfigVectorType> & q,
170  const FrameIndex frameId,
171  const Eigen::MatrixBase<Matrix6Like> & J);
172 
178  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl, typename ConfigVectorType, typename Matrix6Like>
179  PINOCCHIO_DEPRECATED
182  const Eigen::MatrixBase<ConfigVectorType> & q,
183  const FrameIndex frameId,
184  const Eigen::MatrixBase<Matrix6Like> & J)
185  {
186  computeFrameJacobian(model,data,q,frameId,PINOCCHIO_EIGEN_CONST_CAST(Matrix6Like,J));
187  }
188 
202  template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl, typename Matrix6xLike>
205  const typename ModelTpl<Scalar,Options,JointCollectionTpl>::FrameIndex frame_id,
206  const ReferenceFrame rf,
207  const Eigen::MatrixBase<Matrix6xLike> & dJ);
208 
209 } // namespace pinocchio
210 
211 /* --- Details -------------------------------------------------------------------- */
212 #include "pinocchio/algorithm/frames.hxx"
213 
214 #endif // ifndef __pinocchio_frames_hpp__
MotionTpl< Scalar, Options > getFrameVelocity(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, const DataTpl< Scalar, Options, JointCollectionTpl > &data, const typename ModelTpl< Scalar, Options, JointCollectionTpl >::FrameIndex frame_id)
Returns the spatial velocity of the frame expressed in the LOCAL frame coordinate system...
void getFrameJacobianTimeVariation(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, const DataTpl< Scalar, Options, JointCollectionTpl > &data, const typename ModelTpl< Scalar, Options, JointCollectionTpl >::FrameIndex frame_id, const ReferenceFrame rf, const Eigen::MatrixBase< Matrix6xLike > &dJ)
Computes the Jacobian time variation of a specific frame (given by frame_id) expressed either in the ...
void computeFrameJacobian(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, DataTpl< Scalar, Options, JointCollectionTpl > &data, const Eigen::MatrixBase< ConfigVectorType > &q, const FrameIndex frameId, const Eigen::MatrixBase< Matrix6Like > &J)
Computes the Jacobian of a specific Frame expressed in the LOCAL frame coordinate system...
const DataTpl< Scalar, Options, JointCollectionTpl >::SE3 & updateFramePlacement(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, DataTpl< Scalar, Options, JointCollectionTpl > &data, const typename ModelTpl< Scalar, Options, JointCollectionTpl >::FrameIndex frame_id)
Updates the placement of the given frame.
MotionTpl< Scalar, Options > getFrameAcceleration(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, const DataTpl< Scalar, Options, JointCollectionTpl > &data, const typename ModelTpl< Scalar, Options, JointCollectionTpl >::FrameIndex frame_id)
Returns the spatial acceleration of the frame expressed in the LOCAL frame coordinate system...
Main pinocchio namespace.
Definition: treeview.dox:24
void updateFramePlacements(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, DataTpl< Scalar, Options, JointCollectionTpl > &data)
Updates the position of each frame contained in the model.
PINOCCHIO_DEPRECATED void frameJacobian(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, DataTpl< Scalar, Options, JointCollectionTpl > &data, const Eigen::MatrixBase< ConfigVectorType > &q, const FrameIndex frameId, const Eigen::MatrixBase< Matrix6Like > &J)
This function is now deprecated and has been renamed computeFrameJacobian. This signature will be rem...
Definition: frames.hpp:180
void getFrameJacobian(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, const DataTpl< Scalar, Options, JointCollectionTpl > &data, const typename ModelTpl< Scalar, Options, JointCollectionTpl >::FrameIndex frame_id, const ReferenceFrame rf, const Eigen::MatrixBase< Matrix6xLike > &J)
Returns the jacobian of the frame expressed either expressed in the LOCAL frame coordinate system or ...
void framesForwardKinematics(const ModelTpl< Scalar, Options, JointCollectionTpl > &model, DataTpl< Scalar, Options, JointCollectionTpl > &data, const Eigen::MatrixBase< ConfigVectorType > &q)
First calls the forwardKinematics on the model, then computes the placement of each frame...