IRI ROS Specific Algorithm Class. More...
#include <tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h>
IRI ROS Specific Algorithm Class.
Definition at line 45 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
TibiDaboPitchEstimatorSinLaserVerticalAlgNode::TibiDaboPitchEstimatorSinLaserVerticalAlgNode | ( | void | ) |
Constructor.
This constructor initializes specific class attributes and all ROS communications variables to enable message exchange.
Definition at line 5 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
TibiDaboPitchEstimatorSinLaserVerticalAlgNode::~TibiDaboPitchEstimatorSinLaserVerticalAlgNode | ( | void | ) |
Destructor.
This destructor frees all necessary dynamic memory allocated within this this class.
Definition at line 34 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::addNodeDiagnostics | ( | void | ) | [protected, virtual] |
node add diagnostics
In this abstract function additional ROS diagnostics applied to the specific algorithms may be added.
Implements algorithm_base::IriBaseAlgorithm< TibiDaboPitchEstimatorSinLaserVerticalAlgorithm >.
Definition at line 409 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::front_laser_callback | ( | const sensor_msgs::LaserScan::ConstPtr & | msg | ) | [private] |
Definition at line 60 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::function_markers | ( | double | pitch | ) | [private] |
Definition at line 220 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::mainNodeThread | ( | void | ) | [protected, virtual] |
main node thread
This is the main thread node function. Code written here will be executed in every node loop while the algorithm is on running state. Loop frequency can be tuned by modifying loop_rate attribute.
Here data related to the process loop or to ROS topics (mainly data structs related to the MSG and SRV files) must be updated. ROS publisher objects must publish their data in this process. ROS client servers may also request data to the corresponding server topics.
Implements algorithm_base::IriBaseAlgorithm< TibiDaboPitchEstimatorSinLaserVerticalAlgorithm >.
Definition at line 39 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::marker_point_front_laser_node | ( | double | front_laser_point_x, |
double | front_laser_point_y | ||
) | [private] |
Definition at line 347 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::node_config_update | ( | Config & | config, |
uint32_t | level | ||
) | [protected, virtual] |
dynamic reconfigure server callback
This method is called whenever a new configuration is received through the dynamic reconfigure. The derivated generic algorithm class must implement it.
config | an object with new configuration from all algorithm parameters defined in the config file. |
level | integer referring the level in which the configuration has been changed. |
Implements algorithm_base::IriBaseAlgorithm< TibiDaboPitchEstimatorSinLaserVerticalAlgorithm >.
Definition at line 402 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::pitch_callback | ( | const iri_segway_rmp_msgs::SegwayRMP200Status::ConstPtr & | msg | ) | [private] |
Definition at line 198 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
void TibiDaboPitchEstimatorSinLaserVerticalAlgNode::rear_laser_callback | ( | const sensor_msgs::LaserScan::ConstPtr & | msg | ) | [private] |
Definition at line 129 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.cpp.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::a1_ [private] |
Definition at line 91 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
visualization_msgs::Marker TibiDaboPitchEstimatorSinLaserVerticalAlgNode::arrow_intersection_ [private] |
Definition at line 88 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::b1_ [private] |
Definition at line 91 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
visualization_msgs::Marker TibiDaboPitchEstimatorSinLaserVerticalAlgNode::distance_front_laser_marker6_ [private] |
Definition at line 87 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
visualization_msgs::Marker TibiDaboPitchEstimatorSinLaserVerticalAlgNode::floor_line_marker_ [private] |
Definition at line 86 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
ros::Publisher TibiDaboPitchEstimatorSinLaserVerticalAlgNode::front_laser_filtrado_publisher_ [private] |
Definition at line 51 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
CMutex TibiDaboPitchEstimatorSinLaserVerticalAlgNode::front_laser_mutex_ [private] |
Definition at line 59 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::front_laser_point_x [private] |
Definition at line 92 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::front_laser_point_y [private] |
Definition at line 92 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
Definition at line 57 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
Definition at line 93 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
sensor_msgs::LaserScan TibiDaboPitchEstimatorSinLaserVerticalAlgNode::LaserScan_front_msg_ [private] |
Definition at line 52 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
sensor_msgs::LaserScan TibiDaboPitchEstimatorSinLaserVerticalAlgNode::LaserScan_rear_msg_ [private] |
Definition at line 54 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
ros::Publisher TibiDaboPitchEstimatorSinLaserVerticalAlgNode::MarkerArray_lines_publisher_ [private] |
Definition at line 49 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
visualization_msgs::MarkerArray TibiDaboPitchEstimatorSinLaserVerticalAlgNode::MarkerArray_msg_ [private] |
Definition at line 50 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::pitch [private] |
Definition at line 91 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
visualization_msgs::Marker TibiDaboPitchEstimatorSinLaserVerticalAlgNode::pitch_arrow_marker_ [private] |
Definition at line 85 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
CMutex TibiDaboPitchEstimatorSinLaserVerticalAlgNode::pitch_mutex_ [private] |
Definition at line 67 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
Definition at line 65 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
ros::Publisher TibiDaboPitchEstimatorSinLaserVerticalAlgNode::rear_laser_filtrado_publisher_ [private] |
Definition at line 53 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
CMutex TibiDaboPitchEstimatorSinLaserVerticalAlgNode::rear_laser_mutex_ [private] |
Definition at line 63 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::rear_laser_point_x [private] |
Definition at line 92 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
double TibiDaboPitchEstimatorSinLaserVerticalAlgNode::rear_laser_point_y [private] |
Definition at line 92 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
Definition at line 61 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.
Definition at line 93 of file tibi_dabo_pitch_estimator_sin_laser_vertical_alg_node.h.