#include <pinocchio/fwd.hpp>
#include <map>
#include "boost/assign.hpp"
#include <boost/math/distributions/normal.hpp>
#include <pinocchio/algorithm/kinematics.hpp>
#include <pinocchio/multibody/model.hpp>
#include <pinocchio/parsers/urdf.hpp>
#include <dynamic-graph/signal-helper.h>
#include <sot/core/matrix-geometry.hh>
#include <sot/core/robot-utils.hh>
#include <sot/torque_control/utils/vector-conversions.hh>
Go to the source code of this file.
|
void | matrixToRpy (const Eigen::Matrix3d &M, Eigen::Vector3d &rpy) |
|
void | pointRotationByQuaternion (const Eigen::Vector3d &point, const Eigen::Vector4d &quat, Eigen::Vector3d &rotatedPoint) |
|
void | quanternionMult (const Eigen::Vector4d &q1, const Eigen::Vector4d &q2, Eigen::Vector4d &q12) |
|
void | rpyToMatrix (const Eigen::Vector3d &rpy, Eigen::Matrix3d &R) |
|
void | rpyToMatrix (double r, double p, double y, Eigen::Matrix3d &R) |
|
void | se3Interp (const pinocchio::SE3 &s1, const pinocchio::SE3 &s2, const double alpha, pinocchio::SE3 &s12) |
|
◆ SOTBASEESTIMATOR_EXPORT
#define SOTBASEESTIMATOR_EXPORT |