main_naive.cpp File Reference

#include <iostream>
#include <string.h>
#include <fstream>
#include <algorithm>
#include <iterator>
#include "kf_tracker/featureDetection.h"
#include "kf_tracker/CKalmanFilter.h"
#include <opencv2/core/core.hpp>
#include <opencv2/highgui/highgui.hpp>
#include <opencv2/imgproc/imgproc.hpp>
#include <opencv2/video/video.hpp>
#include "opencv2/video/tracking.hpp"
#include <ros/ros.h>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include "pcl_ros/point_cloud.h"
#include <geometry_msgs/Point.h>
#include <std_msgs/Float32MultiArray.h>
#include <std_msgs/Int32MultiArray.h>
#include <sensor_msgs/PointCloud2.h>
#include <pcl_conversions/pcl_conversions.h>
#include <pcl/point_cloud.h>
#include <pcl/common/geometry.h>
#include <pcl/filters/extract_indices.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/features/normal_3d.h>
#include <pcl/kdtree/kdtree.h>
#include <pcl/sample_consensus/method_types.h>
#include <pcl/sample_consensus/model_types.h>
#include <pcl/segmentation/sac_segmentation.h>
#include <pcl/segmentation/extract_clusters.h>

Include dependency graph for main_naive.cpp:

Go to the source code of this file.

Functions
void	cloud_cb (const sensor_msgs::PointCloud2ConstPtr &input)
double	euclidean_distance (geometry_msgs::Point &p1, geometry_msgs::Point &p2)
cv::KalmanFilter	KF0 (stateDim, measDim, ctrlDim, CV_32F)
cv::KalmanFilter	KF1 (stateDim, measDim, ctrlDim, CV_32F)
cv::KalmanFilter	KF2 (stateDim, measDim, ctrlDim, CV_32F)
cv::KalmanFilter	KF3 (stateDim, measDim, ctrlDim, CV_32F)
cv::KalmanFilter	KF4 (stateDim, measDim, ctrlDim, CV_32F)
cv::KalmanFilter	KF5 (stateDim, measDim, ctrlDim, CV_32F)
void	KFT (const std_msgs::Float32MultiArray ccs)
int	main (int argc, char **argv)
cv::Mat_< float >	measurement (2, 1)
void	publish_cloud (ros::Publisher &pub, pcl::PointCloud< pcl::PointXYZ >::Ptr cluster)
cv::Mat	state (stateDim, 1, CV_32F)

Variables
int	ctrlDim =0
bool	firstFrame =true
int	measDim =2
std::vector< int >	objID
ros::Publisher	objID_pub
std::vector< geometry_msgs::Point >	prevClusterCenters
ros::Publisher	pub_cluster0
ros::Publisher	pub_cluster1
ros::Publisher	pub_cluster2
ros::Publisher	pub_cluster3
ros::Publisher	pub_cluster4
ros::Publisher	pub_cluster5
int	stateDim =4

Function Documentation

void cloud_cb

(

const sensor_msgs::PointCloud2ConstPtr &

input

)

Definition at line 255 of file main_naive.cpp.

double euclidean_distance	(	geometry_msgs::Point &	p1,
		geometry_msgs::Point &	p2
	)

Definition at line 71 of file main_naive.cpp.

cv::KalmanFilter KF0	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

cv::KalmanFilter KF1	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

cv::KalmanFilter KF2	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

cv::KalmanFilter KF3	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

cv::KalmanFilter KF4	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

cv::KalmanFilter KF5	(	stateDim	,
		measDim	,
		ctrlDim	,
		CV_32F
	)

void KFT

(

const std_msgs::Float32MultiArray

ccs

)

Definition at line 95 of file main_naive.cpp.

int main	(	int	argc,
		char **	argv
	)

Definition at line 564 of file main_naive.cpp.

cv::Mat_<float> measurement	(	2	,
		1
	)

void publish_cloud	(	ros::Publisher &	pub,
		pcl::PointCloud< pcl::PointXYZ >::Ptr	cluster
	)

Definition at line 245 of file main_naive.cpp.

cv::Mat state	(	stateDim	,
		1	,
		CV_32F
	)

Variable Documentation

int ctrlDim =0

Definition at line 44 of file main_naive.cpp.

bool firstFrame =true

Definition at line 68 of file main_naive.cpp.

int measDim =2

Definition at line 43 of file main_naive.cpp.

std::vector<int> objID

Definition at line 65 of file main_naive.cpp.

ros::Publisher objID_pub

Definition at line 39 of file main_naive.cpp.

std::vector<geometry_msgs::Point> prevClusterCenters

Definition at line 59 of file main_naive.cpp.

ros::Publisher pub_cluster0

Definition at line 52 of file main_naive.cpp.

ros::Publisher pub_cluster1

Definition at line 53 of file main_naive.cpp.

ros::Publisher pub_cluster2

Definition at line 54 of file main_naive.cpp.

ros::Publisher pub_cluster3

Definition at line 55 of file main_naive.cpp.

ros::Publisher pub_cluster4

Definition at line 56 of file main_naive.cpp.

ros::Publisher pub_cluster5

Definition at line 57 of file main_naive.cpp.

int stateDim =4

Definition at line 42 of file main_naive.cpp.