File that adds the IMU odometry covariance to the estimation. More...
#include <sensor_msgs/Imu.h>#include <string>#include <vector>#include <map>#include <ostream>#include "ros/serialization.h"#include "ros/builtin_message_traits.h"#include "ros/message_operations.h"#include "ros/time.h"#include "ros/macros.h"#include "ros/assert.h"#include "std_msgs/Header.h"#include "geometry_msgs/Quaternion.h"#include "geometry_msgs/Vector3.h"#include "geometry_msgs/Vector3Stamped.h"#include "geometry_msgs/QuaternionStamped.h"#include "geometry_msgs/Pose.h"#include "tf/tfMessage.h"#include "tf/tf.h"#include "ros/ros.h"#include <boost/shared_ptr.hpp>#include "common.h"#include "ros/types.h"#include <boost/thread/mutex.hpp>#include <boost/thread/detail/platform.hpp>#include <boost/config.hpp>#include <boost/detail/workaround.hpp>#include "platform.hpp"#include <boost/config/auto_link.hpp>#include <list>#include <deque>#include "ros/service_traits.h"#include <boost/thread/detail/config.hpp>#include <stdexcept>#include <boost/config/abi_prefix.hpp>#include <boost/config/abi_suffix.hpp>#include <boost/utility/enable_if.hpp>#include <boost/type_traits/is_convertible.hpp>#include <boost/cstdint.hpp>#include <cstdlib>#include <ctime>#include <boost/throw_exception.hpp>#include <boost/date_time/compiler_config.hpp>#include "boost/date_time/c_time.hpp"#include "boost/date_time/time_clock.hpp"#include "boost/date_time/microsec_time_clock.hpp"#include <boost/limits.hpp>#include <boost/config/no_tr1/cmath.hpp>#include <boost/operators.hpp>#include <boost/date_time/time_defs.hpp>#include "boost/date_time/special_defs.hpp"#include "boost/date_time/locale_config.hpp"#include <exception>#include <boost/mpl/if.hpp>#include <boost/type_traits/is_base_of.hpp>#include "boost/date_time/constrained_value.hpp"#include "boost/date_time/year_month_day.hpp"#include "boost/date_time/date_defs.hpp"#include <algorithm>#include <cctype>#include "boost/date_time/int_adapter.hpp"#include <boost/date_time/date_duration.hpp>#include <boost/date_time/date.hpp>#include <boost/date_time/gregorian/greg_calendar.hpp>#include <boost/date_time/gregorian/greg_duration.hpp>#include <boost/date_time/date_duration_types.hpp>#include "boost/date_time/gregorian/greg_date.hpp"#include <sstream>#include <iterator>#include "boost/date_time/adjust_functors.hpp"#include <boost/date_time/wrapping_int.hpp>#include "boost/date_time/gregorian/greg_duration_types.hpp"#include "boost/date_time/posix_time/ptime.hpp"#include "boost/date_time/posix_time/posix_time_config.hpp"#include "boost/date_time/posix_time/posix_time_system.hpp"#include "boost/date_time/period.hpp"#include "boost/date_time/posix_time/posix_time_duration.hpp"#include "boost/date_time/date_generators.hpp"#include "boost/date_time/filetime_functions.hpp"#include <boost/date_time/gregorian/gregorian_types.hpp>#include <boost/thread/detail/thread_heap_alloc.hpp>#include <boost/utility.hpp>#include <boost/assert.hpp>#include <boost/ref.hpp>#include <boost/bind.hpp>#include <stdlib.h>#include <memory>#include <boost/type_traits/remove_reference.hpp>#include <boost/thread/condition_variable.hpp>#include <boost/thread/exceptions.hpp>#include <boost/thread/tss.hpp>#include <boost/thread/thread_time.hpp>#include <boost/thread/detail/move.hpp>#include <boost/thread/shared_mutex.hpp>#include "geometry_msgs/Twist.h"#include "tf/transform_datatypes.h"#include <stdio.h>#include <std_msgs/Float64.h>#include <tf/transform_broadcaster.h>#include <iostream>#include <fstream>
Go to the source code of this file.
Functions | |
| void | ImuCallback (const sensor_msgs::Imu::ConstPtr &msg) |
| ImuCallback Function to add covariance to IMU data. | |
| int | main (int argc, char **argv) |
| void | OdometryCallback (const nav_msgs::Odometry::ConstPtr &msg) |
Variables | |
| ros::Publisher | imu_pub |
| sensor_msgs::Imu | inercial_ |
| ros::Publisher | odom_pub |
| nav_msgs::Odometry | odometry_ |
| tf::TransformBroadcaster * | p_odom_broadcaster |
| ros::Time | t_i |
| ros::Time | t_i_1 |
File that adds the IMU odometry covariance to the estimation.
Definition in file add_imu_odometry_covariance.cpp.
| void ImuCallback | ( | const sensor_msgs::Imu::ConstPtr & | msg | ) |
ImuCallback Function to add covariance to IMU data.
Definition at line 62 of file add_imu_odometry_covariance.cpp.
| int main | ( | int | argc, | |
| char ** | argv | |||
| ) |
Definition at line 141 of file add_imu_odometry_covariance.cpp.
| void OdometryCallback | ( | const nav_msgs::Odometry::ConstPtr & | msg | ) |
Definition at line 110 of file add_imu_odometry_covariance.cpp.
| ros::Publisher imu_pub |
Definition at line 56 of file add_imu_odometry_covariance.cpp.
| sensor_msgs::Imu inercial_ |
Definition at line 52 of file add_imu_odometry_covariance.cpp.
| ros::Publisher odom_pub |
Definition at line 55 of file add_imu_odometry_covariance.cpp.
| nav_msgs::Odometry odometry_ |
Definition at line 51 of file add_imu_odometry_covariance.cpp.
| tf::TransformBroadcaster* p_odom_broadcaster |
Definition at line 58 of file add_imu_odometry_covariance.cpp.
| ros::Time t_i |
Definition at line 53 of file add_imu_odometry_covariance.cpp.
| ros::Time t_i_1 |
Definition at line 54 of file add_imu_odometry_covariance.cpp.