赤色検出

MacbookのWindowsXPでVMWareで動かしてるUbuntuでも動いた。カメラがQV-40で暗すぎるので認識部分の数値いじってある

colortrack.cpp

#include <stdio.h>
#include <highgui.h>
#include <cv.h>


IplImage *img = NULL;
IplImage *imgR, *imgG, *imgB, *imgThreshold_R, *imgThreshold_G, *imgThreshold_B, *imgResult, *imgTmp;

void onMouse(int event, int x, int y, int flags, void* param){
  printf("x:%d y:%d r:%d g:%d b:%d %s", x, y, // マウス座標とRGBを出力
    (unsigned char)imgR->imageDataOrigin[x+y*imgR->width],
    (unsigned char)imgG->imageDataOrigin[x+y*imgG->width],
    (unsigned char)imgB->imageDataOrigin[x+y*imgB->width],
    "\n");
}

int main(int argc, char** argv) {
  bool isStop = false;
  CvCapture *capture = NULL;
  capture = cvCreateCameraCapture(0);
  //capture = cvCaptureFromAVI("test.avi");
  if(capture == NULL){
    printf("capture device not found!!");
    return -1;
  }

  img = cvQueryFrame(capture);
  const int w = img->width;
  const int h = img->height;

  imgR = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgG = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgB = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgThreshold_R = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgThreshold_G = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgThreshold_B = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgResult = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);
  imgTmp = cvCreateImage(cvSize(w, h), IPL_DEPTH_8U, 1);

  char winNameCapture[] = "Capture";
  char winNameResult[] = "Result";

  cvNamedWindow(winNameCapture, CV_WINDOW_AUTOSIZE);
  cvNamedWindow(winNameResult, CV_WINDOW_AUTOSIZE);

  cvSetMouseCallback(winNameCapture, onMouse, 0);
  cvSetMouseCallback(winNameResult, onMouse, 0);

  int waitKey;
  while (1) {
    if(!isStop){
      if((img = cvQueryFrame(capture)) == NULL) break;
      cvSplit(img, imgB, imgG, imgR, NULL); // BGRを分解

      // 赤の要素が10以上で、緑と青より1.3倍以上あるピクセルを抽出
      cvThreshold(imgR, imgThreshold_R, 10, 255, CV_THRESH_BINARY);
      cvDiv(imgR, imgG, imgTmp, 10); // 10倍
      cvThreshold(imgTmp, imgThreshold_G, 13, 255, CV_THRESH_BINARY);
      cvDiv(imgR, imgB, imgTmp, 10);
      cvThreshold(imgTmp, imgThreshold_B, 13, 255, CV_THRESH_BINARY);
      cvAnd(imgThreshold_G, imgThreshold_B, imgTmp, NULL);
      cvAnd(imgTmp, imgThreshold_R, imgResult, NULL);

      cvShowImage(winNameCapture, img);
      cvShowImage(winNameResult, imgResult);
    }

    waitKey = cvWaitKey(33);
    if(waitKey == 'q') break;
    if(waitKey == ' '){
      isStop = !isStop;
      if(isStop) printf("stop\n");
      else printf("start\n");
    }
  }
  
  cvReleaseCapture(&capture);
  cvDestroyWindow(winNameCapture);
  cvDestroyWindow(winNameResult);
  return 0;
}

Makefile

SRC = colortrack.cpp
DST = colortrack

prefix=/usr
INCPATH=$(prefix)/include
LIBPATH=$(prefix)/lib 

OPT= -lcv -lcvaux -lcxcore -lhighgui 

CC=g++ -O

CFLAGS= -I$(INCPATH)/opencv
LDFLAGS=-L. -L$(LIBPATH) 


all:
        $(CC) $(SRC)  -o $(DST) $(CFLAGS)  $(LDFLAGS) $(OPT)