Public Member Functions | |
| void | gpsCallback (const sensor_msgs::NavSatFixConstPtr &msg) |
| void | gpsToRobotPose (const tf2::Transform &gps_odom_pose, tf2::Transform &robot_odom_pose, const ros::Time &transform_time) |
| void | headingCb (const sensor_msgs::ImuConstPtr &imu_msg) |
| void | init () |
| SetInitialStateFilter (const ros::NodeHandle &node_handle, const ros::NodeHandle &private_node_handle) | |
| nav_msgs::Odometry | utmToMap (const tf2::Transform &utm_pose, const ros::Time &transform_time) const |
| ~SetInitialStateFilter ()=default | |
Public Attributes | |
| std::string | base_link_frame_id_ {"scouting_wrt_ground_link"} |
| int | gps_count_ {0} |
| std::string | gps_frame_id_ {""} |
| sensor_msgs::NavSatFix | gps_msg_avg_ |
| int | heading_count_ {0} |
| sensor_msgs::Imu | imu_msg_avg_ |
| int | N_gps_ {1} |
| int | N_heading_ {1} |
| ros::NodeHandle | nh_ |
| std::string | path_ |
| ros::NodeHandle | pnh_ |
| tf2::Quaternion | robot_orientation_ |
| tf::Quaternion | robot_quat_ |
| bool | rtk_fix_ {false} |
| ros::Subscriber | sub_gps_ |
| ros::Subscriber | sub_heading_ |
| tf2_ros::Buffer | tf_buffer_ |
| tf2_ros::TransformListener | tf_listener_ {tf_buffer_} |
| ros::Duration | transform_timeout_ {ros::Duration(0)} |
| Eigen::MatrixXd | utm_covariance_ |
| tf2::Transform | utm_pose_ |
| std::string | world_frame_id_ {"odom"} |
| bool | zero_altitude_ {false} |
Definition at line 28 of file set_initial_state_filter.cpp.
|
inline |
Definition at line 31 of file set_initial_state_filter.cpp.
|
default |
| void SetInitialStateFilter::gpsCallback | ( | const sensor_msgs::NavSatFixConstPtr & | msg | ) |
Definition at line 110 of file set_initial_state_filter.cpp.
| void SetInitialStateFilter::gpsToRobotPose | ( | const tf2::Transform & | gps_odom_pose, |
| tf2::Transform & | robot_odom_pose, | ||
| const ros::Time & | transform_time | ||
| ) |
Definition at line 218 of file set_initial_state_filter.cpp.
| void SetInitialStateFilter::headingCb | ( | const sensor_msgs::ImuConstPtr & | imu_msg | ) |
Definition at line 92 of file set_initial_state_filter.cpp.
| void SetInitialStateFilter::init | ( | ) |
Definition at line 74 of file set_initial_state_filter.cpp.
| nav_msgs::Odometry SetInitialStateFilter::utmToMap | ( | const tf2::Transform & | utm_pose, |
| const ros::Time & | transform_time | ||
| ) | const |
Definition at line 189 of file set_initial_state_filter.cpp.
| std::string SetInitialStateFilter::base_link_frame_id_ {"scouting_wrt_ground_link"} |
Definition at line 51 of file set_initial_state_filter.cpp.
| int SetInitialStateFilter::gps_count_ {0} |
Definition at line 45 of file set_initial_state_filter.cpp.
| std::string SetInitialStateFilter::gps_frame_id_ {""} |
Definition at line 53 of file set_initial_state_filter.cpp.
| sensor_msgs::NavSatFix SetInitialStateFilter::gps_msg_avg_ |
Definition at line 62 of file set_initial_state_filter.cpp.
| int SetInitialStateFilter::heading_count_ {0} |
Definition at line 47 of file set_initial_state_filter.cpp.
| sensor_msgs::Imu SetInitialStateFilter::imu_msg_avg_ |
Definition at line 63 of file set_initial_state_filter.cpp.
| int SetInitialStateFilter::N_gps_ {1} |
Definition at line 46 of file set_initial_state_filter.cpp.
| int SetInitialStateFilter::N_heading_ {1} |
Definition at line 48 of file set_initial_state_filter.cpp.
| ros::NodeHandle SetInitialStateFilter::nh_ |
Definition at line 66 of file set_initial_state_filter.cpp.
| std::string SetInitialStateFilter::path_ |
Definition at line 54 of file set_initial_state_filter.cpp.
| ros::NodeHandle SetInitialStateFilter::pnh_ |
Definition at line 67 of file set_initial_state_filter.cpp.
| tf2::Quaternion SetInitialStateFilter::robot_orientation_ |
Definition at line 58 of file set_initial_state_filter.cpp.
| tf::Quaternion SetInitialStateFilter::robot_quat_ |
Definition at line 57 of file set_initial_state_filter.cpp.
| bool SetInitialStateFilter::rtk_fix_ {false} |
Definition at line 50 of file set_initial_state_filter.cpp.
| ros::Subscriber SetInitialStateFilter::sub_gps_ |
Definition at line 71 of file set_initial_state_filter.cpp.
| ros::Subscriber SetInitialStateFilter::sub_heading_ |
Definition at line 70 of file set_initial_state_filter.cpp.
| tf2_ros::Buffer SetInitialStateFilter::tf_buffer_ |
Definition at line 60 of file set_initial_state_filter.cpp.
| tf2_ros::TransformListener SetInitialStateFilter::tf_listener_ {tf_buffer_} |
Definition at line 61 of file set_initial_state_filter.cpp.
| ros::Duration SetInitialStateFilter::transform_timeout_ {ros::Duration(0)} |
Definition at line 56 of file set_initial_state_filter.cpp.
| Eigen::MatrixXd SetInitialStateFilter::utm_covariance_ |
Definition at line 55 of file set_initial_state_filter.cpp.
| tf2::Transform SetInitialStateFilter::utm_pose_ |
Definition at line 59 of file set_initial_state_filter.cpp.
| std::string SetInitialStateFilter::world_frame_id_ {"odom"} |
Definition at line 52 of file set_initial_state_filter.cpp.
| bool SetInitialStateFilter::zero_altitude_ {false} |
Definition at line 49 of file set_initial_state_filter.cpp.