8 #ifndef __sot_talos_balance_ft_calibration_H__ 9 #define __sot_talos_balance_ft_calibration_H__ 16 # if defined (__sot_talos_balance_ft_calibration_H__) 17 # define SOTFTCALIBRATION_EXPORT __declspec(dllexport) 19 # define SOTFTCALIBRATION_EXPORT __declspec(dllimport) 22 # define SOTFTCALIBRATION_EXPORT 30 #include <dynamic-graph/signal-helper.h> 31 #include <dynamic-graph/real-time-logger.h> 32 #include <sot/core/matrix-geometry.hh> 33 #include <sot/core/robot-utils.hh> 35 #include "boost/assign.hpp" 42 namespace talos_balance {
49 :public::dynamicgraph::Entity
52 DYNAMIC_GRAPH_ENTITY_DECL();
58 void init(
const std::string & robotRef);
69 void setRightFootWeight(
const double &rightW);
70 void setLeftFootWeight(
const double &leftW);
73 void calibrateFeetSensor();
75 void displayRobotUtil();
78 virtual void display( std::ostream& os )
const;
85 int m_right_calibration_iter = -1;
86 int m_left_calibration_iter = -1;
103 #endif // #ifndef __sot_talos_balance_ft_calibration_H__ Vector6d m_right_FT_offset_calibration_sum
Offset or bias to be removed from Left FT sensor.
Eigen::Matrix< Scalar, Eigen::Dynamic, 1 > Vector
Vector6d m_left_foot_weight
Vector6d m_right_foot_weight
true if the entity has been successfully initialized
RobotUtilShrPtr m_robot_util
bool m_initSucceeded
Variable used durring average computation of the offset.
Vector6d m_left_FT_offset
Offset or bias to be removed from Right FT sensor.
Vector6d m_right_FT_offset
Number of iteration left for calibration (-1= not cailbrated, 0=caibration done)
Vector6d m_left_FT_offset_calibration_sum
Variable used durring average computation of the offset.
#define SOTFTCALIBRATION_EXPORT
Eigen::Matrix< double, 6, 1 > Vector6d