#include <ab_filter_pose.h>
Public Member Functions | |
ABFilterPose (ros::NodeHandle nh, ros::NodeHandle nh_private) | |
virtual | ~ABFilterPose () |
Private Types | |
typedef btMatrix3x3 | MyMatrix |
typedef geometry_msgs::PoseStamped | Pose |
typedef geometry_msgs::TwistStamped | Twist |
Private Member Functions | |
void | initializeParams () |
void | normalizeAngle2Pi (double &angle) |
void | normalizeAnglePi (double &angle) |
void | poseCallback (const Pose::ConstPtr pose_msg) |
void | publishPose (const std_msgs::Header &header) |
Private Attributes | |
double | alpha_ |
tf::Vector3 | ang_vel_ |
tf::Vector3 | ang_vel_unf_ |
double | beta_ |
bool | initialized_ |
ros::Time | last_update_time_ |
tf::Vector3 | lin_vel_ |
tf::Vector3 | lin_vel_unf_ |
ros::NodeHandle | nh_ |
ros::NodeHandle | nh_private_ |
double | pitch_ |
tf::Vector3 | pos_ |
ros::Publisher | pose_publisher_ |
bool | publish_unfiltered_ |
tf::Quaternion | q_ |
double | roll_ |
ros::Subscriber | subscriber_ |
ros::Publisher | twist_publisher_ |
ros::Publisher | twist_unf_publisher_ |
double | v_pitch_ |
double | v_roll_ |
double | v_yaw_ |
double | yaw_ |
Definition at line 33 of file ab_filter_pose.h.
typedef btMatrix3x3 mav::ABFilterPose::MyMatrix [private] |
Definition at line 42 of file ab_filter_pose.h.
typedef geometry_msgs::PoseStamped mav::ABFilterPose::Pose [private] |
Definition at line 35 of file ab_filter_pose.h.
typedef geometry_msgs::TwistStamped mav::ABFilterPose::Twist [private] |
Definition at line 36 of file ab_filter_pose.h.
mav::ABFilterPose::ABFilterPose | ( | ros::NodeHandle | nh, |
ros::NodeHandle | nh_private | ||
) |
Definition at line 27 of file ab_filter_pose.cpp.
mav::ABFilterPose::~ABFilterPose | ( | ) | [virtual] |
Definition at line 59 of file ab_filter_pose.cpp.
void mav::ABFilterPose::initializeParams | ( | ) | [private] |
Definition at line 65 of file ab_filter_pose.cpp.
void mav::ABFilterPose::normalizeAngle2Pi | ( | double & | angle | ) | [private] |
Definition at line 186 of file ab_filter_pose.cpp.
void mav::ABFilterPose::normalizeAnglePi | ( | double & | angle | ) | [private] |
Definition at line 192 of file ab_filter_pose.cpp.
void mav::ABFilterPose::poseCallback | ( | const Pose::ConstPtr | pose_msg | ) | [private] |
Definition at line 76 of file ab_filter_pose.cpp.
void mav::ABFilterPose::publishPose | ( | const std_msgs::Header & | header | ) | [private] |
Definition at line 150 of file ab_filter_pose.cpp.
double mav::ABFilterPose::alpha_ [private] |
Definition at line 74 of file ab_filter_pose.h.
tf::Vector3 mav::ABFilterPose::ang_vel_ [private] |
Definition at line 66 of file ab_filter_pose.h.
tf::Vector3 mav::ABFilterPose::ang_vel_unf_ [private] |
Definition at line 67 of file ab_filter_pose.h.
double mav::ABFilterPose::beta_ [private] |
Definition at line 75 of file ab_filter_pose.h.
bool mav::ABFilterPose::initialized_ [private] |
Definition at line 58 of file ab_filter_pose.h.
Definition at line 59 of file ab_filter_pose.h.
tf::Vector3 mav::ABFilterPose::lin_vel_ [private] |
Definition at line 62 of file ab_filter_pose.h.
tf::Vector3 mav::ABFilterPose::lin_vel_unf_ [private] |
Definition at line 63 of file ab_filter_pose.h.
ros::NodeHandle mav::ABFilterPose::nh_ [private] |
Definition at line 48 of file ab_filter_pose.h.
Definition at line 49 of file ab_filter_pose.h.
double mav::ABFilterPose::pitch_ [private] |
Definition at line 69 of file ab_filter_pose.h.
tf::Vector3 mav::ABFilterPose::pos_ [private] |
Definition at line 61 of file ab_filter_pose.h.
Definition at line 52 of file ab_filter_pose.h.
bool mav::ABFilterPose::publish_unfiltered_ [private] |
Definition at line 76 of file ab_filter_pose.h.
tf::Quaternion mav::ABFilterPose::q_ [private] |
Definition at line 65 of file ab_filter_pose.h.
double mav::ABFilterPose::roll_ [private] |
Definition at line 69 of file ab_filter_pose.h.
Definition at line 51 of file ab_filter_pose.h.
Definition at line 53 of file ab_filter_pose.h.
Definition at line 54 of file ab_filter_pose.h.
double mav::ABFilterPose::v_pitch_ [private] |
Definition at line 70 of file ab_filter_pose.h.
double mav::ABFilterPose::v_roll_ [private] |
Definition at line 70 of file ab_filter_pose.h.
double mav::ABFilterPose::v_yaw_ [private] |
Definition at line 70 of file ab_filter_pose.h.
double mav::ABFilterPose::yaw_ [private] |
Definition at line 69 of file ab_filter_pose.h.