opencv/samples/cpp/camshiftdemo.cpp

212 lines
6.1 KiB
C++
Raw Normal View History

#include "opencv2/video/tracking.hpp"
#include "opencv2/imgproc/imgproc.hpp"
#include "opencv2/highgui/highgui.hpp"
#include <iostream>
#include <ctype.h>
2010-11-28 20:41:55 +01:00
using namespace cv;
using namespace std;
Mat image;
bool backprojMode = false;
bool selectObject = false;
int trackObject = 0;
bool showHist = true;
Point origin;
Rect selection;
int vmin = 10, vmax = 256, smin = 30;
2012-06-07 19:21:29 +02:00
static void onMouse( int event, int x, int y, int, void* )
{
2010-11-28 00:15:16 +01:00
if( selectObject )
{
2010-11-28 00:15:16 +01:00
selection.x = MIN(x, origin.x);
selection.y = MIN(y, origin.y);
2010-11-28 20:41:55 +01:00
selection.width = std::abs(x - origin.x);
selection.height = std::abs(y - origin.y);
selection &= Rect(0, 0, image.cols, image.rows);
}
switch( event )
{
case CV_EVENT_LBUTTONDOWN:
2010-11-28 00:15:16 +01:00
origin = Point(x,y);
selection = Rect(x,y,0,0);
selectObject = true;
break;
case CV_EVENT_LBUTTONUP:
2010-11-28 00:15:16 +01:00
selectObject = false;
if( selection.width > 0 && selection.height > 0 )
2010-11-28 00:15:16 +01:00
trackObject = -1;
break;
}
}
2012-06-07 19:21:29 +02:00
static void help()
2011-08-10 12:41:38 +02:00
{
cout << "\nThis is a demo that shows mean-shift based tracking\n"
2011-08-10 12:41:38 +02:00
"You select a color objects such as your face and it tracks it.\n"
"This reads from video camera (0 by default, or the camera number the user enters\n"
"Usage: \n"
" ./camshiftdemo [camera number]\n";
2011-08-10 12:41:38 +02:00
cout << "\n\nHot keys: \n"
2011-08-10 12:41:38 +02:00
"\tESC - quit the program\n"
"\tc - stop the tracking\n"
"\tb - switch to/from backprojection view\n"
"\th - show/hide object histogram\n"
"\tp - pause video\n"
"To initialize tracking, select the object with mouse\n";
2011-08-10 12:41:38 +02:00
}
2010-11-30 01:19:34 +01:00
2011-08-10 12:41:38 +02:00
const char* keys =
{
"{1| | 0 | camera number}"
};
2010-11-30 01:19:34 +01:00
2011-08-10 12:41:38 +02:00
int main( int argc, const char** argv )
{
2011-08-10 12:41:38 +02:00
help();
2010-11-28 20:41:55 +01:00
VideoCapture cap;
Rect trackWindow;
RotatedRect trackBox;
int hsize = 16;
float hranges[] = {0,180};
const float* phranges = hranges;
2011-08-10 12:41:38 +02:00
CommandLineParser parser(argc, argv, keys);
int camNum = parser.get<int>("1");
cap.open(camNum);
2010-11-28 20:41:55 +01:00
if( !cap.isOpened() )
{
2010-11-30 01:19:34 +01:00
help();
cout << "***Could not initialize capturing...***\n";
cout << "Current parameter's value: \n";
2011-08-10 12:41:38 +02:00
parser.printParams();
return -1;
}
namedWindow( "Histogram", 0 );
namedWindow( "CamShift Demo", 0 );
2010-11-28 20:41:55 +01:00
setMouseCallback( "CamShift Demo", onMouse, 0 );
createTrackbar( "Vmin", "CamShift Demo", &vmin, 256, 0 );
createTrackbar( "Vmax", "CamShift Demo", &vmax, 256, 0 );
createTrackbar( "Smin", "CamShift Demo", &smin, 256, 0 );
Mat frame, hsv, hue, mask, hist, histimg = Mat::zeros(200, 320, CV_8UC3), backproj;
bool paused = false;
2010-11-28 20:41:55 +01:00
for(;;)
{
if( !paused )
{
cap >> frame;
if( frame.empty() )
break;
}
2010-11-28 20:41:55 +01:00
frame.copyTo(image);
if( !paused )
{
cvtColor(image, hsv, CV_BGR2HSV);
if( trackObject )
{
int _vmin = vmin, _vmax = vmax;
inRange(hsv, Scalar(0, smin, MIN(_vmin,_vmax)),
Scalar(180, 256, MAX(_vmin, _vmax)), mask);
int ch[] = {0, 0};
hue.create(hsv.size(), hsv.depth());
mixChannels(&hsv, 1, &hue, 1, ch, 1);
if( trackObject < 0 )
{
Mat roi(hue, selection), maskroi(mask, selection);
calcHist(&roi, 1, 0, maskroi, hist, 1, &hsize, &phranges);
normalize(hist, hist, 0, 255, CV_MINMAX);
trackWindow = selection;
trackObject = 1;
histimg = Scalar::all(0);
int binW = histimg.cols / hsize;
Mat buf(1, hsize, CV_8UC3);
for( int i = 0; i < hsize; i++ )
buf.at<Vec3b>(i) = Vec3b(saturate_cast<uchar>(i*180./hsize), 255, 255);
cvtColor(buf, buf, CV_HSV2BGR);
for( int i = 0; i < hsize; i++ )
{
int val = saturate_cast<int>(hist.at<float>(i)*histimg.rows/255);
rectangle( histimg, Point(i*binW,histimg.rows),
Point((i+1)*binW,histimg.rows - val),
Scalar(buf.at<Vec3b>(i)), -1, 8 );
}
}
calcBackProject(&hue, 1, 0, hist, backproj, &phranges);
backproj &= mask;
RotatedRect trackBox = CamShift(backproj, trackWindow,
TermCriteria( CV_TERMCRIT_EPS | CV_TERMCRIT_ITER, 10, 1 ));
if( trackWindow.area() <= 1 )
{
int cols = backproj.cols, rows = backproj.rows, r = (MIN(cols, rows) + 5)/6;
trackWindow = Rect(trackWindow.x - r, trackWindow.y - r,
trackWindow.x + r, trackWindow.y + r) &
Rect(0, 0, cols, rows);
}
2010-11-28 20:41:55 +01:00
if( backprojMode )
cvtColor( backproj, image, CV_GRAY2BGR );
ellipse( image, trackBox, Scalar(0,0,255), 3, CV_AA );
}
}
else if( trackObject < 0 )
paused = false;
2010-11-28 20:41:55 +01:00
if( selectObject && selection.width > 0 && selection.height > 0 )
{
2010-11-28 20:41:55 +01:00
Mat roi(image, selection);
bitwise_not(roi, roi);
}
2010-11-28 20:41:55 +01:00
imshow( "CamShift Demo", image );
imshow( "Histogram", histimg );
2010-11-28 20:41:55 +01:00
char c = (char)waitKey(10);
if( c == 27 )
break;
2010-11-28 20:41:55 +01:00
switch(c)
{
case 'b':
2010-11-28 20:41:55 +01:00
backprojMode = !backprojMode;
break;
case 'c':
2010-11-28 20:41:55 +01:00
trackObject = 0;
histimg = Scalar::all(0);
break;
case 'h':
2010-11-28 20:41:55 +01:00
showHist = !showHist;
if( !showHist )
destroyWindow( "Histogram" );
else
2010-11-28 20:41:55 +01:00
namedWindow( "Histogram", 1 );
break;
case 'p':
paused = !paused;
break;
default:
;
}
}
return 0;
}