1 /*M/////////////////////////////////////////////////////////////////////////////////////// 2 // 3 // IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING. 4 // 5 // By downloading, copying, installing or using the software you agree to this license. 6 // If you do not agree to this license, do not download, install, 7 // copy or use the software. 8 // 9 // 10 // Intel License Agreement 11 // For Open Source Computer Vision Library 12 // 13 // Copyright (C) 2000, Intel Corporation, all rights reserved. 14 // Third party copyrights are property of their respective owners. 15 // 16 // Redistribution and use in source and binary forms, with or without modification, 17 // are permitted provided that the following conditions are met: 18 // 19 // * Redistribution's of source code must retain the above copyright notice, 20 // this list of conditions and the following disclaimer. 21 // 22 // * Redistribution's in binary form must reproduce the above copyright notice, 23 // this list of conditions and the following disclaimer in the documentation 24 // and/or other materials provided with the distribution. 25 // 26 // * The name of Intel Corporation may not be used to endorse or promote products 27 // derived from this software without specific prior written permission. 28 // 29 // This software is provided by the copyright holders and contributors "as is" and 30 // any express or implied warranties, including, but not limited to, the implied 31 // warranties of merchantability and fitness for a particular purpose are disclaimed. 32 // In no event shall the Intel Corporation or contributors be liable for any direct, 33 // indirect, incidental, special, exemplary, or consequential damages 34 // (including, but not limited to, procurement of substitute goods or services; 35 // loss of use, data, or profits; or business interruption) however caused 36 // and on any theory of liability, whether in contract, strict liability, 37 // or tort (including negligence or otherwise) arising in any way out of 38 // the use of this software, even if advised of the possibility of such damage. 39 // 40 //M*/ 41 42 #include "_cvaux.h" 43 44 CV_IMPL int 45 icvSubdiv2DCheck( CvSubdiv2D* subdiv ) 46 { 47 int i, j, total = subdiv->edges->total; 48 int check_result = 0; 49 50 CV_FUNCNAME("icvSubdiv2DCheck"); 51 52 __BEGIN__; 53 54 if( !subdiv ) 55 CV_ERROR_FROM_STATUS( CV_NULLPTR_ERR ); 56 57 for( i = 0; i < total; i++ ) 58 { 59 CvQuadEdge2D* edge = (CvQuadEdge2D*)cvGetSetElem(subdiv->edges,i); 60 61 if( edge && CV_IS_SET_ELEM( edge )) 62 { 63 for( j = 0; j < 4; j++ ) 64 { 65 CvSubdiv2DEdge e = (CvSubdiv2DEdge)edge + j; 66 CvSubdiv2DEdge o_next = cvSubdiv2DNextEdge(e); 67 CvSubdiv2DEdge o_prev = cvSubdiv2DGetEdge(e, CV_PREV_AROUND_ORG ); 68 CvSubdiv2DEdge d_prev = cvSubdiv2DGetEdge(e, CV_PREV_AROUND_DST ); 69 CvSubdiv2DEdge d_next = cvSubdiv2DGetEdge(e, CV_NEXT_AROUND_DST ); 70 71 // check points 72 if( cvSubdiv2DEdgeOrg(e) != cvSubdiv2DEdgeOrg(o_next)) 73 EXIT; 74 if( cvSubdiv2DEdgeOrg(e) != cvSubdiv2DEdgeOrg(o_prev)) 75 EXIT; 76 if( cvSubdiv2DEdgeDst(e) != cvSubdiv2DEdgeDst(d_next)) 77 EXIT; 78 if( cvSubdiv2DEdgeDst(e) != cvSubdiv2DEdgeDst(d_prev)) 79 EXIT; 80 if( j % 2 == 0 ) 81 { 82 if( cvSubdiv2DEdgeDst(o_next) != cvSubdiv2DEdgeOrg(d_prev)) 83 EXIT; 84 if( cvSubdiv2DEdgeDst(o_prev) != cvSubdiv2DEdgeOrg(d_next)) 85 EXIT; 86 if( cvSubdiv2DGetEdge(cvSubdiv2DGetEdge(cvSubdiv2DGetEdge( 87 e,CV_NEXT_AROUND_LEFT),CV_NEXT_AROUND_LEFT),CV_NEXT_AROUND_LEFT) != e ) 88 EXIT; 89 if( cvSubdiv2DGetEdge(cvSubdiv2DGetEdge(cvSubdiv2DGetEdge( 90 e,CV_NEXT_AROUND_RIGHT),CV_NEXT_AROUND_RIGHT),CV_NEXT_AROUND_RIGHT) != e) 91 EXIT; 92 } 93 } 94 } 95 } 96 97 check_result = 1; 98 99 __END__; 100 101 return check_result; 102 } 103 104 105 106 static void 107 draw_subdiv_facet( CvSubdiv2D * subdiv, IplImage * dst, IplImage * src, CvSubdiv2DEdge edge ) 108 { 109 CvSubdiv2DEdge t = edge; 110 int i, count = 0; 111 CvPoint local_buf[100]; 112 CvPoint *buf = local_buf; 113 114 // count number of edges in facet 115 do 116 { 117 count++; 118 t = cvSubdiv2DGetEdge( t, CV_NEXT_AROUND_LEFT ); 119 } 120 while( t != edge && count < subdiv->quad_edges * 4 ); 121 122 if( count * sizeof( buf[0] ) > sizeof( local_buf )) 123 { 124 buf = (CvPoint *) malloc( count * sizeof( buf[0] )); 125 } 126 127 // gather points 128 t = edge; 129 for( i = 0; i < count; i++ ) 130 { 131 CvSubdiv2DPoint *pt = cvSubdiv2DEdgeOrg( t ); 132 133 if( !pt ) 134 break; 135 assert( fabs( pt->pt.x ) < 10000 && fabs( pt->pt.y ) < 10000 ); 136 buf[i] = cvPoint( cvRound( pt->pt.x ), cvRound( pt->pt.y )); 137 t = cvSubdiv2DGetEdge( t, CV_NEXT_AROUND_LEFT ); 138 } 139 140 if( i == count ) 141 { 142 CvSubdiv2DPoint *pt = cvSubdiv2DEdgeDst( cvSubdiv2DRotateEdge( edge, 1 )); 143 CvPoint ip = cvPoint( cvRound( pt->pt.x ), cvRound( pt->pt.y )); 144 CvScalar color = {{0,0,0,0}}; 145 146 //printf("count = %d, (%d,%d)\n", ip.x, ip.y ); 147 148 if( 0 <= ip.x && ip.x < src->width && 0 <= ip.y && ip.y < src->height ) 149 { 150 uchar *ptr = (uchar*)(src->imageData + ip.y * src->widthStep + ip.x * 3); 151 color = CV_RGB( ptr[2], ptr[1], ptr[0] ); 152 } 153 154 cvFillConvexPoly( dst, buf, count, color ); 155 //draw_subdiv_point( dst, pt->pt, CV_RGB(0,0,0)); 156 } 157 158 if( buf != local_buf ) 159 free( buf ); 160 } 161 162 163 CV_IMPL void 164 icvDrawMosaic( CvSubdiv2D * subdiv, IplImage * src, IplImage * dst ) 165 { 166 int i, total = subdiv->edges->total; 167 168 cvCalcSubdivVoronoi2D( subdiv ); 169 170 //icvSet( dst, 255 ); 171 for( i = 0; i < total; i++ ) 172 { 173 CvQuadEdge2D *edge = (CvQuadEdge2D *) cvGetSetElem( subdiv->edges, i ); 174 175 if( edge && CV_IS_SET_ELEM( edge )) 176 { 177 CvSubdiv2DEdge e = (CvSubdiv2DEdge) edge; 178 179 // left 180 draw_subdiv_facet( subdiv, dst, src, cvSubdiv2DRotateEdge( e, 1 )); 181 // right 182 draw_subdiv_facet( subdiv, dst, src, cvSubdiv2DRotateEdge( e, 3 )); 183 } 184 } 185 } 186 187 /* End of file. */ 188