#include <dynamic-graph/all-commands.h>
#include <dynamic-graph/factory.h>
#include <sot/core/debug.hh>
#include <sot/core/stop-watch.hh>
#include <sot/talos_balance/talos-base-estimator.hh>
#include "pinocchio/algorithm/frames.hpp"

Include dependency graph for talos-base-estimator.cpp:

Namespaces
	dynamicgraph

	dynamicgraph::sot

	dynamicgraph::sot::talos_balance

Macros
#define	INPUT_SIGNALS

#define	OUTPUT_SIGNALS

#define	PROFILE_BASE_KINEMATICS_COMPUTATION "base-est kinematics computation"

#define	PROFILE_BASE_POSITION_ESTIMATION "base-est position estimation"

#define	PROFILE_BASE_VELOCITY_ESTIMATION "base-est velocity estimation"

Functions
	DEFINE_SIGNAL_INNER_FUNCTION (kinematics_computations, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (a_ac, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (lf_xyzquat, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (q, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (q_imu, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (q_lf, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (q_rf, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (rf_xyzquat, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v_ac, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v_flex, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v_gyr, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v_imu, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (v_kin, dynamicgraph::Vector)

	DEFINE_SIGNAL_OUT_FUNCTION (w_lf, double)

	DEFINE_SIGNAL_OUT_FUNCTION (w_lf_filtered, double)

	DEFINE_SIGNAL_OUT_FUNCTION (w_rf, double)

	DEFINE_SIGNAL_OUT_FUNCTION (w_rf_filtered, double)

	DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN (TalosBaseEstimator, "TalosBaseEstimator")

double	eulerMean (double a1, double a2)

void	matrixToRpy (const Eigen::Matrix3d &M, Eigen::Vector3d &rpy)

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)

double	wEulerMean (double a1, double a2, double w1, double w2)

Macro Definition Documentation

◆ INPUT_SIGNALS

#define INPUT_SIGNALS

Value:

  m_joint_positionsSIN << m_joint_velocitiesSIN << m_imu_quaternionSIN        \
                       << m_forceLLEGSIN << m_forceRLEGSIN << m_dforceLLEGSIN \
                       << m_dforceRLEGSIN << m_w_lf_inSIN << m_w_rf_inSIN     \
                       << m_K_fb_feet_posesSIN << m_lf_ref_xyzquatSIN         \
                       << m_rf_ref_xyzquatSIN << m_accelerometerSIN           \
                       << m_gyroscopeSIN

Definition at line 151 of file talos-base-estimator.cpp.

◆ OUTPUT_SIGNALS

#define OUTPUT_SIGNALS

Value:

  m_qSOUT << m_vSOUT << m_q_lfSOUT << m_q_rfSOUT << m_q_imuSOUT << m_w_lfSOUT \
          << m_w_rfSOUT << m_w_lf_filteredSOUT << m_w_rf_filteredSOUT         \
          << m_lf_xyzquatSOUT << m_rf_xyzquatSOUT << m_v_acSOUT << m_a_acSOUT \
          << m_v_kinSOUT << m_v_imuSOUT << m_v_gyrSOUT << m_v_flexSOUT

Definition at line 158 of file talos-base-estimator.cpp.

◆ PROFILE_BASE_KINEMATICS_COMPUTATION

#define PROFILE_BASE_KINEMATICS_COMPUTATION "base-est kinematics computation"

Definition at line 149 of file talos-base-estimator.cpp.

◆ PROFILE_BASE_POSITION_ESTIMATION

#define PROFILE_BASE_POSITION_ESTIMATION "base-est position estimation"

Definition at line 147 of file talos-base-estimator.cpp.

◆ PROFILE_BASE_VELOCITY_ESTIMATION

#define PROFILE_BASE_VELOCITY_ESTIMATION "base-est velocity estimation"

Definition at line 148 of file talos-base-estimator.cpp.

Namespaces