Namespaces | Functions
MadgwickFilter.cpp File Reference
#include "MadgwickFilter.h"
#include <rtabmap/utilite/ULogger.h>
Include dependency graph for MadgwickFilter.cpp:

Go to the source code of this file.

Namespaces

 rtabmap
 

Functions

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::Quaternionf &orientation)
 
static bool rtabmap::computeOrientation (Eigen::Vector3f A, Eigen::Vector3f E, 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)
 


rtabmap
Author(s): Mathieu Labbe
autogenerated on Thu Jul 25 2024 02:50:24