#include <math.h>
#include <time.h>
#include <stdio.h>
#include <stdlib.h>
#include <ros/ros.h>
#include <nav_msgs/Odometry.h>
#include <sensor_msgs/Imu.h>
#include <sensor_msgs/PointCloud2.h>
#include <tf/transform_datatypes.h>
#include <tf/transform_broadcaster.h>
#include <opencv/cv.h>
#include <opencv2/highgui/highgui.hpp>
#include <pcl_conversions/pcl_conversions.h>
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/kdtree/kdtree_flann.h>
Go to the source code of this file.
Functions | |
void | laserOdometryHandler (const nav_msgs::Odometry::ConstPtr &laserOdometry) |
int | main (int argc, char **argv) |
void | odomAftMappedHandler (const nav_msgs::Odometry::ConstPtr &odomAftMapped) |
void | odomBefMappedHandler (const nav_msgs::Odometry::ConstPtr &odomBefMapped) |
void | transformAssociateToMap () |
Variables | |
const double | deg2rad = PI / 180 |
nav_msgs::Odometry | laserOdometry2 |
tf::StampedTransform | laserOdometryTrans2 |
const double | PI = 3.1415926 |
ros::Publisher * | pubLaserOdometry2Pointer = NULL |
const double | rad2deg = 180 / PI |
tf::TransformBroadcaster * | tfBroadcaster2Pointer = NULL |
double | timeOdomAftMapped |
double | timeOdomBefMapped |
float | transformAftMapped [6] = {0} |
float | transformBefMapped [6] = {0} |
float | transformIncre [6] = {0} |
float | transformMapped [6] = {0} |
float | transformSum [6] = {0} |
void laserOdometryHandler | ( | const nav_msgs::Odometry::ConstPtr & | laserOdometry | ) |
Definition at line 128 of file transformMaintenance.cpp.
int main | ( | int | argc, |
char ** | argv | ||
) |
Definition at line 200 of file transformMaintenance.cpp.
void odomAftMappedHandler | ( | const nav_msgs::Odometry::ConstPtr & | odomAftMapped | ) |
Definition at line 183 of file transformMaintenance.cpp.
void odomBefMappedHandler | ( | const nav_msgs::Odometry::ConstPtr & | odomBefMapped | ) |
Definition at line 166 of file transformMaintenance.cpp.
void transformAssociateToMap | ( | ) |
Definition at line 41 of file transformMaintenance.cpp.
Definition at line 25 of file transformMaintenance.cpp.
nav_msgs::Odometry laserOdometry2 |
Definition at line 38 of file transformMaintenance.cpp.
Definition at line 39 of file transformMaintenance.cpp.
const double PI = 3.1415926 |
Definition at line 23 of file transformMaintenance.cpp.
Definition at line 36 of file transformMaintenance.cpp.
Definition at line 24 of file transformMaintenance.cpp.
Definition at line 37 of file transformMaintenance.cpp.
double timeOdomAftMapped |
Definition at line 28 of file transformMaintenance.cpp.
double timeOdomBefMapped |
Definition at line 27 of file transformMaintenance.cpp.
float transformAftMapped[6] = {0} |
Definition at line 34 of file transformMaintenance.cpp.
float transformBefMapped[6] = {0} |
Definition at line 33 of file transformMaintenance.cpp.
float transformIncre[6] = {0} |
Definition at line 31 of file transformMaintenance.cpp.
float transformMapped[6] = {0} |
Definition at line 32 of file transformMaintenance.cpp.
float transformSum[6] = {0} |
Definition at line 30 of file transformMaintenance.cpp.