#include <math.h>
#include <stdio.h>
#include <stdlib.h>
#include <ros/ros.h>
#include "cameraParameters.h"
#include "pointDefinition.h"
Go to the source code of this file.
Functions | |
void | imageDataHandler (const sensor_msgs::Image::ConstPtr &imageData) |
pcl::PointCloud< ImagePoint >::Ptr | imagePointsCur (new pcl::PointCloud< ImagePoint >()) |
pcl::PointCloud< ImagePoint >::Ptr | imagePointsLast (new pcl::PointCloud< ImagePoint >()) |
int | main (int argc, char **argv) |
Variables | |
cv_bridge::CvImage | bridge |
CvMat | dMat = cvMat(4, 1, CV_64FC1, dImage) |
CvPoint2D32f * | featuresCur = new CvPoint2D32f[2 * MAXFEATURENUM] |
float | featuresError [2 *MAXFEATURENUM] |
char | featuresFound [2 *MAXFEATURENUM] |
int | featuresInd [2 *MAXFEATURENUM] = {0} |
int | featuresIndFromStart = 0 |
CvPoint2D32f * | featuresLast = new CvPoint2D32f[2 * MAXFEATURENUM] |
IplImage * | harrisLast = cvCreateImage(showSize, IPL_DEPTH_32F, 1) |
IplImage * | imageCur = cvCreateImage(imgSize, IPL_DEPTH_8U, 1) |
IplImage * | imageEig |
IplImage * | imageLast = cvCreateImage(imgSize, IPL_DEPTH_8U, 1) |
const int | imagePixelNum = imageHeight * imageWidth |
ros::Publisher * | imagePointsLastPubPointer |
IplImage * | imageShow = cvCreateImage(showSize, IPL_DEPTH_8U, 1) |
ros::Publisher * | imageShowPubPointer |
IplImage * | imageTmp |
CvSize | imgSize = cvSize(imageWidth, imageHeight) |
CvMat | kMat = cvMat(3, 3, CV_64FC1, kImage) |
IplImage * | mapx |
IplImage * | mapy |
const int | MAXFEATURENUM = maxFeatureNumPerSubregion * totalSubregionNum |
const int | maxFeatureNumPerSubregion = 2 |
const double | maxTrackDis = 100 |
IplImage * | pyrCur |
IplImage * | pyrLast |
int | showCount = 0 |
const int | showDSRate = 2 |
CvSize | showSize = cvSize(imageWidth / showDSRate, imageHeight / showDSRate) |
const int | showSkipNum = 2 |
int | subregionFeatureNum [2 *totalSubregionNum] = {0} |
const double | subregionHeight = (double)(imageHeight - 2 * yBoundary) / (double)ySubregionNum |
const double | subregionWidth = (double)(imageWidth - 2 * xBoundary) / (double)xSubregionNum |
bool | systemInited = false |
double | timeCur |
double | timeLast |
int | totalFeatureNum = 0 |
const int | totalSubregionNum = xSubregionNum * ySubregionNum |
const int | winSize = 15 |
const int | xBoundary = 20 |
const int | xSubregionNum = 12 |
const int | yBoundary = 20 |
const int | ySubregionNum = 8 |
void imageDataHandler | ( | const sensor_msgs::Image::ConstPtr & | imageData | ) |
Definition at line 68 of file featureTracking.cpp.
pcl::PointCloud<ImagePoint>::Ptr imagePointsCur | ( | new pcl::PointCloud< ImagePoint > | () | ) |
pcl::PointCloud<ImagePoint>::Ptr imagePointsLast | ( | new pcl::PointCloud< ImagePoint > | () | ) |
int main | ( | int | argc, |
char ** | argv | ||
) |
Definition at line 214 of file featureTracking.cpp.
Definition at line 66 of file featureTracking.cpp.
Definition at line 30 of file featureTracking.cpp.
CvPoint2D32f* featuresCur = new CvPoint2D32f[2 * MAXFEATURENUM] |
Definition at line 50 of file featureTracking.cpp.
float featuresError[2 *MAXFEATURENUM] |
Definition at line 53 of file featureTracking.cpp.
char featuresFound[2 *MAXFEATURENUM] |
Definition at line 52 of file featureTracking.cpp.
int featuresInd[2 *MAXFEATURENUM] = {0} |
Definition at line 56 of file featureTracking.cpp.
int featuresIndFromStart = 0 |
Definition at line 55 of file featureTracking.cpp.
CvPoint2D32f* featuresLast = new CvPoint2D32f[2 * MAXFEATURENUM] |
Definition at line 51 of file featureTracking.cpp.
IplImage* harrisLast = cvCreateImage(showSize, IPL_DEPTH_32F, 1) |
Definition at line 27 of file featureTracking.cpp.
Definition at line 18 of file featureTracking.cpp.
IplImage* imageEig |
Definition at line 48 of file featureTracking.cpp.
Definition at line 19 of file featureTracking.cpp.
const int imagePixelNum = imageHeight * imageWidth |
Definition at line 15 of file featureTracking.cpp.
Definition at line 64 of file featureTracking.cpp.
Definition at line 26 of file featureTracking.cpp.
Definition at line 65 of file featureTracking.cpp.
IplImage * imageTmp |
Definition at line 48 of file featureTracking.cpp.
CvSize imgSize = cvSize(imageWidth, imageHeight) |
Definition at line 16 of file featureTracking.cpp.
Definition at line 29 of file featureTracking.cpp.
IplImage* mapx |
Definition at line 32 of file featureTracking.cpp.
IplImage * mapy |
Definition at line 32 of file featureTracking.cpp.
const int MAXFEATURENUM = maxFeatureNumPerSubregion * totalSubregionNum |
Definition at line 38 of file featureTracking.cpp.
const int maxFeatureNumPerSubregion = 2 |
Definition at line 34 of file featureTracking.cpp.
const double maxTrackDis = 100 |
Definition at line 45 of file featureTracking.cpp.
IplImage * pyrCur |
Definition at line 48 of file featureTracking.cpp.
IplImage * pyrLast |
Definition at line 48 of file featureTracking.cpp.
int showCount = 0 |
Definition at line 21 of file featureTracking.cpp.
const int showDSRate = 2 |
Definition at line 23 of file featureTracking.cpp.
CvSize showSize = cvSize(imageWidth / showDSRate, imageHeight / showDSRate) |
Definition at line 24 of file featureTracking.cpp.
const int showSkipNum = 2 |
Definition at line 22 of file featureTracking.cpp.
int subregionFeatureNum[2 *totalSubregionNum] = {0} |
Definition at line 59 of file featureTracking.cpp.
const double subregionHeight = (double)(imageHeight - 2 * yBoundary) / (double)ySubregionNum |
Definition at line 43 of file featureTracking.cpp.
const double subregionWidth = (double)(imageWidth - 2 * xBoundary) / (double)xSubregionNum |
Definition at line 42 of file featureTracking.cpp.
bool systemInited = false |
Definition at line 12 of file featureTracking.cpp.
double timeCur |
Definition at line 13 of file featureTracking.cpp.
double timeLast |
Definition at line 13 of file featureTracking.cpp.
int totalFeatureNum = 0 |
Definition at line 58 of file featureTracking.cpp.
const int totalSubregionNum = xSubregionNum * ySubregionNum |
Definition at line 37 of file featureTracking.cpp.
const int winSize = 15 |
Definition at line 46 of file featureTracking.cpp.
const int xBoundary = 20 |
Definition at line 40 of file featureTracking.cpp.
const int xSubregionNum = 12 |
Definition at line 35 of file featureTracking.cpp.
const int yBoundary = 20 |
Definition at line 41 of file featureTracking.cpp.
const int ySubregionNum = 8 |
Definition at line 36 of file featureTracking.cpp.