|
static void | rtabmap::addGradientDescentStep (float q0, float q1, float q2, float q3, float _2dx, float _2dy, float _2dz, float mx, float my, float mz, float &s0, float &s1, float &s2, float &s3) |
|
static bool | rtabmap::computeOrientation (Eigen::Vector3f A, Eigen::Vector3f E, Eigen::Quaternionf &orientation) |
|
static bool | rtabmap::computeOrientation (Eigen::Vector3f A, Eigen::Quaternionf &orientation) |
|
template<typename T > |
static void | rtabmap::crossProduct (T ax, T ay, T az, T bx, T by, T bz, T &rx, T &ry, T &rz) |
|
static float | rtabmap::invSqrt (float x) |
|
template<typename T > |
static void | rtabmap::normalizeQuaternion (T &q0, T &q1, T &q2, T &q3) |
|
template<typename T > |
static T | rtabmap::normalizeVector (T &vx, T &vy, T &vz) |
|
template<typename T > |
static void | rtabmap::normalizeVectorOpt (T &vx, T &vy, T &vz) |
|
static void | rtabmap::orientationChangeFromGyro (float q0, float q1, float q2, float q3, float gx, float gy, float gz, float &qDot1, float &qDot2, float &qDot3, float &qDot4) |
|
static void | rtabmap::rotateAndScaleVector (float q0, float q1, float q2, float q3, float _2dx, float _2dy, float _2dz, float &rx, float &ry, float &rz) |
|