#include <op3_localization.h>
Public Member Functions | |
Eigen::MatrixXd | calcVWerr (Eigen::MatrixXd tar_position, Eigen::MatrixXd curr_position, Eigen::MatrixXd tar_orientation, Eigen::MatrixXd curr_orientation) |
void | initialize () |
OP3Localization () | |
void | pelvisPoseCallback (const geometry_msgs::PoseStamped::ConstPtr &msg) |
void | pelvisPoseResetCallback (const std_msgs::String::ConstPtr &msg) |
void | process () |
void | update () |
~OP3Localization () | |
Private Attributes | |
tf::TransformBroadcaster | broadcaster_ |
double | err_tol_ |
bool | is_moving_walking_ |
boost::mutex | mutex_ |
geometry_msgs::PoseStamped | pelvis_pose_ |
geometry_msgs::PoseStamped | pelvis_pose_base_walking_ |
geometry_msgs::PoseStamped | pelvis_pose_base_walking_new_ |
ros::Subscriber | pelvis_pose_msg_sub_ |
geometry_msgs::PoseStamped | pelvis_pose_offset_ |
geometry_msgs::PoseStamped | pelvis_pose_offset_new_ |
geometry_msgs::PoseStamped | pelvis_pose_old_ |
ros::Subscriber | pelvis_reset_msg_sub_ |
tf::StampedTransform | pelvis_trans_ |
ros::NodeHandle | ros_node_ |
double | transform_tolerance_ |
Definition at line 46 of file op3_localization.h.
robotis_op::OP3Localization::OP3Localization | ( | ) |
Definition at line 24 of file op3_localization.cpp.
robotis_op::OP3Localization::~OP3Localization | ( | ) |
Definition at line 59 of file op3_localization.cpp.
Eigen::MatrixXd robotis_op::OP3Localization::calcVWerr | ( | Eigen::MatrixXd | tar_position, |
Eigen::MatrixXd | curr_position, | ||
Eigen::MatrixXd | tar_orientation, | ||
Eigen::MatrixXd | curr_orientation | ||
) |
void robotis_op::OP3Localization::initialize | ( | ) |
Definition at line 64 of file op3_localization.cpp.
void robotis_op::OP3Localization::pelvisPoseCallback | ( | const geometry_msgs::PoseStamped::ConstPtr & | msg | ) |
Definition at line 77 of file op3_localization.cpp.
void robotis_op::OP3Localization::pelvisPoseResetCallback | ( | const std_msgs::String::ConstPtr & | msg | ) |
Definition at line 134 of file op3_localization.cpp.
void robotis_op::OP3Localization::process | ( | ) |
Definition at line 149 of file op3_localization.cpp.
void robotis_op::OP3Localization::update | ( | ) |
Definition at line 173 of file op3_localization.cpp.
|
private |
Definition at line 58 of file op3_localization.h.
|
private |
Definition at line 70 of file op3_localization.h.
|
private |
Definition at line 72 of file op3_localization.h.
|
private |
Definition at line 74 of file op3_localization.h.
|
private |
Definition at line 61 of file op3_localization.h.
|
private |
Definition at line 63 of file op3_localization.h.
|
private |
Definition at line 66 of file op3_localization.h.
|
private |
Definition at line 54 of file op3_localization.h.
|
private |
Definition at line 64 of file op3_localization.h.
|
private |
Definition at line 67 of file op3_localization.h.
|
private |
Definition at line 62 of file op3_localization.h.
|
private |
Definition at line 56 of file op3_localization.h.
|
private |
Definition at line 59 of file op3_localization.h.
|
private |
Definition at line 51 of file op3_localization.h.
|
private |
Definition at line 69 of file op3_localization.h.