From 44daa7febd0518b7493e2061c06645efc38fac07 Mon Sep 17 00:00:00 2001 From: "N.N." Date: Sat, 19 Sep 2009 14:29:24 +0000 Subject: added pdp_opencv_contour_convexhull svn path=/trunk/externals/pdp_opencv/; revision=12403 --- pdp_opencv_contours_convexhull.c | 403 +++++++++++++++++++++++++++++++++++++++ 1 file changed, 403 insertions(+) create mode 100644 pdp_opencv_contours_convexhull.c (limited to 'pdp_opencv_contours_convexhull.c') diff --git a/pdp_opencv_contours_convexhull.c b/pdp_opencv_contours_convexhull.c new file mode 100644 index 0000000..5854f02 --- /dev/null +++ b/pdp_opencv_contours_convexhull.c @@ -0,0 +1,403 @@ +/* + * Pure Data Packet module. + * Copyright (c) by Tom Schouten + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + * + */ + +#include +#include +#include +#include +#include +#include +#include + +#include "pdp.h" + +#ifndef _EiC +#include "cv.h" +#endif + +#define MAX_MARKERS 100 + +typedef struct pdp_opencv_contours_convexhull_struct +{ + t_object x_obj; + t_float x_f; + + t_outlet *x_outlet0; + t_outlet *x_dataout; + t_outlet *x_countout; + t_atom rlist[5]; + int x_packet0; + int x_packet1; + int x_dropped; + int x_queue_id; + + // contours retrieval mode + int x_cmode; + // contours retrieval method + int x_cmethod; + + int x_width; + int x_height; + int x_size; + + int x_nightmode; // don't show the original image + + IplImage *image, *gray, *cnt_img; + +} t_pdp_opencv_contours_convexhull; + +static void pdp_opencv_contours_convexhull_process_rgb(t_pdp_opencv_contours_convexhull *x) +{ + t_pdp *header = pdp_packet_header(x->x_packet0); + short int *data = (short int *)pdp_packet_data(x->x_packet0); + t_pdp *newheader = pdp_packet_header(x->x_packet1); + short int *newdata = (short int *)pdp_packet_data(x->x_packet1); + char tindex[4]; + int i = 0; // Indicator of cycles. + int j=0; + int k = 0; + int area = 0; + int selected = -1; + CvSeq* first_contour; + CvSeq* defects; + CvSeq* contours; + int* hull; + int hullsize; + CvPoint* PointArray; + CvConvexityDefect* defectArray; + CvMemStorage* stor02; + CvMemStorage* stor03; + + stor02 = cvCreateMemStorage(0); + stor03 = cvCreateMemStorage(0); + + if ((x->x_width != (t_int)header->info.image.width) || + (x->x_height != (t_int)header->info.image.height)) + { + + post("pdp_opencv_contours_convexhull :: resizing plugins"); + + + x->x_width = header->info.image.width; + x->x_height = header->info.image.height; + x->x_size = x->x_width*x->x_height; + + //Destroy cv_images + cvReleaseImage(&x->image); + cvReleaseImage(&x->gray); + cvReleaseImage(&x->cnt_img); + + //create the orig image with new size + x->image = cvCreateImage(cvSize(x->x_width,x->x_height), IPL_DEPTH_8U, 3); + + // Create the output images with new sizes + x->gray = cvCreateImage(cvSize(x->image->width,x->image->height), IPL_DEPTH_8U, 1); + x->cnt_img = cvCreateImage(cvSize(x->image->width,x->image->height), IPL_DEPTH_8U, 3); + + } + + newheader->info.image.encoding = header->info.image.encoding; + newheader->info.image.width = x->x_width; + newheader->info.image.height = x->x_height; + + memcpy( x->image->imageData, data, x->x_size*3 ); + + // Convert to grayscale + cvCvtColor(x->image, x->gray, CV_BGR2GRAY); + + // Retrieval mode. + // CV_RETR_EXTERNAL || CV_RETR_LIST || CV_RETR_CCOMP || CV_RETR_TREE + // Approximation method. + // CV_CHAIN_CODE || CV_CHAIN_APPROX_NONE || CV_CHAIN_APPROX_SIMPLE || CV_CHAIN_APPROX_TC89_L1 || CV_CHAIN_APPROX_TC89_KCOS || CV_LINK_RUNS + + cvFindContours( x->gray, stor02, &contours, sizeof(CvContour), x->x_cmode, x->x_cmethod, cvPoint(0,0) ); + if (contours) contours = cvApproxPoly( contours, sizeof(CvContour), stor02, CV_POLY_APPROX_DP, 3, 1 ); + + cvCopy(x->image, x->cnt_img, NULL); + if ( x->x_nightmode ) + { + cvZero( x->cnt_img ); + } + + first_contour = contours; + + // searching for biggest contour + for( ; contours != 0; contours = contours->h_next ) + { + CvRect rect; + rect = cvContourBoundingRect(contours, 1); + if ( (rect.width*rect.height) > area ) + { + selected = i; + area = rect.width*rect.height; + } + i++; + } + + contours = first_contour; + for( ; contours != 0; contours = contours->h_next ) + { + int count = contours->total; // This is number point in contour + CvPoint center; + CvSize size; + CvRect rect; + + rect = cvContourBoundingRect( contours, 1); + if ( (k==selected) ) + { + PointArray = (CvPoint*)malloc( count*sizeof(CvPoint) ); + hull = (int*)malloc(sizeof(int)*count); + cvCvtSeqToArray(contours, PointArray, CV_WHOLE_SEQ); + + cvConvexHull( PointArray, + count, + NULL, + CV_COUNTER_CLOCKWISE, + hull, + &hullsize); + + outlet_float( x->x_countout, hullsize ); + + t_atom rlist[hullsize*2]; + + // Draw convex hull for current contour. + for(i=0; icnt_img, PointArray[hull[i]], PointArray[hull[i+1]],CV_RGB(0,0,255),1, CV_AA, 0 ); + SETFLOAT(&rlist[j], PointArray[hull[i]].x); + SETFLOAT(&rlist[j+1], PointArray[hull[i]].y); + j = j + 2; + } + + cvLine(x->cnt_img, PointArray[hull[hullsize-1]], PointArray[hull[0]],CV_RGB(0,0,255),1, CV_AA, 0 ); + SETFLOAT(&rlist[j], PointArray[hull[i]].x); + SETFLOAT(&rlist[j+1], PointArray[hull[i]].y); + outlet_list( x->x_dataout, 0, hullsize*2, rlist ); + + free(PointArray); + free(hull); + } + k++; + } + + cvReleaseMemStorage( &stor03 ); + cvReleaseMemStorage( &stor02 ); + + memcpy( newdata, x->cnt_img->imageData, x->x_size*3 ); + + return; +} + +static void pdp_opencv_contours_convexhull_nightmode(t_pdp_opencv_contours_convexhull *x, t_floatarg f) +{ + if ( ((int)f==1) || ((int)f==0) ) x->x_nightmode = (int)f; +} + +static void pdp_opencv_contours_convexhull_cmode(t_pdp_opencv_contours_convexhull *x, t_floatarg f) +{ + // CV_RETR_EXTERNAL || CV_RETR_LIST || CV_RETR_CCOMP || CV_RETR_TREE + int mode = (int)f; + + if ( mode == CV_RETR_EXTERNAL ) + { + x->x_cmode = CV_RETR_EXTERNAL; + post( "pdp_opencv_contours_convexhull : mode set to CV_RETR_EXTERNAL" ); + } + if ( mode == CV_RETR_LIST ) + { + x->x_cmode = CV_RETR_LIST; + post( "pdp_opencv_contours_convexhull : mode set to CV_RETR_LIST" ); + } + if ( mode == CV_RETR_CCOMP ) + { + x->x_cmode = CV_RETR_CCOMP; + post( "pdp_opencv_contours_convexhull : mode set to CV_RETR_CCOMP" ); + } + if ( mode == CV_RETR_TREE ) + { + x->x_cmode = CV_RETR_TREE; + post( "pdp_opencv_contours_convexhull : mode set to CV_RETR_TREE" ); + } +} + +static void pdp_opencv_contours_convexhull_cmethod(t_pdp_opencv_contours_convexhull *x, t_floatarg f) +{ + int method = (int)f; + + // CV_CHAIN_CODE || CV_CHAIN_APPROX_NONE || CV_CHAIN_APPROX_SIMPLE || CV_CHAIN_APPROX_TC89_L1 || CV_CHAIN_APPROX_TC89_KCOS || CV_LINK_RUNS + if ( method == CV_CHAIN_CODE ) + { + post( "pdp_opencv_contours_convexhull : not supported method : CV_CHAIN_CODE" ); + } + if ( method == CV_CHAIN_APPROX_NONE ) + { + x->x_cmethod = CV_CHAIN_APPROX_NONE; + post( "pdp_opencv_contours_convexhull : method set to CV_CHAIN_APPROX_NONE" ); + } + if ( method == CV_CHAIN_APPROX_SIMPLE ) + { + x->x_cmethod = CV_CHAIN_APPROX_SIMPLE; + post( "pdp_opencv_contours_convexhull : method set to CV_CHAIN_APPROX_SIMPLE" ); + } + if ( method == CV_CHAIN_APPROX_TC89_L1 ) + { + x->x_cmethod = CV_CHAIN_APPROX_TC89_L1; + post( "pdp_opencv_contours_convexhull : method set to CV_CHAIN_APPROX_TC89_L1" ); + } + if ( method == CV_CHAIN_APPROX_TC89_KCOS ) + { + x->x_cmethod = CV_CHAIN_APPROX_TC89_KCOS; + post( "pdp_opencv_contours_convexhull : method set to CV_CHAIN_APPROX_TC89_KCOS" ); + } + if ( ( method == CV_LINK_RUNS ) && ( x->x_cmode == CV_RETR_LIST ) ) + { + x->x_cmethod = CV_LINK_RUNS; + post( "pdp_opencv_contours_convexhull : method set to CV_LINK_RUNS" ); + } +} + +static void pdp_opencv_contours_convexhull_sendpacket(t_pdp_opencv_contours_convexhull *x) +{ + /* release the packet */ + pdp_packet_mark_unused(x->x_packet0); + x->x_packet0 = -1; + + /* unregister and propagate if valid dest packet */ + pdp_packet_pass_if_valid(x->x_outlet0, &x->x_packet1); +} + +static void pdp_opencv_contours_convexhull_process(t_pdp_opencv_contours_convexhull *x) +{ + int encoding; + t_pdp *header = 0; + char *parname; + unsigned pi; + int partype; + float pardefault; + t_atom plist[2]; + t_atom tlist[2]; + t_atom vlist[2]; + + /* check if image data packets are compatible */ + if ( (header = pdp_packet_header(x->x_packet0)) + && (PDP_BITMAP == header->type)){ + + /* pdp_opencv_contours_convexhull_process inputs and write into active inlet */ + switch(pdp_packet_header(x->x_packet0)->info.image.encoding){ + + case PDP_BITMAP_RGB: + x->x_packet1 = pdp_packet_clone_rw(x->x_packet0); + pdp_queue_add(x, pdp_opencv_contours_convexhull_process_rgb, pdp_opencv_contours_convexhull_sendpacket, &x->x_queue_id); + break; + + default: + /* don't know the type, so dont pdp_opencv_contours_convexhull_process */ + break; + + } + } + +} + +static void pdp_opencv_contours_convexhull_input_0(t_pdp_opencv_contours_convexhull *x, t_symbol *s, t_floatarg f) +{ + /* if this is a register_ro message or register_rw message, register with packet factory */ + + if (s == gensym("register_rw")) + x->x_dropped = pdp_packet_convert_ro_or_drop(&x->x_packet0, (int)f, pdp_gensym("bitmap/rgb/*") ); + + if ((s == gensym("process")) && (-1 != x->x_packet0) && (!x->x_dropped)) + { + /* add the process method and callback to the process queue */ + pdp_opencv_contours_convexhull_process(x); + } +} + +static void pdp_opencv_contours_convexhull_free(t_pdp_opencv_contours_convexhull *x) +{ + int i; + + pdp_queue_finish(x->x_queue_id); + pdp_packet_mark_unused(x->x_packet0); + + //Destroy cv_images + cvReleaseImage(&x->image); + cvReleaseImage(&x->gray); + cvReleaseImage(&x->cnt_img); +} + +t_class *pdp_opencv_contours_convexhull_class; + + +void *pdp_opencv_contours_convexhull_new(t_floatarg f) +{ + int i; + + t_pdp_opencv_contours_convexhull *x = (t_pdp_opencv_contours_convexhull *)pd_new(pdp_opencv_contours_convexhull_class); + + x->x_outlet0 = outlet_new(&x->x_obj, &s_anything); + x->x_countout = outlet_new(&x->x_obj, &s_float); + x->x_dataout = outlet_new(&x->x_obj, &s_anything); + + x->x_packet0 = -1; + x->x_packet1 = -1; + x->x_queue_id = -1; + + x->x_width = 320; + x->x_height = 240; + x->x_size = x->x_width * x->x_height; + + x->x_cmode = CV_RETR_LIST; + x->x_cmethod = CV_CHAIN_APPROX_SIMPLE; + + x->x_nightmode = 0; + + x->image = cvCreateImage(cvSize(x->x_width,x->x_height), IPL_DEPTH_8U, 3); + x->gray = cvCreateImage(cvSize(x->image->width,x->image->height), IPL_DEPTH_8U, 1); + x->cnt_img = cvCreateImage(cvSize(x->image->width,x->image->height), IPL_DEPTH_8U, 3); + + //contours = 0; + return (void *)x; +} + + +#ifdef __cplusplus +extern "C" +{ +#endif + + +void pdp_opencv_contours_convexhull_setup(void) +{ + + post( " pdp_opencv_contours_convexhull"); + pdp_opencv_contours_convexhull_class = class_new(gensym("pdp_opencv_contours_convexhull"), (t_newmethod)pdp_opencv_contours_convexhull_new, + (t_method)pdp_opencv_contours_convexhull_free, sizeof(t_pdp_opencv_contours_convexhull), 0, A_DEFFLOAT, A_NULL); + + class_addmethod(pdp_opencv_contours_convexhull_class, (t_method)pdp_opencv_contours_convexhull_input_0, gensym("pdp"), A_SYMBOL, A_DEFFLOAT, A_NULL); + class_addmethod(pdp_opencv_contours_convexhull_class, (t_method)pdp_opencv_contours_convexhull_cmode, gensym("mode"), A_FLOAT, A_NULL ); + class_addmethod(pdp_opencv_contours_convexhull_class, (t_method)pdp_opencv_contours_convexhull_cmethod, gensym("method"), A_FLOAT, A_NULL ); + class_addmethod(pdp_opencv_contours_convexhull_class, (t_method)pdp_opencv_contours_convexhull_nightmode, gensym("nightmode"), A_FLOAT, A_NULL ); + +} + +#ifdef __cplusplus +} +#endif -- cgit v1.2.1