+++ /dev/null
-/*M///////////////////////////////////////////////////////////////////////////////////////
-//
-// IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
-//
-// By downloading, copying, installing or using the software you agree to this license.
-// If you do not agree to this license, do not download, install,
-// copy or use the software.
-//
-//
-// Intel License Agreement
-// For Open Source Computer Vision Library
-//
-// Copyright (C) 2000, Intel Corporation, all rights reserved.
-// Third party copyrights are property of their respective owners.
-//
-// Redistribution and use in source and binary forms, with or without modification,
-// are permitted provided that the following conditions are met:
-//
-// * Redistribution's of source code must retain the above copyright notice,
-// this list of conditions and the following disclaimer.
-//
-// * Redistribution's in binary form must reproduce the above copyright notice,
-// this list of conditions and the following disclaimer in the documentation
-// and/or other materials provided with the distribution.
-//
-// * The name of Intel Corporation may not be used to endorse or promote products
-// derived from this software without specific prior written permission.
-//
-// This software is provided by the copyright holders and contributors "as is" and
-// any express or implied warranties, including, but not limited to, the implied
-// warranties of merchantability and fitness for a particular purpose are disclaimed.
-// In no event shall the Intel Corporation or contributors be liable for any direct,
-// indirect, incidental, special, exemplary, or consequential damages
-// (including, but not limited to, procurement of substitute goods or services;
-// loss of use, data, or profits; or business interruption) however caused
-// and on any theory of liability, whether in contract, strict liability,
-// or tort (including negligence or otherwise) arising in any way out of
-// the use of this software, even if advised of the possibility of such damage.
-//
-//M*/
-
-/* Reconstruction of contour skeleton */
-#include "_cvaux.h"
-#include <time.h>
-
-#define NEXT_SEQ(seq,seq_first) ((seq) == (seq_first) ? seq->v_next : seq->h_next)
-#define SIGN(x) ( x<0 ? -1:( x>0 ? 1:0 ) )
-
-const float LEE_CONST_ZERO = 1e-6f;
-const float LEE_CONST_DIFF_POINTS = 1e-2f;
-const float LEE_CONST_ACCEPTABLE_ERROR = 1e-4f;
-
-/****************************************************************************************\
-* Auxiliary struct definitions *
-\****************************************************************************************/
-
-template<class T>
-struct CvLeePoint
-{
- T x,y;
-};
-
-typedef CvLeePoint<float> CvPointFloat;
-typedef CvLeePoint<float> CvDirection;
-
-struct CvVoronoiSiteInt;
-struct CvVoronoiEdgeInt;
-struct CvVoronoiNodeInt;
-struct CvVoronoiParabolaInt;
-struct CvVoronoiChainInt;
-struct CvVoronoiHoleInt;
-
-struct CvVoronoiDiagramInt
-{
- CvSeq* SiteSeq;
- CvSeq* EdgeSeq;
- CvSeq* NodeSeq;
- CvSeq* ChainSeq;
- CvSeq* ParabolaSeq;
- CvSeq* DirectionSeq;
- CvSeq* HoleSeq;
- CvVoronoiSiteInt* reflex_site;
- CvVoronoiHoleInt* top_hole;
-};
-
-struct CvVoronoiStorageInt
-{
- CvMemStorage* SiteStorage;
- CvMemStorage* EdgeStorage;
- CvMemStorage* NodeStorage;
- CvMemStorage* ChainStorage;
- CvMemStorage* ParabolaStorage;
- CvMemStorage* DirectionStorage;
- CvMemStorage* HoleStorage;
-};
-
-struct CvVoronoiNodeInt
-{
- CvPointFloat node;
- float radius;
-};
-
-struct CvVoronoiSiteInt
-{
- CvVoronoiNodeInt* node1;
- CvVoronoiNodeInt* node2;
- CvVoronoiEdgeInt* edge1;
- CvVoronoiEdgeInt* edge2;
- CvVoronoiSiteInt* next_site;
- CvVoronoiSiteInt* prev_site;
- CvDirection* direction;
-};
-
-struct CvVoronoiEdgeInt
-{
- CvVoronoiNodeInt* node1;
- CvVoronoiNodeInt* node2;
- CvVoronoiSiteInt* site;
- CvVoronoiEdgeInt* next_edge;
- CvVoronoiEdgeInt* prev_edge;
- CvVoronoiEdgeInt* twin_edge;
- CvVoronoiParabolaInt* parabola;
- CvDirection* direction;
-};
-
-struct CvVoronoiParabolaInt
-{
- float map[6];
- float a;
- CvVoronoiNodeInt* focus;
- CvVoronoiSiteInt* directrice;
-};
-
-struct CvVoronoiChainInt
-{
- CvVoronoiSiteInt * first_site;
- CvVoronoiSiteInt * last_site;
- CvVoronoiChainInt* next_chain;
-};
-
-struct CvVoronoiHoleInt
-{
- CvSeq* SiteSeq;
- CvSeq* ChainSeq;
- CvVoronoiSiteInt* site_top;
- CvVoronoiSiteInt* site_nearest;
- CvVoronoiSiteInt* site_opposite;
- CvVoronoiNodeInt* node;
- CvVoronoiHoleInt* next_hole;
- bool error;
- float x_coord;
-};
-
-typedef CvVoronoiSiteInt* pCvVoronoiSite;
-typedef CvVoronoiEdgeInt* pCvVoronoiEdge;
-typedef CvVoronoiNodeInt* pCvVoronoiNode;
-typedef CvVoronoiParabolaInt* pCvVoronoiParabola;
-typedef CvVoronoiChainInt* pCvVoronoiChain;
-typedef CvVoronoiHoleInt* pCvVoronoiHole;
-typedef CvPointFloat* pCvPointFloat;
-typedef CvDirection* pCvDirection;
-
-/****************************************************************************************\
-* Function definitions *
-\****************************************************************************************/
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvLee
-// Purpose: Compute Voronoi Diagram for one given polygon with holes
-// Context:
-// Parameters:
-// ContourSeq : in, vertices of polygon.
-// VoronoiDiagramInt : in&out, pointer to struct, which contains the
-// description of Voronoi Diagram.
-// VoronoiStorage: in, storage for Voronoi Diagram.
-// contour_type: in, type of vertices.
-// The possible values are CV_LEE_INT,CV_LEE_FLOAT,CV_LEE_DOUBLE.
-// contour_orientation: in, orientation of polygons.
-// = 1, if contour is left - oriented in left coordinat system
-// =-1, if contour is left - oriented in right coordinat system
-// attempt_number: in, number of unsuccessful attemts made by program to compute
-// the Voronoi Diagram befor return the error
-//
-// Returns: 1, if Voronoi Diagram was succesfully computed
-// 0, if some error occures
-//F*/
-static int _cvLee(CvSeq* ContourSeq,
- CvVoronoiDiagramInt* pVoronoiDiagramInt,
- CvMemStorage* VoronoiStorage,
- CvLeeParameters contour_type,
- int contour_orientation,
- int attempt_number);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConstuctSites
-// Purpose : Compute sites for given polygon with holes
-// (site is an edge of polygon or a reflex vertex).
-// Context:
-// Parameters:
-// ContourSeq : in, vertices of polygon
-// pVoronoiDiagram : in, pointer to struct, which contains the
-// description of Voronoi Diagram
-// contour_type: in, type of vertices. The possible values are
-// CV_LEE_INT,CV_LEE_FLOAT,CV_LEE_DOUBLE.
-// contour_orientation: in, orientation of polygons.
-// = 1, if contour is left - oriented in left coordinat system
-// =-1, if contour is left - oriented in right coordinat system
-// Return: 1, if sites were succesfully constructed
-// 0, if some error occures
-//F*/
-static int _cvConstuctSites(CvSeq* ContourSeq,
- CvVoronoiDiagramInt* pVoronoiDiagram,
- CvLeeParameters contour_type,
- int contour_orientation);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConstructChains
-// Purpose : Compute chains for given polygon with holes.
-// Context:
-// Parameters:
-// pVoronoiDiagram : in, pointer to struct, which contains the
-// description of Voronoi Diagram
-// Return: 1, if chains were succesfully constructed
-// 0, if some error occures
-//F*/
-static int _cvConstructChains(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConstructSkeleton
-// Purpose: Compute skeleton for given collection of sites, using Lee algorithm
-// Context:
-// Parameters:
-// VoronoiDiagram : in, pointer to struct, which contains the
-// description of Voronoi Diagram.
-// Returns: 1, if skeleton was succesfully computed
-// 0, if some error occures
-//F*/
-static int _cvConstructSkeleton(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConstructSiteTree
-// Purpose: Construct tree of sites (by analogy with contour tree).
-// Context:
-// Parameters:
-// VoronoiDiagram : in, pointer to struct, which contains the
-// description of Voronoi Diagram.
-// Returns:
-//F*/
-static void _cvConstructSiteTree(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvReleaseVoronoiStorage
-// Purpose : Function realease storages.
-// The storages are divided into two groups:
-// SiteStorage, EdgeStorage, NodeStorage form the first group;
-// ChainStorage,ParabolaStorage,DirectionStorage,HoleStorage form the second group.
-// Context:
-// Parameters:
-// pVoronoiStorage: in,
-// group1,group2: in, if group1<>0 then storages from first group released
-// if group2<>0 then storages from second group released
-// Return :
-//F*/
-static void _cvReleaseVoronoiStorage(CvVoronoiStorageInt* pVoronoiStorage, int group1, int group2);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConvert
-// Purpose : Function convert internal representation of VD (via
-// structs CvVoronoiSiteInt, CvVoronoiEdgeInt,CvVoronoiNodeInt) into
-// external representation of VD (via structs CvVoronoiSite2D, CvVoronoiEdge2D,
-// CvVoronoiNode2D)
-// Context:
-// Parameters:
-// VoronoiDiagram: in
-// VoronoiStorage: in
-// change_orientation: in, if = -1 then the convertion is accompanied with change
-// of orientation
-//
-// Return: 1, if convertion was succesfully completed
-// 0, if some error occures
-//F*/
-/*
-static int _cvConvert(CvVoronoiDiagram2D* VoronoiDiagram,
- CvMemStorage* VoronoiStorage,
- int change_orientation);
-*/
-static int _cvConvert(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &NewSiteSeqPrev,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage,
- int change_orientation);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConvertSameOrientation
-// Purpose : Function convert internal representation of VD (via
-// structs CvVoronoiSiteInt, CvVoronoiEdgeInt,CvVoronoiNodeInt) into
-// external representation of VD (via structs CvVoronoiSite2D, CvVoronoiEdge2D,
-// CvVoronoiNode2D) without change of orientation
-// Context:
-// Parameters:
-// VoronoiDiagram: in
-// VoronoiStorage: in
-/
-// Return: 1, if convertion was succesfully completed
-// 0, if some error occures
-//F*/
-/*
-static int _cvConvertSameOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvMemStorage* VoronoiStorage);
-*/
-static int _cvConvertSameOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &NewSiteSeqPrev,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage);
-
-/*F///////////////////////////////////////////////////////////////////////////////////////
-// Author: Andrey Sobolev
-// Name: _cvConvertChangeOrientation
-// Purpose : Function convert internal representation of VD (via
-// structs CvVoronoiSiteInt, CvVoronoiEdgeInt,CvVoronoiNodeInt) into
-// external representation of VD (via structs CvVoronoiSite2D, CvVoronoiEdge2D,
-// CvVoronoiNode2D) with change of orientation
-// Context:
-// Parameters:
-// VoronoiDiagram: in
-// VoronoiStorage: in
-/
-// Return: 1, if convertion was succesfully completed
-// 0, if some error occures
-//F*/
-/*
-static int _cvConvertChangeOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvMemStorage* VoronoiStorage);
- */
-static int _cvConvertChangeOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &NewSiteSeqPrev,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute sites for external polygon.
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- ContourSeq : in, vertices of polygon
- pReflexSite: out, pointer to reflex site,if any exist,else NULL
- orientation: in, orientation of contour ( = 1 or = -1)
- type: in, type of vertices. The possible values are (int)1,
- (float)1,(double)1.
- Return: 1, if sites were succesfully constructed
- 0, if some error occures :
- --------------------------------------------------------------------------*/
-template<class T>
-int _cvConstructExtSites(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* ContourSeq,
- int orientation,
- T /*type*/);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute sites for internal polygon (for hole).
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- CurrSiteSeq: in, the sequence for sites to be constructed
- CurrContourSeq : in, vertices of polygon
- pTopSite: out, pointer to the most left site of polygon (it is the most left
- vertex of polygon)
- orientation: in, orientation of contour ( = 1 or = -1)
- type: in, type of vertices. The possible values are (int)1,
- (float)1,(double)1.
- Return: 1, if sites were succesfully constructed
- 0, if some error occures :
- --------------------------------------------------------------------------*/
-template<class T>
-int _cvConstructIntSites(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* CurrSiteSeq,
- CvSeq* CurrContourSeq,
- pCvVoronoiSite &pTopSite,
- int orientation,
- T /*type*/);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the simple chains of sites for external polygon.
- Arguments
- pVoronoiDiagram : in&out, pointer to struct, which contains the
- description of Voronoi Diagram
-
- Return: 1, if chains were succesfully constructed
- 0, if some error occures
- --------------------------------------------------------------------------*/
-static int _cvConstructExtChains(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the simple chains of sites for internal polygon (= hole)
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- CurrSiteSeq : in, the sequence of sites
- CurrChainSeq : in,the sequence for chains to be constructed
- pTopSite : in, the most left site of hole
-
- Return :
- --------------------------------------------------------------------------*/
-static void _cvConstructIntChains(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* CurrChainSeq,
- CvSeq* CurrSiteSeq,
- pCvVoronoiSite pTopSite);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the initial Voronoi Diagram for single site
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pSite: in, pointer to site
-
- Return :
- --------------------------------------------------------------------------*/
-static void _cvConstructEdges(pCvVoronoiSite pSite,CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function moves each node on small random value. The nodes are taken
- from pVoronoiDiagram->NodeSeq.
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- begin,end: in, the first and the last nodes in pVoronoiDiagram->NodeSeq,
- which moves
- shift: in, the value of maximal shift.
- Return :
- --------------------------------------------------------------------------*/
-static void _cvRandomModification(CvVoronoiDiagramInt* pVoronoiDiagram, int begin, int end, float shift);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the internal Voronoi Diagram for external polygon.
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- Return : 1, if VD was constructed succesfully
- 0, if some error occure
- --------------------------------------------------------------------------*/
-static int _cvConstructExtVD(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the external Voronoi Diagram for each internal polygon (hole).
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- Return :
- --------------------------------------------------------------------------*/
-static void _cvConstructIntVD(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function joins the Voronoi Diagrams of different
- chains into one Voronoi Diagram
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pChain1,pChain1: in, given chains
- Return : 1, if joining was succesful
- 0, if some error occure
- --------------------------------------------------------------------------*/
-static int _cvJoinChains(pCvVoronoiChain pChain1,
- pCvVoronoiChain pChain2,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function finds the nearest site for top vertex
- (= the most left vertex) of each hole
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- Return :
- --------------------------------------------------------------------------*/
-static void _cvFindNearestSite(CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function seeks for site, which has common bisector in
- final VD with top vertex of given hole. It stores in pHole->opposite_site.
- The search begins from Hole->nearest_site and realizes in clockwise
- direction around the top vertex of given hole.
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pHole : in, given hole
- Return : 1, if the search was succesful
- 0, if some error occure
- --------------------------------------------------------------------------*/
-static int _cvFindOppositSiteCW(pCvVoronoiHole pHole, CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function seeks for site, which has common bisector in
- final VD with top vertex of given hole. It stores in pHole->opposite_site.
- The search begins from Hole->nearest_site and realizes in counterclockwise
- direction around the top vertex of given hole.
- Arguments
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pHole : in, given hole
- Return : 1, if the search was succesful
- 0, if some error occure
- --------------------------------------------------------------------------*/
-static int _cvFindOppositSiteCCW(pCvVoronoiHole pHole,CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function merges external VD of hole and internal VD, which was
- constructed ealier.
- Arguments
-pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pHole : in, given hole
- Return : 1, if merging was succesful
- 0, if some error occure
- --------------------------------------------------------------------------*/
-static int _cvMergeVD(pCvVoronoiHole pHole,CvVoronoiDiagramInt* pVoronoiDiagram);
-
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Computation of bisectors //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of two sites
- Arguments
- pSite_left,pSite_right: in, given sites
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-void _cvCalcEdge(pCvVoronoiSite pSite_left,
- pCvVoronoiSite pSite_right,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of point and site
- Arguments
- pSite : in, site
- pNode : in, point
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-void _cvCalcEdge(pCvVoronoiSite pSite,
- pCvVoronoiNode pNode,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of point and site
- Arguments
- pSite : in, site
- pNode : in, point
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-void _cvCalcEdge(pCvVoronoiNode pNode,
- pCvVoronoiSite pSite,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the direction of bisector of two segments
- Arguments
- pDirection1: in, direction of first segment
- pDirection2: in, direction of second segment
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvCalcEdgeLL(pCvDirection pDirection1,
- pCvDirection pDirection2,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of two points
- Arguments
- pPoint1, pPoint2: in, given points
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvCalcEdgePP(pCvPointFloat pPoint1,
- pCvPointFloat pPoint2,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of segment and point. Since
- it is parabola, it is defined by its focus (site - point)
- and directrice(site-segment)
- Arguments
- pFocus : in, point, which defines the focus of parabola
- pDirectrice: in, site - segment, which defines the directrice of parabola
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvCalcEdgePL(pCvVoronoiNode pFocus,
- pCvVoronoiSite pDirectrice,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Compute the bisector of segment and point. Since
- it is parabola, it is defined by its focus (site - point)
- and directrice(site-segment)
- Arguments
- pFocus : in, point, which defines the focus of parabola
- pDirectrice: in, site - segment, which defines the directrice of parabola
- pVoronoiDiagram : in, pointer to struct, which contains the
- description of Voronoi Diagram
- pEdge : out, bisector
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvCalcEdgeLP(pCvVoronoiSite pDirectrice,
- pCvVoronoiNode pFocus,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram);
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Computation of intersections of bisectors //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1,pEdge2: in, two edges
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvCalcEdgeIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- CvPointFloat* pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, straight ray
- pEdge2: in, straight ray or segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvLine_LineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, straight ray
- pEdge2: in, parabolic ray or segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvLine_ParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, straight ray
- pEdge2: in, parabolic segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvLine_CloseParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, straight ray
- pEdge2: in, parabolic ray
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvLine_OpenParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, straight ray or segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_LineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, straight ray
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_OpenLineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, straight segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_CloseLineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, parabolic ray or segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_ParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, parabolic ray
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_OpenParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes intersection of two edges. Intersection
- must be the nearest to the marked point on pEdge1
- (this marked point is pEdge1->node1->node).
- Arguments
- pEdge1 : in, parabolic ray
- pEdge2: in, parabolic segment
- pPoint: out, intersection of pEdge1 and pEdge2
- Radius: out, distance between pPoint and sites, assosiated
- with pEdge1 and pEdge2 (pPoint is situated on the equal
- distance from site, assosiated with pEdge1 and from
- site,assosiated with pEdge2)
- Return : distance between pPoint and marked point on pEdge1 or
- : -1, if edges have no intersections
- --------------------------------------------------------------------------*/
-static
-float _cvPar_CloseParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius);
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Subsidiary functions //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge1 : in
- pEdge2 : out
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvMakeTwinEdge(pCvVoronoiEdge pEdge2,
- pCvVoronoiEdge pEdge1);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge : in&out
- pEdge_left_prev : in&out
- pSite_left : in&out
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvStickEdgeLeftBegin(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_left_prev,
- pCvVoronoiSite pSite_left);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge : in&out
- pEdge_right_next : in&out
- pSite_right : in&out
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvStickEdgeRightBegin(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_right_next,
- pCvVoronoiSite pSite_right);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge : in&out
- pEdge_left_next : in&out
- pSite_left : in&out
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvStickEdgeLeftEnd(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_left_next,
- pCvVoronoiSite pSite_left);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge : in&out
- pEdge_right_prev : in&out
- pSite_right : in&out
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvStickEdgeRightEnd(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_right_prev,
- pCvVoronoiSite pSite_right);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge_left_cur : in
- pEdge_left : in
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvTwinNULLLeft(pCvVoronoiEdge pEdge_left_cur,
- pCvVoronoiEdge pEdge_left);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description :
- Arguments
- pEdge_right_cur : in
- pEdge_right : in
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvTwinNULLRight(pCvVoronoiEdge pEdge_right_cur,
- pCvVoronoiEdge pEdge_right);
-
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function initializes the struct CvVoronoiNode
- Arguments
- pNode : out
- pPoint : in,
- radius : in
- Return :
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-void _cvInitVoronoiNode(pCvVoronoiNode pNode,
- T pPoint, float radius = 0);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function initializes the struct CvVoronoiSite
- Arguments
- pSite : out
- pNode1,pNode2,pPrev_site : in
- Return :
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvInitVoronoiSite(pCvVoronoiSite pSite,
- pCvVoronoiNode pNode1,
- pCvVoronoiNode pNode2,
- pCvVoronoiSite pPrev_site);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function pushs the element in the end of the sequence
- end returns its adress
- Arguments
- Seq : in, pointer to the sequence
- Elem : in, element
- Return : pointer to the element in the sequence
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-T _cvSeqPush(CvSeq* Seq, T pElem);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function pushs the element in the begin of the sequence
- end returns its adress
- Arguments
- Seq : in, pointer to the sequence
- Elem : in, element
- Return : pointer to the element in the sequence
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-T _cvSeqPushFront(CvSeq* Seq, T pElem);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function pushs the element pHole in pHoleHierarchy->HoleSeq
- so as all elements in this sequence would be normalized
- according to field .x_coord of element. pHoleHierarchy->TopHole
- points to hole with smallest x_coord.
- Arguments
-pHoleHierarchy : in, pointer to the structur
- pHole : in, element
- Return : pointer to the element in the sequence
- --------------------------------------------------------------------------*/
-CV_INLINE
-void _cvSeqPushInOrder(CvVoronoiDiagramInt* pVoronoiDiagram, pCvVoronoiHole pHole);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function intersects given edge pEdge (and his twin edge)
- by point pNode on two parts
- Arguments
- pEdge : in, given edge
- pNode : in, given point
- EdgeSeq : in
- Return : one of parts
- --------------------------------------------------------------------------*/
-CV_INLINE
-pCvVoronoiEdge _cvDivideRightEdge(pCvVoronoiEdge pEdge,
- pCvVoronoiNode pNode,
- CvSeq* EdgeSeq);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function intersects given edge pEdge (and his twin edge)
- by point pNode on two parts
- Arguments
- pEdge : in, given edge
- pNode : in, given point
- EdgeSeq : in
- Return : one of parts
- --------------------------------------------------------------------------*/
-CV_INLINE
-pCvVoronoiEdge _cvDivideLeftEdge(pCvVoronoiEdge pEdge,
- pCvVoronoiNode pNode,
- CvSeq* EdgeSeq);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : function pushs the element in the end of the sequence
- end returns its adress
- Arguments
- writer: in, writer associated with sequence
- pElem : in, element
- Return : pointer to the element in the sequence
- --------------------------------------------------------------------------*/
-template<class T> CV_INLINE
-T _cvWriteSeqElem(T pElem, CvSeqWriter &writer);
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Mathematical functions //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function changes x and y
- Arguments
- x,y : in&out
- Return :
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-void _cvSwap(T &x, T &y);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the inverse map to the
- given ortogonal affine map
- Arguments
- A : in, given ortogonal affine map
- B : out, inverse map
- Return : 1, if inverse map exist
- 0, else
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-int _cvCalcOrtogInverse(T* B, T* A);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the composition of two affine maps
- Arguments
- A,B : in, given affine maps
- Result: out, composition of A and B (Result = AB)
- Return :
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-void _cvCalcComposition(T* Result,T* A,T* B);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the image of point under
- given affin map
- Arguments
- A : in, affine maps
- pPoint : in, pointer to point
- pImgPoint:out, pointer to image of point
- Return :
- --------------------------------------------------------------------------*/
-template<class T> CV_INLINE
-void _cvCalcPointImage(pCvPointFloat pImgPoint,pCvPointFloat pPoint,T* A);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the image of vector under
- given affin map
- Arguments
- A : in, affine maps
- pVector : in, pointer to vector
- pImgVector:out, pointer to image of vector
- Return :
- --------------------------------------------------------------------------*/
-template<class T> CV_INLINE
-void _cvCalcVectorImage(pCvDirection pImgVector,pCvDirection pVector,T* A);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the distance between the point
- and site. Internal function.
- Arguments
- pPoint : in, point
- pSite : in, site
- Return : distance
- --------------------------------------------------------------------------*/
-CV_INLINE
-float _cvCalcDist(pCvPointFloat pPoint, pCvVoronoiSite pSite);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the distance between two points
- Arguments
- pPoint1,pPoint2 : in, two points
- Return : distance
- --------------------------------------------------------------------------*/
-CV_INLINE
-float _cvPPDist(pCvPointFloat pPoint1,pCvPointFloat pPoint2);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function computes the distance betwin point and
- segment. Internal function.
- Arguments
- pPoint: in, point
- pPoint1,pPoint2 : in, segment [pPoint1,pPoint2]
- Return : distance
- --------------------------------------------------------------------------*/
-CV_INLINE
-float _cvPLDist(pCvPointFloat pPoint,pCvPointFloat pPoint1,pCvDirection pDirection);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function solves the squar equation with real coefficients
- T - float or double
- Arguments
- c2,c1,c0: in, real coefficients of polynom
- X: out, array of roots
- Return : number of roots
- --------------------------------------------------------------------------*/
-template <class T>
-int _cvSolveEqu2thR(T c2, T c1, T c0, T* X);
-
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : Function solves the linear equation with real or complex coefficients
- T - float or double or complex
- Arguments
- c1,c0: in, real or complex coefficients of polynom
- X: out, array of roots
- Return : number of roots
- --------------------------------------------------------------------------*/
-template <class T> CV_INLINE
-int _cvSolveEqu1th(T c1, T c0, T* X);
-
-/****************************************************************************************\
-* Storage Block Increase *
-\****************************************************************************************/
-/*--------------------------------------------------------------------------
- Author : Andrey Sobolev
- Description : For each sequence function creates the memory block sufficient to store
- all elements of sequnce
- Arguments
- pVoronoiDiagramInt: in, pointer to struct, which contains the
- description of Voronoi Diagram.
- vertices_number: in, number of vertices in polygon
- Return :
- --------------------------------------------------------------------------*/
-void _cvSetSeqBlockSize(CvVoronoiDiagramInt* pVoronoiDiagramInt,int vertices_number)
-{
- int N = 2*vertices_number;
- cvSetSeqBlockSize(pVoronoiDiagramInt->SiteSeq,N*pVoronoiDiagramInt->SiteSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->EdgeSeq,3*N*pVoronoiDiagramInt->EdgeSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->NodeSeq,5*N*pVoronoiDiagramInt->NodeSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->ParabolaSeq,N*pVoronoiDiagramInt->ParabolaSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->DirectionSeq,3*N*pVoronoiDiagramInt->DirectionSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->ChainSeq,N*pVoronoiDiagramInt->DirectionSeq->elem_size);
- cvSetSeqBlockSize(pVoronoiDiagramInt->HoleSeq,100*pVoronoiDiagramInt->HoleSeq->elem_size);
-}
-
-/****************************************************************************************\
-* Function realization *
-\****************************************************************************************/
-
-
-CV_IMPL int cvVoronoiDiagramFromContour(CvSeq* ContourSeq,
- CvVoronoiDiagram2D** VoronoiDiagram,
- CvMemStorage* VoronoiStorage,
- CvLeeParameters contour_type,
- int contour_orientation,
- int attempt_number)
-{
- CV_FUNCNAME( "cvVoronoiDiagramFromContour" );
-
- __BEGIN__;
-
- CvSet* SiteSeq = NULL;
- CvSeq* CurContourSeq = NULL;
- CvVoronoiDiagramInt VoronoiDiagramInt;
- CvSeqWriter NodeWriter, EdgeWriter;
- CvMemStorage* storage;
-
- memset( &VoronoiDiagramInt, 0, sizeof(VoronoiDiagramInt) );
-
- if( !ContourSeq )
- CV_ERROR( CV_StsBadArg,"Contour sequence is empty" );
-
- if(!VoronoiStorage)
- CV_ERROR( CV_StsBadArg,"Storage is not initialized" );
-
- if( contour_type < 0 || contour_type > 2)
- CV_ERROR( CV_StsBadArg,"Unsupported parameter: type" );
-
- if( contour_orientation != 1 && contour_orientation != -1)
- CV_ERROR( CV_StsBadArg,"Unsupported parameter: orientation" );
-
- storage = cvCreateChildMemStorage(VoronoiStorage);
- (*VoronoiDiagram) = (CvVoronoiDiagram2D*)cvCreateSet(0,sizeof(CvVoronoiDiagram2D),sizeof(CvVoronoiNode2D), storage);
- storage = cvCreateChildMemStorage(VoronoiStorage);
- (*VoronoiDiagram)->edges = cvCreateSet(0,sizeof(CvSet),sizeof(CvVoronoiEdge2D), storage);
- cvStartAppendToSeq((CvSeq*)(*VoronoiDiagram)->edges, &EdgeWriter);
- cvStartAppendToSeq((CvSeq*)(*VoronoiDiagram), &NodeWriter);
-
- for(CurContourSeq = ContourSeq;\
- CurContourSeq != NULL;\
- CurContourSeq = CurContourSeq->h_next)
- {
- if(_cvLee(CurContourSeq, &VoronoiDiagramInt,VoronoiStorage,contour_type,contour_orientation,attempt_number))
-
- {
- if(!_cvConvert(*VoronoiDiagram,VoronoiDiagramInt,SiteSeq,NodeWriter,EdgeWriter,VoronoiStorage,contour_orientation))
- goto exit;
- }
- else if(CurContourSeq->total >= 3)
- goto exit;
- }
-
- cvEndWriteSeq(&EdgeWriter);
- cvEndWriteSeq(&NodeWriter);
- if(SiteSeq != NULL)
- return 1;
-
-
- __END__;
- return 0;
-}//end of cvVoronoiDiagramFromContour
-
-CV_IMPL int cvVoronoiDiagramFromImage(IplImage* pImage,
- CvSeq** ContourSeq,
- CvVoronoiDiagram2D** VoronoiDiagram,
- CvMemStorage* VoronoiStorage,
- CvLeeParameters regularization_method,
- float approx_precision)
-{
- CV_FUNCNAME( "cvVoronoiDiagramFromContour" );
- int RESULT = 0;
-
- __BEGIN__;
-
- IplImage* pWorkImage = NULL;
- CvSize image_size;
- int i, multiplicator = 3;
-
- int approx_method;
- CvMemStorage* ApproxContourStorage = NULL;
- CvSeq* ApproxContourSeq = NULL;
-
- if( !ContourSeq )
- CV_ERROR( CV_StsBadArg,"Contour sequence is not initialized" );
-
- if( (*ContourSeq)->total != 0)
- CV_ERROR( CV_StsBadArg,"Contour sequence is not empty" );
-
- if(!VoronoiStorage)
- CV_ERROR( CV_StsBadArg,"Storage is not initialized" );
-
- if(!pImage)
- CV_ERROR( CV_StsBadArg,"Image is not initialized" );
-
- if(pImage->nChannels != 1 || pImage->depth != 8)
- CV_ERROR( CV_StsBadArg,"Unsupported image format" );
-
- if(approx_precision<0 && approx_precision != CV_LEE_AUTO)
- CV_ERROR( CV_StsBadArg,"Unsupported presision value" );
-
- switch(regularization_method)
- {
- case CV_LEE_ERODE: image_size.width = pImage->width;
- image_size.height = pImage->height;
- pWorkImage = cvCreateImage(image_size,8,1);
- cvErode(pImage,pWorkImage,0,1);
- approx_method = CV_CHAIN_APPROX_TC89_L1;
- break;
- case CV_LEE_ZOOM: image_size.width = multiplicator*pImage->width;
- image_size.height = multiplicator*pImage->height;
- pWorkImage = cvCreateImage(image_size,8,1);
- cvResize(pImage, pWorkImage, CV_INTER_NN);
- approx_method = CV_CHAIN_APPROX_TC89_L1;
- break;
- case CV_LEE_NON: pWorkImage = pImage;
- approx_method = CV_CHAIN_APPROX_TC89_L1;
- break;
- default: CV_ERROR( CV_StsBadArg,"Unsupported regularisation method" );
- break;
-
- }
-
- cvFindContours(pWorkImage, (*ContourSeq)->storage, ContourSeq, \
- sizeof(CvContour), CV_RETR_CCOMP, approx_method );
-
- if(pWorkImage && pWorkImage != pImage )
- cvReleaseImage(&pWorkImage);
-
- ApproxContourStorage = cvCreateMemStorage(0);
- if(approx_precision > 0)
- {
- ApproxContourSeq = cvApproxPoly(*ContourSeq, sizeof(CvContour), ApproxContourStorage,\
- CV_POLY_APPROX_DP,approx_precision,1);
-
- RESULT = cvVoronoiDiagramFromContour(ApproxContourSeq,VoronoiDiagram,VoronoiStorage,CV_LEE_INT,-1,10);
- }
- else if(approx_precision == CV_LEE_AUTO)
- {
- ApproxContourSeq = *ContourSeq;
- for(i = 1; i < 50; i++)
- {
- RESULT = cvVoronoiDiagramFromContour(ApproxContourSeq,VoronoiDiagram,VoronoiStorage,CV_LEE_INT,-1,1);
- if(RESULT)
- break;
- ApproxContourSeq = cvApproxPoly(ApproxContourSeq, sizeof(CvContour),ApproxContourStorage,\
- CV_POLY_APPROX_DP,(float)i,1);
- }
- }
- else
- RESULT = cvVoronoiDiagramFromContour(*ContourSeq,VoronoiDiagram,VoronoiStorage,CV_LEE_INT,-1,10);
-/*
- if(ApproxContourSeq)
- {
- cvClearMemStorage( (*ContourSeq)->storage );
- *ContourSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvPoint),(*ContourSeq)->storage);
- CvSeqReader reader;
- CvSeqWriter writer;
- CvPoint Point;
- cvStartAppendToSeq(*ContourSeq, &writer);
- cvStartReadSeq(ApproxContourSeq, &reader);
- for(int i = 0;i < ApproxContourSeq->total;i++)
- {
- CV_READ_SEQ_ELEM(Point,reader);
- Point.y = 600 - Point.y;
- CV_WRITE_SEQ_ELEM(Point,writer);
- }
- cvEndWriteSeq(&writer);
- }
- */
-
- cvReleaseMemStorage(&ApproxContourStorage);
-
-
- __END__;
- return RESULT;
-}//end of cvVoronoiDiagramFromImage
-
-CV_IMPL void cvReleaseVoronoiStorage(CvVoronoiDiagram2D* VoronoiDiagram,
- CvMemStorage** pVoronoiStorage)
-{
- /*CV_FUNCNAME( "cvReleaseVoronoiStorage" );*/
- __BEGIN__;
-
- CvSeq* Seq;
-
- if(VoronoiDiagram->storage)
- cvReleaseMemStorage(&VoronoiDiagram->storage);
- for(Seq = (CvSeq*)VoronoiDiagram->sites; Seq != NULL; Seq = Seq->h_next)
- if(Seq->storage)
- cvReleaseMemStorage(&Seq->storage);
- for(Seq = (CvSeq*)VoronoiDiagram->edges; Seq != NULL; Seq = Seq->h_next)
- if(Seq->storage)
- cvReleaseMemStorage(&Seq->storage);
-
- if(*pVoronoiStorage)
- cvReleaseMemStorage(pVoronoiStorage);
-
- __END__;
-}//end of cvReleaseVoronoiStorage
-
-static int _cvLee(CvSeq* ContourSeq,
- CvVoronoiDiagramInt* pVoronoiDiagramInt,
- CvMemStorage* VoronoiStorage,
- CvLeeParameters contour_type,
- int contour_orientation,
- int attempt_number)
-{
- //orientation = 1 for left coordinat system
- //orientation = -1 for right coordinat system
- if(ContourSeq->total<3)
- return 0;
-
- int attempt = 0;
- CvVoronoiStorageInt VoronoiStorageInt;
-
- srand((int)time(NULL));
-
-NEXTATTEMPT:
- VoronoiStorageInt.SiteStorage = cvCreateChildMemStorage(VoronoiStorage);
- VoronoiStorageInt.NodeStorage = cvCreateChildMemStorage(VoronoiStorage);
- VoronoiStorageInt.EdgeStorage = cvCreateChildMemStorage(VoronoiStorage);
- VoronoiStorageInt.ParabolaStorage = cvCreateMemStorage(0);
- VoronoiStorageInt.ChainStorage = cvCreateMemStorage(0);
- VoronoiStorageInt.DirectionStorage = cvCreateMemStorage(0);
- VoronoiStorageInt.HoleStorage = cvCreateMemStorage(0);
-
- pVoronoiDiagramInt->SiteSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiSiteInt),VoronoiStorageInt.SiteStorage);
- pVoronoiDiagramInt->NodeSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiNodeInt),VoronoiStorageInt.NodeStorage);
- pVoronoiDiagramInt->EdgeSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiEdgeInt),VoronoiStorageInt.EdgeStorage);
- pVoronoiDiagramInt->ChainSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiChainInt),VoronoiStorageInt.ChainStorage);
- pVoronoiDiagramInt->DirectionSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvDirection),VoronoiStorageInt.DirectionStorage);
- pVoronoiDiagramInt->ParabolaSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiParabolaInt),VoronoiStorageInt.ParabolaStorage);
- pVoronoiDiagramInt->HoleSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiHoleInt),VoronoiStorageInt.HoleStorage);
-
- _cvSetSeqBlockSize(pVoronoiDiagramInt,ContourSeq->total);
-
- if(!_cvConstuctSites(ContourSeq, pVoronoiDiagramInt, contour_type,contour_orientation))
- {
- attempt = attempt_number;
- goto FAULT;
- }
- _cvRandomModification(pVoronoiDiagramInt, 0,pVoronoiDiagramInt->NodeSeq->total,0.2f);
-
- if(!_cvConstructChains(pVoronoiDiagramInt))
- {
- attempt = attempt_number;
- goto FAULT;
- }
-
- if(!_cvConstructSkeleton(pVoronoiDiagramInt))
- goto FAULT;
-
- _cvConstructSiteTree(pVoronoiDiagramInt);
-
-//SUCCESS:
- _cvReleaseVoronoiStorage(&VoronoiStorageInt,0,1);
- return 1;
-
-FAULT:
- _cvReleaseVoronoiStorage(&VoronoiStorageInt,1,1);
- if(++attempt < attempt_number)
- goto NEXTATTEMPT;
-
- return 0;
-}// end of _cvLee
-
-static int _cvConstuctSites(CvSeq* ContourSeq,
- CvVoronoiDiagramInt* pVoronoiDiagram,
- CvLeeParameters contour_type,
- int contour_orientation)
-{
- pVoronoiDiagram->reflex_site = NULL;
- pVoronoiDiagram->top_hole = NULL;
- int result = 0;
-
- switch(contour_type)
- {
- case CV_LEE_INT : result = _cvConstructExtSites(pVoronoiDiagram,ContourSeq,contour_orientation,(int)1);
- break;
- case CV_LEE_FLOAT : result = _cvConstructExtSites(pVoronoiDiagram,ContourSeq,contour_orientation,(float)1);
- break;
- case CV_LEE_DOUBLE : result = _cvConstructExtSites(pVoronoiDiagram,ContourSeq,contour_orientation,(double)1);
- break;
- default: return 0;
- }
-
- if(!result)
- return 0;
-
- CvSeq* CurSiteSeq;
- CvVoronoiHoleInt Hole = {NULL,NULL,NULL,NULL,NULL,NULL,NULL,false,0};
- pCvVoronoiSite pTopSite = 0;
- for(CvSeq* CurContourSeq = ContourSeq->v_next;\
- CurContourSeq != NULL;\
- CurContourSeq = CurContourSeq->h_next)
- {
- if(CurContourSeq->total == 0)
- continue;
-
- CurSiteSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiSiteInt),pVoronoiDiagram->SiteSeq->storage);
- switch(contour_type)
- {
- case CV_LEE_INT : result = _cvConstructIntSites(pVoronoiDiagram,CurSiteSeq,CurContourSeq,pTopSite,contour_orientation,(int)1);
- break;
- case CV_LEE_FLOAT : result = _cvConstructIntSites(pVoronoiDiagram,CurSiteSeq,CurContourSeq,pTopSite,contour_orientation,(float)1);
- break;
- case CV_LEE_DOUBLE :result = _cvConstructIntSites(pVoronoiDiagram,CurSiteSeq,CurContourSeq,pTopSite,contour_orientation,(double)1);
- break;
- default: result = 0;
- }
- if(!result)
- continue;
-
- Hole.SiteSeq = CurSiteSeq;
- Hole.site_top = pTopSite;
- Hole.x_coord = pTopSite->node1->node.x;
- Hole.error = false;
- _cvSeqPushInOrder(pVoronoiDiagram, &Hole);
- }
- return 1;
-}//end of _cvConstuctSites
-
-static int _cvConstructChains(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- if(!_cvConstructExtChains(pVoronoiDiagram))
- return 0;
-
- CvSeq* CurrChainSeq;
- for(pCvVoronoiHole pHole = pVoronoiDiagram->top_hole;\
- pHole != NULL; \
- pHole = pHole->next_hole)
- {
- pHole->error = false;
- CurrChainSeq = cvCreateSeq(0,sizeof(CvSeq),sizeof(CvVoronoiChainInt),pVoronoiDiagram->ChainSeq->storage);
- _cvConstructIntChains(pVoronoiDiagram,CurrChainSeq,pHole->SiteSeq,pHole->site_top);
- pHole->ChainSeq = CurrChainSeq;
- }
- return 1;
-}//end of _cvConstructChains
-
-static int _cvConstructSkeleton(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- if(!_cvConstructExtVD(pVoronoiDiagram))
- return 0;
- _cvConstructIntVD(pVoronoiDiagram);
- _cvFindNearestSite(pVoronoiDiagram);
-
- float dx,dy;
- int result;
- for(pCvVoronoiHole pHole = pVoronoiDiagram->top_hole;\
- pHole != NULL; pHole = pHole->next_hole)
- {
- if(pHole->error)
- continue;
- dx = pHole->node->node.x - pHole->site_top->node1->node.x;
- dy = pHole->node->node.y - pHole->site_top->node1->node.y;
-
- if(fabs(dy) < 0.01 && dx < 0)
- pHole->site_opposite = pHole->site_nearest;
- else
- {
- if(dy > 0)
- result = _cvFindOppositSiteCCW(pHole,pVoronoiDiagram);
- else
- result = _cvFindOppositSiteCW(pHole,pVoronoiDiagram);
-
- if(!result)
- {
- pHole->error = true;
- continue;
- }
- }
-
- if(!_cvMergeVD(pHole,pVoronoiDiagram))
- return 0;
- }
- return 1;
-}//end of _cvConstructSkeleton
-
-static void _cvConstructSiteTree(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- CvSeq* CurSeq = pVoronoiDiagram->SiteSeq;
- for(pCvVoronoiHole pHole = pVoronoiDiagram->top_hole;\
- pHole != NULL; pHole = pHole->next_hole)
- {
- if(pHole->error)
- continue;
- if(CurSeq == pVoronoiDiagram->SiteSeq)
- {
- CurSeq->v_next = pHole->SiteSeq;
- pHole->SiteSeq->v_prev = CurSeq;
- }
- else
- {
- CurSeq->h_next = pHole->SiteSeq;
- pHole->SiteSeq->h_prev = CurSeq;
- pHole->SiteSeq->v_prev = pVoronoiDiagram->SiteSeq;
- }
- CurSeq = pHole->SiteSeq;
- }
- CurSeq->h_next = NULL;
-}//end of _cvConstructSiteTree
-
-static void _cvRandomModification(CvVoronoiDiagramInt* pVoronoiDiagram, int begin, int end, float shift)
-{
- CvSeqReader Reader;
- pCvVoronoiNode pNode;
- const float rnd_const = shift/RAND_MAX;
- int i;
-
- cvStartReadSeq(pVoronoiDiagram->NodeSeq, &Reader,0);
- for( i = begin; i < end; i++)
- {
- pNode = (pCvVoronoiNode)Reader.ptr;
- pNode->node.x = (float)cvFloor(pNode->node.x) + rand()*rnd_const;
- pNode->node.y = (float)cvFloor(pNode->node.y) + rand()*rnd_const;
- CV_NEXT_SEQ_ELEM( sizeof(CvVoronoiNodeInt), Reader );
- }
-
- for(pCvVoronoiHole pHole = pVoronoiDiagram->top_hole;\
- pHole != NULL;\
- pHole = pHole->next_hole)
- {
- pHole->site_top->node1->node.x = (float)cvFloor(pHole->site_top->node1->node.x);
- }
-
-}//end of _cvRandomModification
-
-static void _cvReleaseVoronoiStorage(CvVoronoiStorageInt* pVoronoiStorage, int group1, int group2)
-{
- //if group1 = 1 then SiteSeq, NodeSeq, EdgeSeq released
- //if group2 = 1 then DirectionSeq, ParabolaSeq, ChainSeq, HoleSeq released
- if(group1 == 1)
- {
- if(pVoronoiStorage->SiteStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->SiteStorage);
- if(pVoronoiStorage->EdgeStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->EdgeStorage);
- if(pVoronoiStorage->NodeStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->NodeStorage);
- }
- if(group2 == 1)
- {
- if(pVoronoiStorage->ParabolaStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->ParabolaStorage);
- if(pVoronoiStorage->ChainStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->ChainStorage);
- if(pVoronoiStorage->DirectionStorage!=NULL)
- cvReleaseMemStorage(&pVoronoiStorage->DirectionStorage);
- if(pVoronoiStorage->HoleStorage != NULL)
- cvReleaseMemStorage(&pVoronoiStorage->HoleStorage);
- }
-}// end of _cvReleaseVoronoiStorage
-
-static int _cvConvert(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &SiteSeq,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage,
- int contour_orientation)
-{
- if(contour_orientation == 1)
- return _cvConvertSameOrientation(VoronoiDiagram,VoronoiDiagramInt,SiteSeq,NodeWriter,
- EdgeWriter,VoronoiStorage);
- else
- return _cvConvertChangeOrientation(VoronoiDiagram,VoronoiDiagramInt,SiteSeq,NodeWriter,
- EdgeWriter,VoronoiStorage);
-}// end of _cvConvert
-
-static int _cvConvertSameOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &NewSiteSeqPrev,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage)
-{
- CvSeq* SiteSeq = VoronoiDiagramInt.SiteSeq;
- CvSeq* EdgeSeq = VoronoiDiagramInt.EdgeSeq;
- CvSeq* NodeSeq = VoronoiDiagramInt.NodeSeq;
-
-
- CvMemStorage *NewSiteStorage = cvCreateChildMemStorage(VoronoiStorage);
- CvSet *NewSiteSeq = NULL,*CurrNewSiteSeq = NULL, *PrevNewSiteSeq = NULL;;
- CvSeqWriter SiteWriter;
-
- CvVoronoiSite2D NewSite = {{0,0},{0,0},{0,0}},NewSite_prev;
- CvVoronoiSite2D *pNewSite, *pNewSite_prev = &NewSite_prev;
- pCvVoronoiSite pSite,pFirstSite;
-
- CvVoronoiEdge2D NewEdge = {{0,0},{0,0},{0,0,0,0}};
- CvVoronoiEdge2D *pNewEdge1, *pNewEdge2;
- pCvVoronoiEdge pEdge;
-
- CvVoronoiNode2D* pNode1, *pNode2;
- CvVoronoiNode2D Node;
- Node.next_free = NULL;
-
- for(CvSeq* CurrSiteSeq = SiteSeq;\
- CurrSiteSeq != NULL;\
- CurrSiteSeq = NEXT_SEQ(CurrSiteSeq,SiteSeq))
- {
- CurrNewSiteSeq = cvCreateSet(0,sizeof(CvSet),sizeof(CvVoronoiSite2D), NewSiteStorage);
- if(!NewSiteSeq)
- NewSiteSeq = PrevNewSiteSeq = CurrNewSiteSeq;
- else if(PrevNewSiteSeq->v_prev == NULL)
- {
- PrevNewSiteSeq->v_next = (CvSeq*)CurrNewSiteSeq;
- CurrNewSiteSeq->v_prev = (CvSeq*)PrevNewSiteSeq;
- }
- else
- {
- PrevNewSiteSeq->h_next = (CvSeq*)CurrNewSiteSeq;
- CurrNewSiteSeq->h_prev = (CvSeq*)PrevNewSiteSeq;
- CurrNewSiteSeq->v_prev = (CvSeq*)PrevNewSiteSeq->v_prev;
- }
- PrevNewSiteSeq = CurrNewSiteSeq;
-
- pSite = pFirstSite = (pCvVoronoiSite)cvGetSeqElem(CurrSiteSeq, 0);
- while(pSite->prev_site->node1 == pSite->prev_site->node2)\
- pSite = pSite->next_site;
- pFirstSite = pSite;
-
- pNewSite_prev = &NewSite_prev;
- cvStartAppendToSeq((CvSeq*)CurrNewSiteSeq, &SiteWriter);
- do
- {
- pNewSite = _cvWriteSeqElem(&NewSite,SiteWriter);
- pNewSite->next[0] = pNewSite_prev;
- pNewSite_prev->next[1] = pNewSite;
- pEdge = pSite->edge1;
- if(!pEdge || !pEdge->node1 || !pEdge->node2)
- return 0;
-
- if(pEdge->site == NULL)
- {
- pNewEdge1 = (CvVoronoiEdge2D*)pEdge->twin_edge;
- pNewEdge1->site[1] = pNewSite;
- pNewSite->node[0] = pNewEdge1->node[0];
- }
- else
- {
- pNewEdge1 = _cvWriteSeqElem(&NewEdge,EdgeWriter);
- pNewEdge1->site[0] = pNewSite;
-
- pNode1 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode2 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode1->pt.x = pEdge->node1->node.x;
- pNode1->pt.y = pEdge->node1->node.y;
- pNode1->radius = pEdge->node1->radius;
- pNode2->pt.x = pEdge->node2->node.x;
- pNode2->pt.y = pEdge->node2->node.y;
- pNode2->radius = pEdge->node2->radius;
- pNewEdge1->node[0] = pNode1;
- pNewEdge1->node[1] = pNode2;
-
- pNewSite->node[0] = pNewEdge1->node[1];
-
- if(!pNewEdge1->node[0] || !pNewEdge1->node[1])
- return 0;
- pEdge->twin_edge->site = NULL;
- pEdge->twin_edge->twin_edge = (pCvVoronoiEdge)pNewEdge1;
- }
- pNewSite->edge[1] = pNewEdge1;
- pEdge = pEdge->prev_edge;
- while((pEdge != NULL && CurrSiteSeq->total>1) ||
- (pEdge != pSite->edge2 && CurrSiteSeq->total == 1))
- {
- if(pEdge->site == NULL)
- {
- pNewEdge2 = (CvVoronoiEdge2D*)pEdge->twin_edge;
- pNewEdge2->site[1] = pNewSite;
- if(CV_VORONOIEDGE2D_BEGINNODE(pNewEdge1,pNewSite) != pNewEdge2->node[0])
- {
- cvFlushSeqWriter(&NodeWriter);
-// cvSetRemove((CvSet*)VoronoiDiagram,VoronoiDiagram->total-1);
- pNewEdge1->node[0] = pNewEdge2->node[0];
- }
- }
- else
- {
- pNewEdge2 = _cvWriteSeqElem(&NewEdge,EdgeWriter);
- pNewEdge2->site[0] = pNewSite;
-
- pNode1 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode1->pt.x = pEdge->node1->node.x;
- pNode1->pt.y = pEdge->node1->node.y;
- pNode1->radius = pEdge->node1->radius;
- pNewEdge2->node[0] = pNode1;
-
- if(pNewEdge1->site[0] == pNewSite)
- pNewEdge2->node[1] = pNewEdge1->node[0];
- else
- pNewEdge2->node[1] = pNewEdge1->node[1];
-
- if(!pNewEdge1->node[0] || !pNewEdge1->node[1])
- return 0;
- pEdge->twin_edge->site = NULL;
- pEdge->twin_edge->twin_edge = (pCvVoronoiEdge)pNewEdge2;
- }
- if(pNewEdge1->site[0] == pNewSite)
- pNewEdge1->next[2] = pNewEdge2;
- else
- pNewEdge1->next[3] = pNewEdge2;
-
- if(pNewEdge2->site[0] == pNewSite)
- pNewEdge2->next[0] = pNewEdge1;
- else
- pNewEdge2->next[1] = pNewEdge1;
-
- pEdge = pEdge->prev_edge;
- pNewEdge1 = pNewEdge2;
- }
- pNewSite->edge[0] = pNewEdge1;
- pNewSite->node[1] = pNewEdge1->node[0];
-
- if(pSite->node1 == pSite->node2 && pSite != pSite->next_site && pNewEdge1->node[0] != pNewEdge1->node[1])
- {
- cvFlushSeqWriter(&NodeWriter);
-// cvSetRemove((CvSet*)VoronoiDiagram,VoronoiDiagram->total-1);
- pNewSite->node[1] = pNewEdge1->node[0] = pNewSite->node[0];
- }
-
- pNewSite_prev = pNewSite;
- pSite = pSite->next_site;
- }while(pSite != pFirstSite);
- pNewSite->node[1] = pNewEdge1->node[1];
- if(pSite == pSite->next_site)
- {
- Node.pt.x = pSite->node1->node.x;
- Node.pt.y = pSite->node1->node.y;
- Node.radius = 0;
- pNewSite->node[0] = pNewSite->node[1] = _cvWriteSeqElem(&Node,NodeWriter);
- }
-
- cvEndWriteSeq(&SiteWriter);
- pNewSite = (CvVoronoiSite2D*)cvGetSetElem(CurrNewSiteSeq, 0);
- pNewSite->next[0] = pNewSite_prev;
- pNewSite_prev->next[1] = pNewSite;
- }
-
- cvReleaseMemStorage(&(SiteSeq->storage));
- cvReleaseMemStorage(&(EdgeSeq->storage));
- cvReleaseMemStorage(&(NodeSeq->storage));
-
- if(NewSiteSeqPrev == NULL)
- VoronoiDiagram->sites = NewSiteSeq;
- else
- {
- NewSiteSeqPrev->h_next = (CvSeq*)NewSiteSeq;
- NewSiteSeq->h_prev = (CvSeq*)NewSiteSeqPrev;
- }
-
- NewSiteSeqPrev = NewSiteSeq;
- return 1;
-}//end of _cvConvertSameOrientation
-
-static int _cvConvertChangeOrientation(CvVoronoiDiagram2D* VoronoiDiagram,
- CvVoronoiDiagramInt VoronoiDiagramInt,
- CvSet* &NewSiteSeqPrev,
- CvSeqWriter &NodeWriter,
- CvSeqWriter &EdgeWriter,
- CvMemStorage* VoronoiStorage)
-{
- // pNewSite->edge[1] = pSite->edge2
- // pNewSite->edge[0] = pSite->edge1
-
- CvSeq* SiteSeq = VoronoiDiagramInt.SiteSeq;
- CvSeq* EdgeSeq = VoronoiDiagramInt.EdgeSeq;
- CvSeq* NodeSeq = VoronoiDiagramInt.NodeSeq;
-
-
- CvMemStorage *NewSiteStorage = cvCreateChildMemStorage(VoronoiStorage);
- CvSet *NewSiteSeq = NULL,*CurrNewSiteSeq = NULL, *PrevNewSiteSeq = NULL;;
- CvSeqWriter SiteWriter;
-
- CvVoronoiSite2D NewSite = {{0,0},{0,0},{0,0}},NewSite_prev;
- CvVoronoiSite2D *pNewSite, *pNewSite_prev = &NewSite_prev;
- pCvVoronoiSite pSite,pFirstSite;
-
- CvVoronoiEdge2D NewEdge = {{0,0},{0,0},{0,0,0,0}};
- CvVoronoiEdge2D *pNewEdge1, *pNewEdge2;
- pCvVoronoiEdge pEdge;
-
- CvVoronoiNode2D* pNode1, *pNode2;
- CvVoronoiNode2D Node;
- Node.next_free = NULL;
-
- for(CvSeq* CurrSiteSeq = SiteSeq;\
- CurrSiteSeq != NULL;\
- CurrSiteSeq = NEXT_SEQ(CurrSiteSeq,SiteSeq))
- {
- CurrNewSiteSeq = cvCreateSet(0,sizeof(CvSet),sizeof(CvVoronoiSite2D), NewSiteStorage);
- if(!NewSiteSeq)
- NewSiteSeq = PrevNewSiteSeq = CurrNewSiteSeq;
- else if(PrevNewSiteSeq->v_prev == NULL)
- {
- PrevNewSiteSeq->v_next = (CvSeq*)CurrNewSiteSeq;
- CurrNewSiteSeq->v_prev = (CvSeq*)PrevNewSiteSeq;
- }
- else
- {
- PrevNewSiteSeq->h_next = (CvSeq*)CurrNewSiteSeq;
- CurrNewSiteSeq->h_prev = (CvSeq*)PrevNewSiteSeq;
- CurrNewSiteSeq->v_prev = (CvSeq*)PrevNewSiteSeq->v_prev;
- }
- PrevNewSiteSeq = CurrNewSiteSeq;
-
- pSite = (pCvVoronoiSite)cvGetSeqElem(CurrSiteSeq, 0);
- while(pSite->next_site->node1 == pSite->next_site->node2)\
- pSite = pSite->next_site;
- pFirstSite = pSite;
-
- pNewSite_prev = &NewSite_prev;
- cvStartAppendToSeq((CvSeq*)CurrNewSiteSeq, &SiteWriter);
- do
- {
- pNewSite = _cvWriteSeqElem(&NewSite,SiteWriter);
- pNewSite->next[0] = pNewSite_prev;
- pNewSite_prev->next[1] = pNewSite;
-
- pEdge = pSite->edge2;
- if(!pEdge || !pEdge->node1 || !pEdge->node2)
- return 0;
-
- if(pEdge->site == NULL)
- {
- pNewEdge1 = (CvVoronoiEdge2D*)pEdge->twin_edge;
- pNewEdge1->site[1] = pNewSite;
- pNewSite->node[0] = pNewEdge1->node[0];
- }
- else
- {
- pNewEdge1 = _cvWriteSeqElem(&NewEdge,EdgeWriter);
- pNewEdge1->site[0] = pNewSite;
-
- pNode1 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode2 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode1->pt.x = pEdge->node1->node.x;
- pNode1->pt.y = pEdge->node1->node.y;
- pNode1->radius = pEdge->node1->radius;
- pNode2->pt.x = pEdge->node2->node.x;
- pNode2->pt.y = pEdge->node2->node.y;
- pNode2->radius = pEdge->node2->radius;
- pNewEdge1->node[0] = pNode2;
- pNewEdge1->node[1] = pNode1;
-
- pNewSite->node[0] = pNewEdge1->node[1];
-
- if(!pNewEdge1->node[0] || !pNewEdge1->node[1])
- return 0;
- pEdge->twin_edge->site = NULL;
- pEdge->twin_edge->twin_edge = (pCvVoronoiEdge)pNewEdge1;
- }
- pNewSite->edge[1] = pNewEdge1;
-
-
- pEdge = pEdge->next_edge;
- while((pEdge != NULL && CurrSiteSeq->total>1) ||
- (pEdge != pSite->edge1 && CurrSiteSeq->total == 1))
- {
- if(pEdge->site == NULL)
- {
- pNewEdge2 = (CvVoronoiEdge2D*)pEdge->twin_edge;
- pNewEdge2->site[1] = pNewSite;
- if(CV_VORONOIEDGE2D_BEGINNODE(pNewEdge1,pNewSite) != pNewEdge2->node[0])
- {
- cvFlushSeqWriter(&NodeWriter);
-// cvSetRemove((CvSet*)VoronoiDiagram,VoronoiDiagram->total-1);
- pNewEdge1->node[0] = pNewEdge2->node[0];
- }
- }
- else
- {
- pNewEdge2 = _cvWriteSeqElem(&NewEdge,EdgeWriter);
- pNewEdge2->site[0] = pNewSite;
-
- pNode2 = _cvWriteSeqElem(&Node,NodeWriter);
- pNode2->pt.x = pEdge->node2->node.x;
- pNode2->pt.y = pEdge->node2->node.y;
- pNode2->radius = pEdge->node2->radius;
- pNewEdge2->node[0] = pNode2;
-
- if(pNewEdge1->site[0] == pNewSite)
- pNewEdge2->node[1] = pNewEdge1->node[0];
- else
- pNewEdge2->node[1] = pNewEdge1->node[1];
-
- if(!pNewEdge1->node[0] || !pNewEdge1->node[1])
- return 0;
- pEdge->twin_edge->site = NULL;
- pEdge->twin_edge->twin_edge = (pCvVoronoiEdge)pNewEdge2;
- }
- if(pNewEdge1->site[0] == pNewSite)
- pNewEdge1->next[2] = pNewEdge2;
- else
- pNewEdge1->next[3] = pNewEdge2;
-
- if(pNewEdge2->site[0] == pNewSite)
- pNewEdge2->next[0] = pNewEdge1;
- else
- pNewEdge2->next[1] = pNewEdge1;
-
- pEdge = pEdge->next_edge;
- pNewEdge1 = pNewEdge2;
- }
- pNewSite->edge[0] = pNewEdge1;
- pNewSite->node[1] = pNewEdge1->node[0];
-
- if(pSite->node1 == pSite->node2 && pSite != pSite->next_site && pNewEdge1->node[0] != pNewEdge1->node[1])
- {
- cvFlushSeqWriter(&NodeWriter);
-// cvSetRemove((CvSet*)VoronoiDiagram,VoronoiDiagram->total-1);
- pNewSite->node[1] = pNewEdge1->node[0] = pNewSite->node[0];
- }
-
- pNewSite_prev = pNewSite;
- pSite = pSite->prev_site;
- }while(pSite != pFirstSite);
- pNewSite->node[1] = pNewEdge1->node[1];
- if(pSite == pSite->next_site)
- {
- Node.pt.x = pSite->node1->node.x;
- Node.pt.y = pSite->node1->node.y;
- Node.radius = 0;
- pNewSite->node[0] = pNewSite->node[1] = _cvWriteSeqElem(&Node,NodeWriter);
- }
-
- cvEndWriteSeq(&SiteWriter);
- pNewSite = (CvVoronoiSite2D*)cvGetSetElem(CurrNewSiteSeq, 0);
- pNewSite->next[0] = pNewSite_prev;
- pNewSite_prev->next[1] = pNewSite;
- }
-
- cvReleaseMemStorage(&(SiteSeq->storage));
- cvReleaseMemStorage(&(EdgeSeq->storage));
- cvReleaseMemStorage(&(NodeSeq->storage));
-
- if(NewSiteSeqPrev == NULL)
- VoronoiDiagram->sites = NewSiteSeq;
- else
- {
- NewSiteSeqPrev->h_next = (CvSeq*)NewSiteSeq;
- NewSiteSeq->h_prev = (CvSeq*)NewSiteSeqPrev;
- }
- NewSiteSeqPrev = NewSiteSeq;
- return 1;
-}//end of _cvConvert
-
-template<class T>
-int _cvConstructExtSites(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* ContourSeq,
- int orientation,
- T type)
-{
- const double angl_eps = 0.03;
- CvSeq* SiteSeq = pVoronoiDiagram->SiteSeq;
- CvSeq* NodeSeq = pVoronoiDiagram->NodeSeq;
- //CvSeq* DirectionSeq = pVoronoiDiagram->DirectionSeq;
- CvPointFloat Vertex1,Vertex2,Vertex3;
- CvLeePoint<T> VertexT1,VertexT2,VertexT3;
-
- CvSeqReader ContourReader;
- CvVoronoiSiteInt Site = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- CvVoronoiSiteInt SiteTemp = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- CvVoronoiNodeInt Node;
- pCvVoronoiNode pNode1,pNode2;
- pCvVoronoiSite pSite = &SiteTemp,pSite_prev = &SiteTemp;
- pCvVoronoiSite pReflexSite = NULL;
- int NReflexSite = 0;
-
- float delta_x_rc, delta_x_cl, delta_y_rc, delta_y_cl;
- float norm_cl,norm_rc, mult_cl_rc;
- float _sin, _cos;
- int i;
-
- if(orientation == 1)
- {
- cvStartReadSeq(ContourSeq, &ContourReader,0);
- CV_READ_SEQ_ELEM(VertexT1,ContourReader);
- CV_READ_SEQ_ELEM(VertexT2,ContourReader);
- }
- else
- {
- cvStartReadSeq(ContourSeq, &ContourReader,1);
- CV_REV_READ_SEQ_ELEM(VertexT1,ContourReader);
- CV_REV_READ_SEQ_ELEM(VertexT2,ContourReader);
- }
-
- Vertex1.x = (float)VertexT1.x;
- Vertex1.y = (float)VertexT1.y;
- Vertex2.x = (float)VertexT2.x;
- Vertex2.y = (float)VertexT2.y;
-
- _cvInitVoronoiNode(&Node, &Vertex2);
- pNode1 = _cvSeqPush(NodeSeq, &Node);
-
- delta_x_cl = Vertex2.x - Vertex1.x;
- delta_y_cl = Vertex2.y - Vertex1.y;
- norm_cl = (float)sqrt((double)delta_x_cl*delta_x_cl + delta_y_cl*delta_y_cl);
-
- for( i = 0;i<ContourSeq->total;i++)
- {
- if(orientation == 1)
- {
- CV_READ_SEQ_ELEM(VertexT3,ContourReader);
- }
- else
- {
- CV_REV_READ_SEQ_ELEM(VertexT3,ContourReader);
- }
-
- Vertex3.x = (float)VertexT3.x;
- Vertex3.y = (float)VertexT3.y;
-
- _cvInitVoronoiNode(&Node, &Vertex3);
- pNode2 = _cvSeqPush(NodeSeq, &Node);
-
- delta_x_rc = Vertex3.x - Vertex2.x;
- delta_y_rc = Vertex3.y - Vertex2.y;
- norm_rc = (float)sqrt((double)delta_x_rc*delta_x_rc + delta_y_rc*delta_y_rc);
- if(norm_rc==0)
- continue;
-
- mult_cl_rc = norm_cl*norm_rc;
- _sin = (delta_y_rc* delta_x_cl - delta_x_rc* delta_y_cl)/mult_cl_rc;
- _cos = -(delta_x_cl*delta_x_rc + delta_y_cl*delta_y_rc)/mult_cl_rc;
-
- if((_sin > angl_eps) || (_sin > 0 && _cos > 0))
- {
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode2,pSite_prev);
- pSite_prev->next_site = pSite;
- }
- else if((_sin < -angl_eps) || (_sin < 0 && _cos > 0))
- {
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode1,pSite_prev);
- pReflexSite = pSite;
- NReflexSite++;
- pSite_prev->next_site = pSite;
-
- pSite_prev = pSite;
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode2,pSite_prev);
- pSite_prev->next_site = pSite;
- }
- else
- {
- Vertex2 = Vertex3;
- delta_y_rc = delta_y_cl + delta_y_rc;
- delta_x_rc = delta_x_cl + delta_x_rc;
- pSite->node2 = pNode2;
-
- norm_rc = (float)sqrt((double)delta_y_rc*delta_y_rc + delta_x_rc*delta_x_rc);
- }
- Vertex2=Vertex3;
- delta_y_cl= delta_y_rc;
- delta_x_cl= delta_x_rc;
- norm_cl = norm_rc;
- pSite_prev = pSite;
- pNode1 = pNode2;
- }
-
- if(SiteTemp.next_site==NULL)
- return 0;
-
- if(ContourSeq->total - NReflexSite<2)
- return 0;
-
- if(SiteSeq->total<3)
- return 0;
-
- pSite->node2 = SiteTemp.next_site->node1;
- pSite->next_site = SiteTemp.next_site;
- SiteTemp.next_site->prev_site = pSite;
-
- i = 0;
- if(pReflexSite!=NULL)
- for(i=0; i<SiteSeq->total; i++)
- {
- if(pReflexSite->next_site->next_site->node1 !=
- pReflexSite->next_site->next_site->node2)
- break;
- else
- pReflexSite = pReflexSite->next_site->next_site;
- }
- pVoronoiDiagram->reflex_site = pReflexSite;
- return (i<SiteSeq->total);
-}//end of _cvConstructExtSites
-
-template<class T>
-int _cvConstructIntSites(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* CurrSiteSeq,
- CvSeq* CurrContourSeq,
- pCvVoronoiSite &pTopSite,
- int orientation,
- T type)
-{
- const double angl_eps = 0.03;
- float min_x = (float)999999999;
- CvSeq* SiteSeq = CurrSiteSeq;
- CvSeq* NodeSeq = pVoronoiDiagram->NodeSeq;
- //CvSeq* DirectionSeq = pVoronoiDiagram->DirectionSeq;
- CvPointFloat Vertex1,Vertex2,Vertex3;
- CvLeePoint<T> VertexT1,VertexT2,VertexT3;
-
- CvSeqReader ContourReader;
- CvVoronoiSiteInt Site = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- CvVoronoiSiteInt SiteTemp = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- CvVoronoiNodeInt Node;
- pCvVoronoiNode pNode1,pNode2;
- pCvVoronoiSite pSite = &SiteTemp,pSite_prev = &SiteTemp;
- pTopSite = NULL;
- int NReflexSite = 0;
-
- if(CurrContourSeq->total == 1)
- {
- cvStartReadSeq(CurrContourSeq, &ContourReader,0);
- CV_READ_SEQ_ELEM(VertexT1,ContourReader);
- Vertex1.x = (float)VertexT1.x;
- Vertex1.y = (float)VertexT1.y;
-
- _cvInitVoronoiNode(&Node, &Vertex1);
- pNode1 = _cvSeqPush(NodeSeq, &Node);
- pTopSite = pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode1,pSite);
- pSite->next_site = pSite;
- return 1;
- }
-
- float delta_x_rc, delta_x_cl, delta_y_rc, delta_y_cl;
- float norm_cl,norm_rc, mult_cl_rc;
- float _sin, _cos;
- int i;
-
- if(orientation == 1)
- {
- cvStartReadSeq(CurrContourSeq, &ContourReader,0);
- CV_READ_SEQ_ELEM(VertexT1,ContourReader);
- CV_READ_SEQ_ELEM(VertexT2,ContourReader);
- }
- else
- {
- cvStartReadSeq(CurrContourSeq, &ContourReader,1);
- CV_REV_READ_SEQ_ELEM(VertexT1,ContourReader);
- CV_REV_READ_SEQ_ELEM(VertexT2,ContourReader);
- }
-
- Vertex1.x = (float)VertexT1.x;
- Vertex1.y = (float)VertexT1.y;
- Vertex2.x = (float)VertexT2.x;
- Vertex2.y = (float)VertexT2.y;
-
- _cvInitVoronoiNode(&Node, &Vertex2);
- pNode1 = _cvSeqPush(NodeSeq, &Node);
-
- delta_x_cl = Vertex2.x - Vertex1.x;
- delta_y_cl = Vertex2.y - Vertex1.y;
- norm_cl = (float)sqrt((double)delta_x_cl*delta_x_cl + delta_y_cl*delta_y_cl);
- for( i = 0;i<CurrContourSeq->total;i++)
- {
- if(orientation == 1)
- {
- CV_READ_SEQ_ELEM(VertexT3,ContourReader);
- }
- else
- {
- CV_REV_READ_SEQ_ELEM(VertexT3,ContourReader);
- }
- Vertex3.x = (float)VertexT3.x;
- Vertex3.y = (float)VertexT3.y;
-
- _cvInitVoronoiNode(&Node, &Vertex3);
- pNode2 = _cvSeqPush(NodeSeq, &Node);
-
- delta_x_rc = Vertex3.x - Vertex2.x;
- delta_y_rc = Vertex3.y - Vertex2.y;
- norm_rc = (float)sqrt((double)delta_x_rc*delta_x_rc + delta_y_rc*delta_y_rc);
- if(norm_rc==0)
- continue;
-
- mult_cl_rc = norm_cl*norm_rc;
- _sin = (delta_y_rc* delta_x_cl - delta_x_rc* delta_y_cl)/mult_cl_rc;
- _cos = -(delta_x_cl*delta_x_rc + delta_y_cl*delta_y_rc)/mult_cl_rc;
- if((_sin > angl_eps) || (_sin > 0 && _cos > 0))
- {
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode2,pSite_prev);
- pSite_prev->next_site = pSite;
- }
- else if((_sin < -angl_eps) || (_sin < 0 && _cos > 0) || (_sin == 0 && CurrContourSeq->total == 2))
- {
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode1,pSite_prev);
- if(pNode1->node.x < min_x)
- {
- min_x = pNode1->node.x;
- pTopSite = pSite;
- }
- NReflexSite++;
- pSite_prev->next_site = pSite;
-
- pSite_prev = pSite;
- pSite = _cvSeqPush(SiteSeq, &Site);
- _cvInitVoronoiSite(pSite,pNode1,pNode2,pSite_prev);
- pSite_prev->next_site = pSite;
- }
- else
- {
- Vertex2 = Vertex3;
- delta_y_rc = delta_y_cl + delta_y_rc;
- delta_x_rc = delta_x_cl + delta_x_rc;
- norm_rc = (float)sqrt((double)delta_y_rc*delta_y_rc + delta_x_rc*delta_x_rc);
- pSite->node2 = pNode2;
- }
-
- Vertex1=Vertex2;
- Vertex2=Vertex3;
- delta_y_cl= delta_y_rc;
- delta_x_cl= delta_x_rc;
- norm_cl = norm_rc;
- pSite_prev = pSite;
- pNode1 = pNode2;
- }
-
- if(SiteTemp.next_site==NULL)
- return 0;
-
- if(NReflexSite < 3 && CurrContourSeq->total > 2 || NReflexSite < 2)
- return 0;
-
- pSite->node2 = SiteTemp.next_site->node1;
- pSite->next_site = SiteTemp.next_site;
- SiteTemp.next_site->prev_site = pSite;
-
- return 1;
-}//end of _cvConstructIntSites
-
-static int _cvConstructExtChains(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- CvSeq* SiteSeq = pVoronoiDiagram->SiteSeq;
- CvSeq* ChainSeq = pVoronoiDiagram->ChainSeq;
-
- CvVoronoiChainInt Chain;
- pCvVoronoiChain pChain,pChainFirst;
- pCvVoronoiSite pSite, pSite_prev, pSiteFirst,pReflexSite = pVoronoiDiagram->reflex_site;
-
- if(pReflexSite==NULL)
- pSite = pSiteFirst = (pCvVoronoiSite)cvGetSeqElem(SiteSeq, 0);
- else
- {
- while(pReflexSite->next_site->next_site->node1==
- pReflexSite->next_site->next_site->node2)
- pReflexSite = pReflexSite->next_site->next_site;
-
- pSite = pSiteFirst = pReflexSite->next_site;
- }
-
- Chain.last_site = pSite;
- _cvConstructEdges(pSite,pVoronoiDiagram);
- pSite_prev = pSite;
- pSite = pSite->prev_site;
- do
- {
- if(pSite->node1!=pSite->node2)
- {
- Chain.first_site = pSite_prev;
- pChain = _cvSeqPushFront(ChainSeq,&Chain);
-
- _cvConstructEdges(pSite,pVoronoiDiagram);
- Chain.last_site = pSite;
- Chain.next_chain = pChain;
- }
- else
- {
- pSite=pSite->prev_site;
- _cvConstructEdges(pSite,pVoronoiDiagram);
- _cvConstructEdges(pSite->next_site,pVoronoiDiagram);
- }
- pSite_prev = pSite;
- pSite = pSite->prev_site;
- }while(pSite!=pSiteFirst);
-
- Chain.first_site = pSite_prev;
- pChain = _cvSeqPushFront(ChainSeq,&Chain);
- pChainFirst = (pCvVoronoiChain)cvGetSeqElem(ChainSeq,ChainSeq->total - 1);
- pChainFirst->next_chain = pChain;
- if(ChainSeq->total < 3)
- return 0;
- else
- return 1;
-}// end of _cvConstructExtChains
-
-static void _cvConstructIntChains(CvVoronoiDiagramInt* pVoronoiDiagram,
- CvSeq* CurrChainSeq,
- CvSeq* CurrSiteSeq,
- pCvVoronoiSite pTopSite)
-{
- CvSeq* ChainSeq = CurrChainSeq;
-
- if(CurrSiteSeq->total == 1)
- return;
-
- CvVoronoiChainInt Chain = {NULL,NULL,NULL};
- pCvVoronoiChain pChain,pChainFirst;;
- pCvVoronoiSite pSite, pSite_prev, pSiteFirst;
- pSite = pSiteFirst = pTopSite->next_site;
-
- Chain.last_site = pSite;
- _cvConstructEdges(pSite,pVoronoiDiagram);
- pSite_prev = pSite;
- pSite = pSite->prev_site;
- do
- {
- if(pSite->node1!=pSite->node2)
- {
- Chain.first_site = pSite_prev;
- pChain = _cvSeqPushFront(ChainSeq,&Chain);
-
- _cvConstructEdges(pSite,pVoronoiDiagram);
- Chain.last_site = pSite;
- Chain.next_chain = pChain;
- }
- else
- {
- pSite=pSite->prev_site;
- if(pSite != pSiteFirst)
- _cvConstructEdges(pSite,pVoronoiDiagram);
- _cvConstructEdges(pSite->next_site,pVoronoiDiagram);
- }
- pSite_prev = pSite;
- pSite = pSite->prev_site;
- }while(pSite!=pSiteFirst && pSite!= pSiteFirst->prev_site);
-
- if(pSite == pSiteFirst->prev_site && ChainSeq->total == 0)
- return;
-
- Chain.first_site = pSite_prev;
- if(pSite == pSiteFirst->prev_site)
- {
- pChainFirst = (pCvVoronoiChain)cvGetSeqElem(ChainSeq,ChainSeq->total - 1);
- pChainFirst->last_site = Chain.last_site;
- pChainFirst->next_chain = Chain.next_chain;
- return;
- }
- else
- {
- pChain = _cvSeqPushFront(ChainSeq,&Chain);
- pChainFirst = (pCvVoronoiChain)cvGetSeqElem(ChainSeq,ChainSeq->total - 1);
- pChainFirst->next_chain = pChain;
- return;
- }
-}// end of _cvConstructIntChains
-
-CV_INLINE void _cvConstructEdges(pCvVoronoiSite pSite,CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- CvSeq* EdgeSeq = pVoronoiDiagram->EdgeSeq;
- CvSeq* DirectionSeq = pVoronoiDiagram->DirectionSeq;
- CvVoronoiEdgeInt Edge = {NULL,NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- pCvVoronoiEdge pEdge1,pEdge2;
- CvDirection EdgeDirection,SiteDirection;
- float site_lengh;
-
- Edge.site = pSite;
- if(pSite->node1!=pSite->node2)
- {
- SiteDirection.x = pSite->node2->node.x - pSite->node1->node.x;
- SiteDirection.y = pSite->node2->node.y - pSite->node1->node.y;
- site_lengh = (float)sqrt((double)SiteDirection.x*SiteDirection.x + SiteDirection.y * SiteDirection.y);
- SiteDirection.x /= site_lengh;
- SiteDirection.y /= site_lengh;
- EdgeDirection.x = -SiteDirection.y;
- EdgeDirection.y = SiteDirection.x;
- Edge.direction = _cvSeqPush(DirectionSeq,&EdgeDirection);
- pSite->direction = _cvSeqPush(DirectionSeq,&SiteDirection);
-
- pEdge1 = _cvSeqPush(EdgeSeq,&Edge);
- pEdge2 = _cvSeqPush(EdgeSeq,&Edge);
- }
- else
- {
- pCvVoronoiSite pSite_prev = pSite->prev_site;
- pCvVoronoiSite pSite_next = pSite->next_site;
-
- pEdge1 = _cvSeqPush(EdgeSeq,&Edge);
- pEdge2 = _cvSeqPush(EdgeSeq,&Edge);
-
- pEdge2->direction = pSite_next->edge1->direction;
- pEdge2->twin_edge = pSite_next->edge1;
- pSite_next->edge1->twin_edge = pEdge2;
-
- pEdge1->direction = pSite_prev->edge2->direction;
- pEdge1->twin_edge = pSite_prev->edge2;
- pSite_prev->edge2->twin_edge = pEdge1;
- }
-
- pEdge2->node1 = pSite->node2;
- pEdge1->node2 = pSite->node1;
- pSite->edge1 = pEdge1;
- pSite->edge2 = pEdge2;
- pEdge2->next_edge = pEdge1;
- pEdge1->prev_edge = pEdge2;
-}// end of _cvConstructEdges
-
-static int _cvConstructExtVD(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiSite pSite_right = 0,pSite_left = 0;
- pCvVoronoiEdge pEdge_left,pEdge_right;
- pCvVoronoiChain pChain1, pChain2;
-
- pChain1 = (pCvVoronoiChain)cvGetSeqElem(pVoronoiDiagram->ChainSeq,0);
- do
- {
- pChain2 = pChain1->next_chain;
- if(pChain2->next_chain==pChain1)
- {
- pSite_right = pChain1->first_site;
- pSite_left = pChain2->last_site;
- pEdge_left = pSite_left->edge2->next_edge;
- pEdge_right = pSite_right->edge1->prev_edge;
- pEdge_left->prev_edge = NULL;
- pEdge_right->next_edge = NULL;
- pSite_right->edge1 = NULL;
- pSite_left->edge2 = NULL;
- }
-
- if(!_cvJoinChains(pChain1,pChain2,pVoronoiDiagram))
- return 0;
-
- pChain1->last_site = pChain2->last_site;
- pChain1->next_chain = pChain2->next_chain;
- pChain1 = pChain1->next_chain;
- }while(pChain1->next_chain != pChain1);
-
- pCvVoronoiNode pEndNode = pSite_left->node2;
- if(pSite_right->edge1==NULL)
- return 0;
- else
- pSite_right->edge1->node2 = pEndNode;
-
- if(pSite_left->edge2==NULL)
- return 0;
- else
- pSite_left->edge2->node1 = pEndNode;
-
- return 1;
-}//end of _cvConstructExtVD
-
-static int _cvJoinChains(pCvVoronoiChain pChain1,
- pCvVoronoiChain pChain2,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- const double dist_eps = 0.05;
- if(pChain1->first_site == NULL || pChain1->last_site == NULL ||
- pChain2->first_site == NULL || pChain2->last_site == NULL)
- return 0;
-
- CvVoronoiEdgeInt EdgeNULL = {NULL,NULL,NULL,NULL,NULL,NULL,NULL,NULL};
-
- CvSeq* NodeSeq = pVoronoiDiagram->NodeSeq;
- CvSeq* EdgeSeq = pVoronoiDiagram->EdgeSeq;
-
- pCvVoronoiSite pSite_left = pChain1->last_site;
- pCvVoronoiSite pSite_right = pChain2->first_site;
-
- pCvVoronoiEdge pEdge_left = pSite_left->edge2->next_edge;
- pCvVoronoiEdge pEdge_right = pSite_right->edge1->prev_edge;
-
- pCvVoronoiEdge pEdge_left_cur = pEdge_left;
- pCvVoronoiEdge pEdge_right_cur = pEdge_right;
-
- pCvVoronoiEdge pEdge_left_prev = NULL;
- pCvVoronoiEdge pEdge_right_next = NULL;
-
- pCvVoronoiNode pNode_siteleft = pChain1->first_site->node1;
- pCvVoronoiNode pNode_siteright = pChain2->last_site->node2;
- /*CvVoronoiSiteInt Site_left_chain = {pNode_siteleft,pNode_siteleft,NULL,NULL,NULL,NULL};
- CvVoronoiSiteInt Site_right_chain = {pNode_siteright,pNode_siteright,NULL,NULL,NULL,NULL};*/
-
- pCvVoronoiEdge pEdge1,pEdge2;
- CvPointFloat Point1 = {0,0}, Point2 = {0,0};
-
- float radius1,radius2,dist1,dist2;
- bool left = true,right = true;
-
- CvVoronoiNodeInt Node;
- pCvVoronoiNode pNode_begin = pSite_left->node2;
-
- pEdge1 = pSite_left->edge2;
- pEdge1->node2 = NULL;
- pEdge2 = pSite_right->edge1;
- pEdge2->node1 = NULL;
-
- for(;;)
- {
-
- if(left)
- pEdge1->node1 = pNode_begin;
- if(right)
- pEdge2->node2 = pNode_begin;
-
- pEdge_left = pEdge_left_cur;
- pEdge_right = pEdge_right_cur;
-
- if(left&&right)
- {
- _cvCalcEdge(pSite_left,pSite_right,pEdge1,pVoronoiDiagram);
- _cvMakeTwinEdge(pEdge2,pEdge1);
- _cvStickEdgeLeftBegin(pEdge1,pEdge_left_prev,pSite_left);
- _cvStickEdgeRightBegin(pEdge2,pEdge_right_next,pSite_right);
- }
- else if(!left)
- {
- _cvCalcEdge(pNode_siteleft,pSite_right,pEdge2,pVoronoiDiagram);
- _cvStickEdgeRightBegin(pEdge2,pEdge_right_next,pSite_right);
- }
- else if(!right)
- {
- _cvCalcEdge(pSite_left,pNode_siteright,pEdge1,pVoronoiDiagram);
- _cvStickEdgeLeftBegin(pEdge1,pEdge_left_prev,pSite_left);
- }
-
- dist1=dist2=-1;
- radius1 = -1; radius2 = -2;
-
- while(pEdge_left!=NULL)
- {
- if(pEdge_left->node2 == NULL)
- {
- pEdge_left_cur = pEdge_left = pEdge_left->next_edge;
- if(pEdge_left == NULL)
- break;
- }
-
- if(left)
- dist1 = _cvCalcEdgeIntersection(pEdge1, pEdge_left, &Point1,radius1);
- else
- dist1 = _cvCalcEdgeIntersection(pEdge2, pEdge_left, &Point1,radius1);
-
- if(dist1>=0)
- break;
-
- pEdge_left = pEdge_left->next_edge;
- }
-
- while(pEdge_right!=NULL)
- {
- if(pEdge_right->node1 == NULL)
- {
- pEdge_right_cur = pEdge_right = pEdge_right->prev_edge;
- if(pEdge_right == NULL)
- break;
- }
-
- if(left)
- dist2 = _cvCalcEdgeIntersection(pEdge1, pEdge_right, &Point2, radius2);
- else
- dist2 = _cvCalcEdgeIntersection(pEdge2, pEdge_right, &Point2, radius2);
-
- if(dist2>=0)
- break;
-
- pEdge_right = pEdge_right->prev_edge;
- }
-
- if(dist1<0&&dist2<0)
- {
- if(left)
- {
- pEdge_left = pSite_left->edge1;
- if(pEdge_left==NULL)
- _cvStickEdgeLeftEnd(pEdge1,NULL,pSite_left);
- else
- {
- while(pEdge_left->node1!=NULL
- &&pEdge_left->node1==pEdge_left->prev_edge->node2)
- {
- pEdge_left = pEdge_left->prev_edge;
- if(pEdge_left==NULL || pEdge_left->prev_edge == NULL)
- return 0;
- }
- _cvStickEdgeLeftEnd(pEdge1,pEdge_left,pSite_left);
- }
- }
- if(right)
- {
- pEdge_right = pSite_right->edge2;
- if(pEdge_right==NULL)
- _cvStickEdgeRightEnd(pEdge2,NULL,pSite_right);
- else
- {
- while(pEdge_right->node2!=NULL
- && pEdge_right->node2==pEdge_right->next_edge->node1)
- {
- pEdge_right = pEdge_right->next_edge;
- if(pEdge_right==NULL || pEdge_right->next_edge == NULL )
- return 0;
- }
- _cvStickEdgeRightEnd(pEdge2,pEdge_right,pSite_right);
- }
- }
- return 1;
- }
-
- if(fabs(dist1 - dist2)<dist_eps)
- {
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point2,radius2);
-
- pEdge1->node2 = pNode_begin;
- pEdge2->node1 = pNode_begin;
-
- _cvStickEdgeLeftEnd(pEdge1,pEdge_left,pSite_left);
- _cvTwinNULLLeft(pEdge_left_cur,pEdge_left);
-
- _cvStickEdgeRightEnd(pEdge2,pEdge_right,pSite_right);
- _cvTwinNULLRight(pEdge_right_cur,pEdge_right);
-
- if(pEdge_left->twin_edge!=NULL&&pEdge_right->twin_edge!=NULL)
- {
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pEdge_right_cur = pEdge_right_next->prev_edge;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- continue;
- }
-
- if(pEdge_left->twin_edge==NULL&&pEdge_right->twin_edge!=NULL)
- {
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pEdge_right_cur = pEdge_right_next->prev_edge;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- pEdge_left_cur = NULL;
- left = false;
- continue;
- }
-
- if(pEdge_left->twin_edge!=NULL&&pEdge_right->twin_edge==NULL)
- {
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- pEdge_right_cur = NULL;
- right = false;
- continue;
- }
- if(pEdge_left->twin_edge==NULL&&pEdge_right->twin_edge==NULL)
- return 1;
- }
-
- if((dist1<dist2&&dist1>=0)||(dist1>=0&&dist2<0))
- {
-
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point1,radius1);
- pEdge1->node2 = pNode_begin;
- _cvTwinNULLLeft(pEdge_left_cur,pEdge_left);
- _cvStickEdgeLeftEnd(pEdge1,pEdge_left,pSite_left);
- if(right)
- {
- pEdge2->node1 = pNode_begin;
- pEdge_right_next = pEdge2;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- if(pEdge_left->twin_edge!=NULL)
- {
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- continue;
- }
- else
- {
- pEdge_left_cur = NULL;
- left = false;
- continue;
- }
- }
- else
- {
- if(pEdge_left->twin_edge!=NULL)
- {
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- continue;
- }
- else
- return 1;
-
- }
-
- }
-
- if((dist1>dist2&&dist2>=0)||(dist1<0&&dist2>=0))
- {
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point2,radius2);
- pEdge2->node1 = pNode_begin;
- _cvTwinNULLRight(pEdge_right_cur,pEdge_right);
- _cvStickEdgeRightEnd(pEdge2,pEdge_right,pSite_right);
- if(left)
- {
- pEdge1->node2 = pNode_begin;
- pEdge_left_prev = pEdge1;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- if(pEdge_right->twin_edge!=NULL)
- {
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pEdge_right_cur = pEdge_right_next->prev_edge;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- continue;
- }
- else
- {
- pEdge_right_cur = NULL;
- right = false;
- continue;
- }
- }
- else
- {
- if(pEdge_right->twin_edge!=NULL)
- {
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pEdge_right_cur = pEdge_right_next->prev_edge;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
- continue;
- }
- else
- return 1;
- }
-
- }
- }
-
-}// end of _cvJoinChains
-
-static void _cvFindNearestSite(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiHole pCurrHole, pHole = pVoronoiDiagram->top_hole;
- pCvPointFloat pTopPoint,pPoint1,pPoint2;
- CvPointFloat Direction;
- pCvVoronoiSite pSite;
- CvVoronoiNodeInt Node;
- CvSeq* CurrSeq;
- float min_distance,distance;
- int i;
- for(;pHole != NULL; pHole = pHole->next_hole)
- {
- if(pHole->error)
- continue;
- pTopPoint = &pHole->site_top->node1->node;
- pCurrHole = NULL;
- CurrSeq = pVoronoiDiagram->SiteSeq;
- min_distance = (float)3e+34;
- while(pCurrHole != pHole)
- {
- if(pCurrHole && pCurrHole->error)
- continue;
- pSite = (pCvVoronoiSite)cvGetSeqElem(CurrSeq,0);
- if(CurrSeq->total == 1)
- {
- distance = _cvCalcDist(pTopPoint, pSite);
- if(distance < min_distance)
- {
- min_distance = distance;
- pHole->site_nearest = pSite;
- }
- }
- else
- {
- for(i = 0; i < CurrSeq->total;i++, pSite = pSite->next_site)
- {
- if(pSite->node1 != pSite->node2)
- {
- pPoint1 = &pSite->node1->node;
- pPoint2 = &pSite->node2->node;
-
- Direction.x = -pSite->direction->y;
- Direction.y = pSite->direction->x;
-
- if(
- (pTopPoint->x - pPoint2->x)*Direction.y -
- (pTopPoint->y - pPoint2->y)*Direction.x > 0
- ||
- (pTopPoint->x - pPoint1->x)*Direction.y -
- (pTopPoint->y - pPoint1->y)*Direction.x < 0
- ||
- (pTopPoint->x - pPoint1->x)*pSite->direction->y -
- (pTopPoint->y - pPoint1->y)*pSite->direction->x > 0
- )
- continue;
-
- distance = _cvCalcDist(pTopPoint, pSite);
- }
- else
- {
- pPoint1 = &pSite->node1->node;
- if(
- (pTopPoint->x - pPoint1->x)*pSite->edge2->direction->y -
- (pTopPoint->y - pPoint1->y)*pSite->edge2->direction->x > 0
- ||
- (pTopPoint->x - pPoint1->x)*pSite->edge1->direction->y -
- (pTopPoint->y - pPoint1->y)*pSite->edge1->direction->x < 0
- )
- continue;
-
- distance = _cvCalcDist(pTopPoint, pSite);
- }
-
-
- if(distance < min_distance)
- {
- min_distance = distance;
- pHole->site_nearest = pSite;
- }
- }
- }
-
- if(pCurrHole == NULL)
- pCurrHole = pVoronoiDiagram->top_hole;
- else
- pCurrHole = pCurrHole->next_hole;
-
- CurrSeq = pCurrHole->SiteSeq;
- }
- pHole->x_coord = min_distance;
-
- if(pHole->site_nearest->node1 == pHole->site_nearest->node2)
- {
- Direction.x = (pHole->site_nearest->node1->node.x - pHole->site_top->node1->node.x)/2;
- Direction.y = (pHole->site_nearest->node1->node.y - pHole->site_top->node1->node.y)/2;
- }
- else
- {
-
- Direction.x = pHole->site_nearest->direction->y * min_distance / 2;
- Direction.y = - pHole->site_nearest->direction->x * min_distance / 2;
- }
-
- Node.node.x = pHole->site_top->node1->node.x + Direction.x;
- Node.node.y = pHole->site_top->node1->node.y + Direction.y;
- pHole->node = _cvSeqPush(pVoronoiDiagram->NodeSeq, &Node);
- }
-}//end of _cvFindNearestSite
-
-static void _cvConstructIntVD(CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiChain pChain1, pChain2;
- pCvVoronoiHole pHole;
- int i;
-
- pHole = pVoronoiDiagram->top_hole;
-
- for(;pHole != NULL; pHole = pHole->next_hole)
- {
- if(pHole->ChainSeq->total == 0)
- continue;
- pChain1 = (pCvVoronoiChain)cvGetSeqElem(pHole->ChainSeq,0);
- for(i = pHole->ChainSeq->total; i > 0;i--)
- {
- pChain2 = pChain1->next_chain;
- if(!_cvJoinChains(pChain1,pChain2,pVoronoiDiagram))
- {
- pHole->error = true;
- break;
- }
-
- pChain1->last_site = pChain2->last_site;
- pChain1->next_chain = pChain2->next_chain;
- pChain1 = pChain1->next_chain;
- }
- }
-}// end of _cvConstructIntVD
-
-static int _cvFindOppositSiteCW(pCvVoronoiHole pHole, CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiSite pSite_left = pHole->site_nearest;
- pCvVoronoiSite pSite_right = pHole->site_top;
- pCvVoronoiNode pNode = pHole->node;
-
- CvDirection Direction = {-1,0};
- CvVoronoiEdgeInt Edge_right = {NULL,pSite_right->node1,pSite_right,NULL,NULL,NULL,NULL,&Direction};
-
- pCvVoronoiEdge pEdge_left = pSite_left->edge2->next_edge;
- pCvVoronoiEdge pEdge_right = &Edge_right;
-
- CvVoronoiEdgeInt Edge = {NULL,pNode,pSite_right,NULL,NULL,NULL,NULL,NULL};
- CvVoronoiEdgeInt Edge_cur = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- pCvVoronoiEdge pEdge = &Edge;
-
- float radius1, radius2,dist1, dist2;
- CvPointFloat Point1 = {0,0}, Point2 = {0,0};
-
- for(;;)
- {
- pEdge->direction = NULL;
- pEdge->parabola = NULL;
- _cvCalcEdge(pSite_left,pSite_right,pEdge,pVoronoiDiagram);
-
- dist1=dist2=-1;
- radius1 = -1; radius2 = -2;
- while(pEdge_left!=NULL)
- {
- dist1 = _cvCalcEdgeIntersection(pEdge, pEdge_left, &Point1,radius1);
- if(dist1>=0)
- break;
- pEdge_left = pEdge_left->next_edge;
- }
-
- dist2 = _cvCalcEdgeIntersection(pEdge, pEdge_right, &Point2, radius2);
- if(dist2>=0 && dist1 >= dist2)
- {
- pHole->site_opposite = pSite_left;
- pNode->node = Point2;
- return 1;
- }
-
- if(dist1<0)
- return 0;
-
- Edge_cur = *pEdge_left->twin_edge;
- Edge_cur.node1 = pNode;
- pEdge_left = &Edge_cur;
-
- pSite_left = pEdge_left->site;
- pNode->node = Point1;
- }
-}//end of _cvFindOppositSiteCW
-
-static int _cvFindOppositSiteCCW(pCvVoronoiHole pHole,CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiSite pSite_right = pHole->site_nearest;
- pCvVoronoiSite pSite_left = pHole->site_top;
- pCvVoronoiNode pNode = pHole->node;
-
- CvDirection Direction = {-1,0};
- CvVoronoiEdgeInt Edge_left = {pSite_left->node1,NULL,pSite_left,NULL,NULL,NULL, NULL, &Direction};
-
- pCvVoronoiEdge pEdge_left = &Edge_left;
- pCvVoronoiEdge pEdge_right = pSite_right->edge1->prev_edge;
-
- CvVoronoiEdgeInt Edge = {NULL,pNode,pSite_left,NULL,NULL,NULL,NULL};
- CvVoronoiEdgeInt Edge_cur = {NULL,NULL,NULL,NULL,NULL,NULL,NULL};
- pCvVoronoiEdge pEdge = &Edge;
-
- double dist1, dist2;
- float radius1, radius2;
- CvPointFloat Point1 = {0,0}, Point2 = {0,0};
-
- for(;;)
- {
- pEdge->direction = NULL;
- pEdge->parabola = NULL;
- _cvCalcEdge(pSite_left,pSite_right,pEdge,pVoronoiDiagram);
-
- dist1=dist2=-1;
- radius1 = -1; radius2 = -2;
- while(pEdge_right!=NULL)
- {
- dist1 = _cvCalcEdgeIntersection(pEdge, pEdge_right, &Point1,radius2);
- if(dist1>=0)
- break;
- pEdge_right = pEdge_right->prev_edge;
- }
-
- dist2 = _cvCalcEdgeIntersection(pEdge, pEdge_left, &Point2, radius1);
- if(dist2>=0 && dist1 > dist2)
- {
- pHole->site_opposite = pSite_right;
- pNode->node = Point2;
- return 1;
- }
-
- if(dist1<0)
- return 0;
-
- Edge_cur = *pEdge_right->twin_edge;
- Edge_cur.node2 = pNode;
- pEdge_right = &Edge_cur;
-
- pSite_right = pEdge_right->site;
- pNode->node = Point1;
- }
-}//end of _cvFindOppositSiteCCW
-
-static int _cvMergeVD(pCvVoronoiHole pHole,CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvVoronoiSite pSite_left_first = pHole->site_top;
- pCvVoronoiSite pSite_right_first = pHole->site_opposite;
- pCvVoronoiNode pNode_begin = pHole->node;
- if(pSite_left_first == NULL || pSite_right_first == NULL || pNode_begin == NULL)
- return 0;
-
- pCvVoronoiSite pSite_left = pSite_left_first;
- pCvVoronoiSite pSite_right = pSite_right_first;
-
- const double dist_eps = 0.05;
- CvVoronoiEdgeInt EdgeNULL = {NULL,NULL,NULL,NULL,NULL,NULL,NULL,NULL};
-
- CvSeq* NodeSeq = pVoronoiDiagram->NodeSeq;
- CvSeq* EdgeSeq = pVoronoiDiagram->EdgeSeq;
-
- pCvVoronoiEdge pEdge_left = NULL;
- if(pSite_left->edge2 != NULL)
- pEdge_left = pSite_left->edge2->next_edge;
-
- pCvVoronoiEdge pEdge_right = pSite_right->edge1;
- pCvVoronoiEdge pEdge_left_cur = pEdge_left;
- pCvVoronoiEdge pEdge_right_cur = pEdge_right;
-
- pCvVoronoiEdge pEdge_left_prev = NULL;
- pCvVoronoiEdge pEdge_right_next = NULL;
-
- pCvVoronoiEdge pEdge1,pEdge2,pEdge1_first, pEdge2_first;
- CvPointFloat Point1 = {0,0}, Point2 = {0,0};
-
- float radius1,radius2,dist1,dist2;
-
- CvVoronoiNodeInt Node;
-
- pEdge1_first = pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);;
- pEdge2_first = pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);;
- pEdge1->site = pSite_left_first;
- pEdge2->site = pSite_right_first;
-
- do
- {
- pEdge1->node1 = pEdge2->node2 = pNode_begin;
-
- pEdge_left = pEdge_left_cur;
- pEdge_right = pEdge_right_cur->prev_edge;
-
- _cvCalcEdge(pSite_left,pSite_right,pEdge1,pVoronoiDiagram);
- _cvMakeTwinEdge(pEdge2,pEdge1);
-
- if(pEdge_left_prev != NULL)
- _cvStickEdgeLeftBegin(pEdge1,pEdge_left_prev,pSite_left);
- if(pEdge_right_next != NULL)
- _cvStickEdgeRightBegin(pEdge2,pEdge_right_next,pSite_right);
-
- dist1=dist2=-1;
- radius1 = -1; radius2 = -2;
-
-//LEFT:
- while(pEdge_left!=NULL)
- {
- if(pEdge_left->node2 == NULL)
- pEdge_left_cur = pEdge_left = pEdge_left->next_edge;
-
- dist1 = _cvCalcEdgeIntersection(pEdge1, pEdge_left, &Point1,radius1);
- if(dist1>=0)
- goto RIGHT;
- pEdge_left = pEdge_left->next_edge;
- }
-
-RIGHT:
- while(pEdge_right!=NULL)
- {
- dist2 = _cvCalcEdgeIntersection(pEdge1, pEdge_right, &Point2,radius2);
- if(dist2>=0)
- goto RESULTHANDLING;
-
- pEdge_right = pEdge_right->prev_edge;
- }
- pEdge_right = pEdge_right_cur;
- dist2 = _cvCalcEdgeIntersection(pEdge1, pEdge_right, &Point2, radius2);
-
-RESULTHANDLING:
- if(dist1<0&&dist2<0)
- return 0;
-
- if(fabs(dist1 - dist2)<dist_eps)
- {
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point2,radius2);
-
- pEdge1->node2 = pNode_begin;
- pEdge2->node1 = pNode_begin;
-
- pEdge_right_cur = _cvDivideRightEdge(pEdge_right,pNode_begin,EdgeSeq);
-
- _cvStickEdgeLeftEnd(pEdge1,pEdge_left,pSite_left);
- _cvStickEdgeRightEnd(pEdge2,pEdge_right,pSite_right);
-
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- continue;
- }
-
- if((dist1<dist2&&dist1>=0)||(dist1>=0&&dist2<0))
- {
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point1,radius1);
-
- pEdge1->node2 = pNode_begin;
- _cvStickEdgeLeftEnd(pEdge1,pEdge_left,pSite_left);
-
- pEdge2->node1 = pNode_begin;
- pEdge_right_next = pEdge2;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- pEdge_left_prev = pEdge_left->twin_edge;
- if(!pEdge_left_prev)
- return 0;
- pEdge_left_cur = pEdge_left_prev->next_edge;
- pSite_left = pEdge_left_prev->site;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- continue;
- }
-
- if((dist1>dist2&&dist2>=0)||(dist1<0&&dist2>=0))
- {
- pNode_begin = _cvSeqPush(NodeSeq,&Node);
- _cvInitVoronoiNode(pNode_begin, &Point2,radius2);
-
- pEdge_right_cur = _cvDivideRightEdge(pEdge_right,pNode_begin,EdgeSeq);
-
- pEdge2->node1 = pNode_begin;
- _cvStickEdgeRightEnd(pEdge2,pEdge_right,pSite_right);
-
- pEdge1->node2 = pNode_begin;
- pEdge_left_prev = pEdge1;
- pEdge1 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- pEdge_right_next = pEdge_right->twin_edge;
- if(!pEdge_right_next)
- return 0;
- pSite_right = pEdge_right_next->site;
- pEdge2 = _cvSeqPush(EdgeSeq, &EdgeNULL);
-
- continue;
- }
-
- }while(!(pSite_left == pSite_left_first && pSite_right == pSite_right_first));
-
- pEdge1_first->node1 = pNode_begin;
- pEdge2_first->node2 = pNode_begin;
- _cvStickEdgeLeftBegin(pEdge1_first,pEdge_left_prev,pSite_left_first);
- _cvStickEdgeRightBegin(pEdge2_first,pEdge_right_next,pSite_right_first);
-
- if(pSite_left_first->edge2 == NULL)
- pSite_left_first->edge2 = pSite_left_first->edge1 = pEdge1_first;
- return 1;
-}// end of _cvMergeVD
-
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Computation of bisectors //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-void _cvCalcEdge(pCvVoronoiSite pSite_left,
- pCvVoronoiSite pSite_right,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- if((pSite_left->node1!=pSite_left->node2)&&
- (pSite_right->node1!=pSite_right->node2))
- _cvCalcEdgeLL(pSite_left->direction,
- pSite_right->direction,
- pEdge,pVoronoiDiagram);
-
- else if((pSite_left->node1!=pSite_left->node2)&&
- (pSite_right->node1 == pSite_right->node2))
- _cvCalcEdgeLP(pSite_left,pSite_right->node1,pEdge,pVoronoiDiagram);
-
- else if((pSite_left->node1==pSite_left->node2)&&
- (pSite_right->node1!=pSite_right->node2))
- _cvCalcEdgePL(pSite_left->node1,pSite_right,pEdge,pVoronoiDiagram);
-
- else
- _cvCalcEdgePP(&(pSite_left->node1->node),
- &(pSite_right->node1->node),
- pEdge,pVoronoiDiagram);
-}//end of _cvCalcEdge
-
-void _cvCalcEdge(pCvVoronoiSite pSite,
- pCvVoronoiNode pNode,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- if(pSite->node1!=pSite->node2)
- _cvCalcEdgeLP(pSite, pNode, pEdge,pVoronoiDiagram);
- else
- _cvCalcEdgePP(&(pSite->node1->node),
- &pNode->node,
- pEdge,pVoronoiDiagram);
-}//end of _cvCalcEdge
-
-void _cvCalcEdge(pCvVoronoiNode pNode,
- pCvVoronoiSite pSite,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- if(pSite->node1!=pSite->node2)
- _cvCalcEdgePL(pNode,pSite,pEdge,pVoronoiDiagram);
- else
- _cvCalcEdgePP(&pNode->node,&pSite->node1->node,pEdge,pVoronoiDiagram);
-}//end of _cvCalcEdge
-
-CV_INLINE
-void _cvCalcEdgeLL(pCvDirection pDirection1,
- pCvDirection pDirection2,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- CvDirection Direction = {pDirection2->x - pDirection1->x, pDirection2->y - pDirection1->y};
- if((fabs(Direction.x)<LEE_CONST_ZERO)&&(fabs(Direction.y)<LEE_CONST_ZERO))
- Direction = *pDirection2;
- pEdge->direction = _cvSeqPush(pVoronoiDiagram->DirectionSeq,&Direction);;
-}//end of _cvCalcEdgeLL
-
-CV_INLINE
-void _cvCalcEdgePP(pCvPointFloat pPoint1,
- pCvPointFloat pPoint2,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- CvDirection Direction = {pPoint1->y - pPoint2->y,pPoint2->x - pPoint1->x};
- pEdge->direction = _cvSeqPush(pVoronoiDiagram->DirectionSeq,&Direction);
-}//end of _cvCalcEdgePP
-
-CV_INLINE
-void _cvCalcEdgePL(pCvVoronoiNode pFocus,
- pCvVoronoiSite pDirectrice,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvPointFloat pPoint0 = &pFocus->node;
- pCvPointFloat pPoint1 = &pDirectrice->node1->node;
-
- CvDirection Vector01 = {pPoint0->x - pPoint1->x,pPoint0->y - pPoint1->y};
- float half_h = (Vector01.y*pDirectrice->direction->x - Vector01.x*pDirectrice->direction->y)/2;
- CvDirection Normal = {-pDirectrice->direction->y,pDirectrice->direction->x};
- if(half_h < LEE_CONST_ZERO)
- {
- pEdge->direction = _cvSeqPush(pVoronoiDiagram->DirectionSeq,&Normal);
- return;
- }
- CvVoronoiParabolaInt Parabola;
- pCvVoronoiParabola pParabola = _cvSeqPush(pVoronoiDiagram->ParabolaSeq,&Parabola);
- float* map = pParabola->map;
-
- map[1] = Normal.x;
- map[4] = Normal.y;
- map[0] = Normal.y;
- map[3] = -Normal.x;
- map[2] = pPoint0->x - Normal.x*half_h;
- map[5] = pPoint0->y - Normal.y*half_h;
-
- pParabola->a = 1/(4*half_h);
- pParabola->focus = pFocus;
- pParabola->directrice = pDirectrice;
- pEdge->parabola = pParabola;
-}//end of _cvCalcEdgePL
-
-CV_INLINE
-void _cvCalcEdgeLP(pCvVoronoiSite pDirectrice,
- pCvVoronoiNode pFocus,
- pCvVoronoiEdge pEdge,
- CvVoronoiDiagramInt* pVoronoiDiagram)
-{
- pCvPointFloat pPoint0 = &pFocus->node;
- pCvPointFloat pPoint1 = &pDirectrice->node1->node;
-
- CvDirection Vector01 = {pPoint0->x - pPoint1->x,pPoint0->y - pPoint1->y};
- float half_h = (Vector01.y*pDirectrice->direction->x - Vector01.x*pDirectrice->direction->y)/2;
- CvDirection Normal = {-pDirectrice->direction->y,pDirectrice->direction->x};
- if(half_h < LEE_CONST_ZERO)
- {
- pEdge->direction = _cvSeqPush(pVoronoiDiagram->DirectionSeq,&Normal);
- return;
- }
- CvVoronoiParabolaInt Parabola;
- pCvVoronoiParabola pParabola = _cvSeqPush(pVoronoiDiagram->ParabolaSeq,&Parabola);
- float* map = pParabola->map;
-
- map[1] = Normal.x;
- map[4] = Normal.y;
- map[0] = -Normal.y;
- map[3] = Normal.x;
- map[2] = pPoint0->x - Normal.x*half_h;
- map[5] = pPoint0->y - Normal.y*half_h;
-
- pParabola->a = 1/(4*half_h);
- pParabola->focus = pFocus;
- pParabola->directrice = pDirectrice;
- pEdge->parabola = pParabola;
-}//end of _cvCalcEdgeLP
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Computation of intersections of bisectors //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-static
-float _cvCalcEdgeIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- CvPointFloat* pPoint,
- float &Radius)
-{
- if((pEdge1->parabola==NULL)&&(pEdge2->parabola==NULL))
- return _cvLine_LineIntersection(pEdge1,pEdge2,pPoint,Radius);
- if((pEdge1->parabola==NULL)&&(pEdge2->parabola!=NULL))
- return _cvLine_ParIntersection(pEdge1,pEdge2,pPoint,Radius);
- if((pEdge1->parabola!=NULL)&&(pEdge2->parabola==NULL))
- return _cvPar_LineIntersection(pEdge1,pEdge2,pPoint,Radius);
- if((pEdge1->parabola!=NULL)&&(pEdge2->parabola!=NULL))
- return _cvPar_ParIntersection(pEdge1,pEdge2,pPoint,Radius);
- return -1;
-}//end of _cvCalcEdgeIntersection
-
-static
-float _cvLine_LineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- return -1;
-
- CvPointFloat Point1,Point3;
- float det;
- float k,m;
- float x21,x43,y43,y21,x31,y31;
-
- if(pEdge1->node1!=NULL)
- {
- Point1.x = pEdge1->node1->node.x;
- Point1.y = pEdge1->node1->node.y;
- }
- else
- {
- Point1.x = pEdge1->node2->node.x;
- Point1.y = pEdge1->node2->node.y;
- }
- x21 = pEdge1->direction->x;
- y21 = pEdge1->direction->y;
-
- if(pEdge2->node2==NULL)
- {
- Point3.x = pEdge2->node1->node.x;
- Point3.y = pEdge2->node1->node.y;
- x43 = pEdge2->direction->x;
- y43 = pEdge2->direction->y;
-
- }
- else if(pEdge2->node1==NULL)
- {
- Point3.x = pEdge2->node2->node.x;
- Point3.y = pEdge2->node2->node.y;
- x43 = pEdge2->direction->x;
- y43 = pEdge2->direction->y;
- }
- else
- {
- Point3.x = pEdge2->node1->node.x;
- Point3.y = pEdge2->node1->node.y;
- x43 = pEdge2->node2->node.x - Point3.x;
- y43 = pEdge2->node2->node.y - Point3.y;
- }
-
- x31 = Point3.x - Point1.x;
- y31 = Point3.y - Point1.y;
-
- det = y21*x43 - x21*y43;
- if(fabs(det) < LEE_CONST_ZERO)
- return -1;
-
- k = (x43*y31 - y43*x31)/det;
- m = (x21*y31 - y21*x31)/det;
-
- if(k<-LEE_CONST_ACCEPTABLE_ERROR||m<-LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- if(((pEdge1->node2!=NULL)&&(pEdge1->node1!=NULL))&&(k>1.f+LEE_CONST_ACCEPTABLE_ERROR))
- return -1;
- if(((pEdge2->node2!=NULL)&&(pEdge2->node1!=NULL))&&(m>1.f+LEE_CONST_ACCEPTABLE_ERROR))
- return -1;
-
- pPoint->x = (float)(k*x21) + Point1.x;
- pPoint->y = (float)(k*y21) + Point1.y;
-
- Radius = _cvCalcDist(pPoint,pEdge1->site);
- return _cvPPDist(pPoint,&Point1);;
-}//end of _cvLine_LineIntersection
-
-static
-float _cvLine_ParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- if(pEdge2->node1==NULL||pEdge2->node2==NULL)
- return _cvLine_OpenParIntersection(pEdge1,pEdge2,pPoint,Radius);
- else
- return _cvLine_CloseParIntersection(pEdge1,pEdge2,pPoint,Radius);
-}//end of _cvLine_ParIntersection
-
-static
-float _cvLine_OpenParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- pCvPointFloat pRayPoint1;
- if(pEdge1->node1!=NULL)
- pRayPoint1 = &(pEdge1->node1->node);
- else
- pRayPoint1 = &(pEdge1->node2->node);
-
- pCvDirection pDirection = pEdge1->direction;
- float* Parabola = pEdge2->parabola->map;
-
- pCvPointFloat pParPoint1;
- if(pEdge2->node1==NULL)
- pParPoint1 = &(pEdge2->node2->node);
- else
- pParPoint1 = &(pEdge2->node1->node);
-
- float InversParabola[6];
- _cvCalcOrtogInverse(InversParabola, Parabola);
-
- CvPointFloat Point,ParPoint1_img,RayPoint1_img;
- CvDirection Direction_img;
- _cvCalcPointImage(&RayPoint1_img, pRayPoint1, InversParabola);
- _cvCalcVectorImage(&Direction_img,pDirection, InversParabola);
-
- float c2 = pEdge2->parabola->a*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* RayPoint1_img.x - Direction_img.x*RayPoint1_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
- if(N==0)
- return -1;
-
- _cvCalcPointImage(&ParPoint1_img, pParPoint1, InversParabola);
- int sign_x = SIGN(Direction_img.x);
- int sign_y = SIGN(Direction_img.y);
- if(N==1)
- {
- if(X[0]<ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- float pr0 = (X[0]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[0]*X[0]-RayPoint1_img.y)*sign_y;
- if(pr0 <= -LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- }
- else
- {
- if(X[1]<ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- float pr0 = (X[0]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[0]*X[0]-RayPoint1_img.y)*sign_y;
- float pr1 = (X[1]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[1]*X[1]-RayPoint1_img.y)*sign_y;
-
- if(pr0 <= -LEE_CONST_ACCEPTABLE_ERROR &&pr1 <= -LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
-
- if(pr0 >- LEE_CONST_ACCEPTABLE_ERROR && pr1 >- LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(X[0] >= ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(pr0>pr1)
- _cvSwap(X[0],X[1]);
- }
- else
- {
- N=1;
- X[0] = X[1];
- }
- }
- else if(pr0 >- LEE_CONST_ACCEPTABLE_ERROR)
- {
- N = 1;
- if(X[0] < ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- }
- else if(pr1 >- LEE_CONST_ACCEPTABLE_ERROR)
- {
- N=1;
- X[0] = X[1];
- }
- else
- return -1;
- }
-
- Point.x = X[(N-1)*(IntersectionNumber - 1)];
- Point.y = pEdge2->parabola->a*Point.x*Point.x;
-
- Radius = Point.y + 1.f/(4*pEdge2->parabola->a);
- _cvCalcPointImage(pPoint,&Point,Parabola);
- float dist = _cvPPDist(pPoint, pRayPoint1);
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvLine_OpenParIntersection
-
-static
-float _cvLine_CloseParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- pCvPointFloat pRayPoint1;
- if(pEdge1->node1!=NULL)
- pRayPoint1 = &(pEdge1->node1->node);
- else
- pRayPoint1 = &(pEdge1->node2->node);
-
- pCvDirection pDirection = pEdge1->direction;
- float* Parabola = pEdge2->parabola->map;
-
- pCvPointFloat pParPoint1,pParPoint2;
- pParPoint2 = &(pEdge2->node1->node);
- pParPoint1 = &(pEdge2->node2->node);
-
-
- float InversParabola[6];
- _cvCalcOrtogInverse(InversParabola, Parabola);
-
- CvPointFloat Point,ParPoint1_img,ParPoint2_img,RayPoint1_img;
- CvDirection Direction_img;
- _cvCalcPointImage(&RayPoint1_img, pRayPoint1, InversParabola);
- _cvCalcVectorImage(&Direction_img,pDirection, InversParabola);
-
- float c2 = pEdge2->parabola->a*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* RayPoint1_img.x - Direction_img.x*RayPoint1_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
- if(N==0)
- return -1;
-
- _cvCalcPointImage(&ParPoint1_img, pParPoint1, InversParabola);
- _cvCalcPointImage(&ParPoint2_img, pParPoint2, InversParabola);
- if(ParPoint1_img.x>ParPoint2_img.x)
- _cvSwap(ParPoint1_img,ParPoint2_img);
- int sign_x = SIGN(Direction_img.x);
- int sign_y = SIGN(Direction_img.y);
- if(N==1)
- {
- if((X[0]<ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR) ||
- (X[0]>ParPoint2_img.x + LEE_CONST_ACCEPTABLE_ERROR))
- return -1;
- float pr0 = (X[0]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[0]*X[0]-RayPoint1_img.y)*sign_y;
- if(pr0 <= -LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
- }
- else
- {
- if((X[1]<ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR) ||
- (X[0]>ParPoint2_img.x + LEE_CONST_ACCEPTABLE_ERROR))
- return -1;
-
- if((X[0]<ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR) &&
- (X[1]>ParPoint2_img.x + LEE_CONST_ACCEPTABLE_ERROR))
- return -1;
-
- float pr0 = (X[0]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[0]*X[0]-RayPoint1_img.y)*sign_y;
- float pr1 = (X[1]-RayPoint1_img.x)*sign_x + \
- (pEdge2->parabola->a*X[1]*X[1]-RayPoint1_img.y)*sign_y;
-
- if(pr0 <= -LEE_CONST_ACCEPTABLE_ERROR && pr1 <= -LEE_CONST_ACCEPTABLE_ERROR)
- return -1;
-
- if(pr0 > -LEE_CONST_ACCEPTABLE_ERROR && pr1 > -LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(X[0] >= ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(X[1] <= ParPoint2_img.x + LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(pr0>pr1)
- _cvSwap(X[0], X[1]);
- }
- else
- N=1;
- }
- else
- {
- N=1;
- X[0] = X[1];
- }
- }
- else if(pr0 > -LEE_CONST_ACCEPTABLE_ERROR)
- {
-
- if(X[0] >= ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- N=1;
- else
- return -1;
- }
- else if(pr1 > -LEE_CONST_ACCEPTABLE_ERROR)
- {
- if(X[1] <= ParPoint2_img.x + LEE_CONST_ACCEPTABLE_ERROR)
- {
- N=1;
- X[0] = X[1];
- }
- else
- return -1;
- }
- else
- return -1;
- }
-
- Point.x = X[(N-1)*(IntersectionNumber - 1)];
- Point.y = pEdge2->parabola->a*Point.x*Point.x;
- Radius = Point.y + 1.f/(4*pEdge2->parabola->a);
- _cvCalcPointImage(pPoint,&Point,Parabola);
- float dist = _cvPPDist(pPoint, pRayPoint1);
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvLine_CloseParIntersection
-
-static
-float _cvPar_LineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- if(pEdge2->node1==NULL||pEdge2->node2==NULL)
- return _cvPar_OpenLineIntersection(pEdge1,pEdge2,pPoint,Radius);
- else
- return _cvPar_CloseLineIntersection(pEdge1,pEdge2,pPoint,Radius);
-}//end _cvPar_LineIntersection
-
-static
-float _cvPar_OpenLineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int i, IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- float* Parabola = pEdge1->parabola->map;
- pCvPointFloat pParPoint1;
- if(pEdge1->node1!=NULL)
- pParPoint1 = &(pEdge1->node1->node);
- else
- pParPoint1 = &(pEdge1->node2->node);
-
- pCvPointFloat pRayPoint1;
- if(pEdge2->node1==NULL)
- pRayPoint1 = &(pEdge2->node2->node);
- else
- pRayPoint1 = &(pEdge2->node1->node);
- pCvDirection pDirection = pEdge2->direction;
-
-
- float InversParabola[6];
- _cvCalcOrtogInverse(InversParabola, Parabola);
-
- CvPointFloat Point = {0,0},ParPoint1_img,RayPoint1_img;
- CvDirection Direction_img;
- _cvCalcVectorImage(&Direction_img,pDirection, InversParabola);
- _cvCalcPointImage(&RayPoint1_img, pRayPoint1, InversParabola);
-
-
- float q = RayPoint1_img.y - pEdge1->parabola->a*RayPoint1_img.x*RayPoint1_img.x;
- if(pEdge2->site->node1 == pEdge2->site->node2 && q < 0 ||
- pEdge2->site->node1 != pEdge2->site->node2 && q > 0)
- return -1;
-
- float c2 = pEdge1->parabola->a*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* RayPoint1_img.x - Direction_img.x*RayPoint1_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
- if(N==0)
- return -1;
-
- _cvCalcPointImage(&ParPoint1_img, pParPoint1, InversParabola);
- int sign_x = SIGN(Direction_img.x);
- int sign_y = SIGN(Direction_img.y);
- float pr;
-
- if(N==2 && IntersectionNumber == 2)
- _cvSwap(X[0], X[1]);
-
- for( i=0;i<N;i++)
- {
- if(X[i]<=ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- pr = (X[i]-RayPoint1_img.x)*sign_x +
- (pEdge1->parabola->a*X[i]*X[i]-RayPoint1_img.y)*sign_y;
- if(pr <= -LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- else
- {
- Point.x = X[i];
- break;
- }
- }
-
- if(i==N)
- return -1;
-
- Point.y = pEdge1->parabola->a*Point.x*Point.x;
- Radius = Point.y + 1.f/(4*pEdge1->parabola->a);
- _cvCalcPointImage(pPoint,&Point,Parabola);
- float dist = Point.x - ParPoint1_img.x;
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvPar_OpenLineIntersection
-
-static
-float _cvPar_CloseLineIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int i, IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- float* Parabola = pEdge1->parabola->map;
- pCvPointFloat pParPoint1;
- if(pEdge1->node1!=NULL)
- pParPoint1 = &(pEdge1->node1->node);
- else
- pParPoint1 = &(pEdge1->node2->node);
-
- pCvPointFloat pRayPoint1,pRayPoint2;
- pRayPoint2 = &(pEdge2->node1->node);
- pRayPoint1 = &(pEdge2->node2->node);
-
- pCvDirection pDirection = pEdge2->direction;
- float InversParabola[6];
- _cvCalcOrtogInverse(InversParabola, Parabola);
-
- CvPointFloat Point={0,0},ParPoint1_img,RayPoint1_img,RayPoint2_img;
- CvDirection Direction_img;
- _cvCalcPointImage(&RayPoint1_img, pRayPoint1, InversParabola);
- _cvCalcPointImage(&RayPoint2_img, pRayPoint2, InversParabola);
-
- float q;
- if(Radius == -1)
- {
- q = RayPoint1_img.y - pEdge1->parabola->a*RayPoint1_img.x*RayPoint1_img.x;
- if(pEdge2->site->node1 == pEdge2->site->node2 && q < 0 ||
- pEdge2->site->node1 != pEdge2->site->node2 && q > 0)
- return -1;
- }
- if(Radius == -2)
- {
- q = RayPoint2_img.y - pEdge1->parabola->a*RayPoint2_img.x*RayPoint2_img.x;
- if(pEdge2->site->node1 == pEdge2->site->node2 && q < 0 ||
- pEdge2->site->node1 != pEdge2->site->node2 && q > 0)
- return -1;
- }
-
- _cvCalcPointImage(&ParPoint1_img, pParPoint1, InversParabola);
- _cvCalcVectorImage(&Direction_img,pDirection, InversParabola);
-
- float c2 = pEdge1->parabola->a*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* RayPoint1_img.x - Direction_img.x*RayPoint1_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
- if(N==0)
- return -1;
- int sign_x = SIGN(RayPoint2_img.x - RayPoint1_img.x);
- int sign_y = SIGN(RayPoint2_img.y - RayPoint1_img.y);
- float pr_dir = (RayPoint2_img.x - RayPoint1_img.x)*sign_x +
- (RayPoint2_img.y - RayPoint1_img.y)*sign_y;
- float pr;
-
- if(N==2 && IntersectionNumber == 2)
- _cvSwap(X[0], X[1]);
-
- for( i =0;i<N;i++)
- {
- if(X[i] <= ParPoint1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- pr = (X[i]-RayPoint1_img.x)*sign_x + \
- (pEdge1->parabola->a*X[i]*X[i]-RayPoint1_img.y)*sign_y;
- if(pr <= -LEE_CONST_ACCEPTABLE_ERROR || pr>=pr_dir + LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- else
- {
- Point.x = X[i];
- break;
- }
- }
-
- if(i==N)
- return -1;
-
- Point.y = pEdge1->parabola->a*Point.x*Point.x;
- Radius = Point.y + 1.f/(4*pEdge1->parabola->a);
- _cvCalcPointImage(pPoint,&Point,Parabola);
- float dist = Point.x - ParPoint1_img.x;
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvPar_CloseLineIntersection
-
-static
-float _cvPar_ParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- if(pEdge2->node1==NULL||pEdge2->node2==NULL)
- return _cvPar_OpenParIntersection(pEdge1,pEdge2,pPoint,Radius);
- else
- return _cvPar_CloseParIntersection(pEdge1,pEdge2,pPoint,Radius);
-}// end of _cvPar_ParIntersection
-
-static
-float _cvPar_OpenParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int i, IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- float* Parabola1 = pEdge1->parabola->map;
- pCvPointFloat pPar1Point1;
- if(pEdge1->node1!=NULL)
- pPar1Point1 = &(pEdge1->node1->node);
- else
- pPar1Point1 = &(pEdge1->node2->node);
-
- float* Parabola2 = pEdge2->parabola->map;
- pCvPointFloat pPar2Point1;
- if(pEdge2->node1!=NULL)
- pPar2Point1 = &(pEdge2->node1->node);
- else
- pPar2Point1 = &(pEdge2->node2->node);
-
- CvPointFloat Point;
- CvDirection Direction;
- if(pEdge1->parabola->directrice==pEdge2->parabola->directrice) //common site is segment -> different focuses
- {
- pCvPointFloat pFocus1 = &(pEdge1->parabola->focus->node);
- pCvPointFloat pFocus2 = &(pEdge2->parabola->focus->node);
-
- Point.x = (pFocus1->x + pFocus2->x)/2;
- Point.y = (pFocus1->y + pFocus2->y)/2;
- Direction.x = pFocus1->y - pFocus2->y;
- Direction.y = pFocus2->x - pFocus1->x;
- }
- else//common site is focus -> different directrices
- {
- pCvVoronoiSite pDirectrice1 = pEdge1->parabola->directrice;
- pCvPointFloat pPoint1 = &(pDirectrice1->node1->node);
- pCvDirection pVector21 = pDirectrice1->direction;
-
- pCvVoronoiSite pDirectrice2 = pEdge2->parabola->directrice;
- pCvPointFloat pPoint3 = &(pDirectrice2->node1->node);
- pCvDirection pVector43 = pDirectrice2->direction;
-
- Direction.x = pVector43->x - pVector21->x;
- Direction.y = pVector43->y - pVector21->y;
-
- if((fabs(Direction.x) < LEE_CONST_ZERO) &&
- (fabs(Direction.y) < LEE_CONST_ZERO))
- Direction = *pVector43;
-
- float det = pVector21->y * pVector43->x - pVector21->x * pVector43->y;
- if(fabs(det) < LEE_CONST_ZERO)
- {
- Point.x = (pPoint1->x + pPoint3->x)/2;
- Point.y = (pPoint1->y + pPoint3->y)/2;
- }
- else
- {
- float d1 = pVector21->y*pPoint1->x - pVector21->x*pPoint1->y;
- float d2 = pVector43->y*pPoint3->x - pVector43->x*pPoint3->y;
- Point.x = (float)((pVector43->x*d1 - pVector21->x*d2)/det);
- Point.y = (float)((pVector43->y*d1 - pVector21->y*d2)/det);
- }
- }
-
- float InversParabola2[6];
- _cvCalcOrtogInverse(InversParabola2, Parabola2);
-
- CvPointFloat Par2Point1_img,Point_img;
- CvDirection Direction_img;
- _cvCalcVectorImage(&Direction_img,&Direction, InversParabola2);
- _cvCalcPointImage(&Point_img, &Point, InversParabola2);
-
- float a1 = pEdge1->parabola->a;
- float a2 = pEdge2->parabola->a;
- float c2 = a2*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* Point_img.x - Direction_img.x*Point_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
-
- if(N==0)
- return -1;
-
- _cvCalcPointImage(&Par2Point1_img, pPar2Point1, InversParabola2);
-
- if(X[N-1]<Par2Point1_img.x)
- return -1;
-
- if(X[0]<Par2Point1_img.x)
- {
- X[0] = X[1];
- N=1;
- }
-
- float InversParabola1[6];
- CvPointFloat Par1Point1_img;
- _cvCalcOrtogInverse(InversParabola1, Parabola1);
- _cvCalcPointImage(&Par1Point1_img, pPar1Point1, InversParabola1);
- float InvPar1_Par2[6];
- _cvCalcComposition(InvPar1_Par2,InversParabola1,Parabola2);
- for(i=0;i<N;i++)
- X[i] = (InvPar1_Par2[1]*a2*X[i] + InvPar1_Par2[0])*X[i] + InvPar1_Par2[2];
-
- if(N!=1)
- {
- if((X[0]>X[1] && IntersectionNumber == 1)||
- (X[0]<X[1] && IntersectionNumber == 2))
- _cvSwap(X[0], X[1]);
- }
-
- for(i = 0;i<N;i++)
- {
- Point.x = X[i];
- Point.y = a1*Point.x*Point.x;
- if(Point.x < Par1Point1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- else
- break;
- }
-
- if(i==N)
- return -1;
-
- Radius = Point.y + 1.f/(4*pEdge1->parabola->a);
- _cvCalcPointImage(pPoint,&Point,Parabola1);
- float dist = Point.x - Par1Point1_img.x;
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvPar_OpenParIntersection
-
-static
-float _cvPar_CloseParIntersection(pCvVoronoiEdge pEdge1,
- pCvVoronoiEdge pEdge2,
- pCvPointFloat pPoint,
- float &Radius)
-{
- int i, IntersectionNumber = 1;
- if(((pEdge1->node1 == pEdge2->node1 ||
- pEdge1->node1 == pEdge2->node2) &&
- pEdge1->node1 != NULL)||
- ((pEdge1->node2 == pEdge2->node1 ||
- pEdge1->node2 == pEdge2->node2) &&
- pEdge1->node2 != NULL))
- IntersectionNumber = 2;
-
- float* Parabola1 = pEdge1->parabola->map;
- float* Parabola2 = pEdge2->parabola->map;
- pCvPointFloat pPar1Point1;
- if(pEdge1->node1!=NULL)
- pPar1Point1 = &(pEdge1->node1->node);
- else
- pPar1Point1 = &(pEdge1->node2->node);
-
- pCvPointFloat pPar2Point1 = &(pEdge2->node1->node);
- pCvPointFloat pPar2Point2 = &(pEdge2->node2->node);
-
- CvPointFloat Point;
- CvDirection Direction;
- if(pEdge1->parabola->directrice==pEdge2->parabola->directrice) //common site is segment -> different focuses
- {
- pCvPointFloat pFocus1 = &(pEdge1->parabola->focus->node);
- pCvPointFloat pFocus2 = &(pEdge2->parabola->focus->node);
-
- Point.x = (pFocus1->x + pFocus2->x)/2;
- Point.y = (pFocus1->y + pFocus2->y)/2;
- Direction.x = pFocus1->y - pFocus2->y;
- Direction.y = pFocus2->x - pFocus1->x;
- }
- else//common site is focus -> different directrices
- {
- pCvVoronoiSite pDirectrice1 = pEdge1->parabola->directrice;
- pCvPointFloat pPoint1 = &(pDirectrice1->node1->node);
- pCvDirection pVector21 = pDirectrice1->direction;
-
- pCvVoronoiSite pDirectrice2 = pEdge2->parabola->directrice;
- pCvPointFloat pPoint3 = &(pDirectrice2->node1->node);
- pCvDirection pVector43 = pDirectrice2->direction;
-
- Direction.x = pVector43->x - pVector21->x;
- Direction.y = pVector43->y - pVector21->y;
-
- if((fabs(Direction.x) < LEE_CONST_ZERO) &&
- (fabs(Direction.y) < LEE_CONST_ZERO))
- Direction = *pVector43;
-
- float det = pVector21->y * pVector43->x - pVector21->x * pVector43->y;
- if(fabs(det) < LEE_CONST_ZERO)
- {
- Point.x = (pPoint1->x + pPoint3->x)/2;
- Point.y = (pPoint1->y + pPoint3->y)/2;
- }
- else
- {
- float d1 = pVector21->y*pPoint1->x - pVector21->x*pPoint1->y;
- float d2 = pVector43->y*pPoint3->x - pVector43->x*pPoint3->y;
- Point.x = (float)((pVector43->x*d1 - pVector21->x*d2)/det);
- Point.y = (float)((pVector43->y*d1 - pVector21->y*d2)/det);
- }
- }
-
-
-
- float InversParabola2[6];
- _cvCalcOrtogInverse(InversParabola2, Parabola2);
-
- CvPointFloat Par2Point1_img,Par2Point2_img,Point_img;
- CvDirection Direction_img;
- _cvCalcVectorImage(&Direction_img,&Direction, InversParabola2);
- _cvCalcPointImage(&Point_img, &Point, InversParabola2);
-
- float a1 = pEdge1->parabola->a;
- float a2 = pEdge2->parabola->a;
- float c2 = a2*Direction_img.x;
- float c1 = -Direction_img.y;
- float c0 = Direction_img.y* Point_img.x - Direction_img.x*Point_img.y;
- float X[2];
- int N = _cvSolveEqu2thR(c2,c1,c0,X);
-
- if(N==0)
- return -1;
-
- _cvCalcPointImage(&Par2Point1_img, pPar2Point1, InversParabola2);
- _cvCalcPointImage(&Par2Point2_img, pPar2Point2, InversParabola2);
- if(Par2Point1_img.x>Par2Point2_img.x)
- _cvSwap(Par2Point1_img,Par2Point2_img);
-
- if(X[0]>Par2Point2_img.x||X[N-1]<Par2Point1_img.x)
- return -1;
-
- if(X[0]<Par2Point1_img.x)
- {
- if(X[1]<Par2Point2_img.x)
- {
- X[0] = X[1];
- N=1;
- }
- else
- return -1;
- }
- else if(X[N-1]>Par2Point2_img.x)
- N=1;
-
- float InversParabola1[6];
- CvPointFloat Par1Point1_img;
- _cvCalcOrtogInverse(InversParabola1, Parabola1);
- _cvCalcPointImage(&Par1Point1_img, pPar1Point1, InversParabola1);
- float InvPar1_Par2[6];
- _cvCalcComposition(InvPar1_Par2,InversParabola1,Parabola2);
- for(i=0;i<N;i++)
- X[i] = (InvPar1_Par2[1]*a2*X[i] + InvPar1_Par2[0])*X[i] + InvPar1_Par2[2];
-
- if(N!=1)
- {
- if((X[0]>X[1] && IntersectionNumber == 1)||
- (X[0]<X[1] && IntersectionNumber == 2))
- _cvSwap(X[0], X[1]);
- }
-
-
- for(i = 0;i<N;i++)
- {
- Point.x = (float)X[i];
- Point.y = (float)a1*Point.x*Point.x;
- if(Point.x < Par1Point1_img.x - LEE_CONST_ACCEPTABLE_ERROR)
- continue;
- else
- break;
- }
-
- if(i==N)
- return -1;
-
- Radius = Point.y + 1.f/(4*a1);
- _cvCalcPointImage(pPoint,&Point,Parabola1);
- float dist = Point.x - Par1Point1_img.x;
- if(IntersectionNumber == 2 && dist < LEE_CONST_DIFF_POINTS)
- return -1;
- else
- return dist;
-}// end of _cvPar_CloseParIntersection
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Subsidiary functions //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-CV_INLINE
-void _cvMakeTwinEdge(pCvVoronoiEdge pEdge2,
- pCvVoronoiEdge pEdge1)
-{
- pEdge2->direction = pEdge1->direction;
- pEdge2->parabola = pEdge1->parabola;
- pEdge2->node1 = pEdge1->node2;
- pEdge2->twin_edge = pEdge1;
- pEdge1->twin_edge = pEdge2;
-}//end of _cvMakeTwinEdge
-
-CV_INLINE
-void _cvStickEdgeLeftBegin(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_left_prev,
- pCvVoronoiSite pSite_left)
-{
- pEdge->prev_edge = pEdge_left_prev;
- pEdge->site = pSite_left;
- if(pEdge_left_prev == NULL)
- pSite_left->edge2 = pEdge;
- else
- {
- pEdge_left_prev->node2 = pEdge->node1;
- pEdge_left_prev->next_edge = pEdge;
- }
-}//end of _cvStickEdgeLeftBegin
-
-CV_INLINE
-void _cvStickEdgeRightBegin(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_right_next,
- pCvVoronoiSite pSite_right)
-{
- pEdge->next_edge = pEdge_right_next;
- pEdge->site = pSite_right;
- if(pEdge_right_next == NULL)
- pSite_right->edge1 = pEdge;
- else
- {
- pEdge_right_next->node1 = pEdge->node2;
- pEdge_right_next->prev_edge = pEdge;
- }
-}// end of _cvStickEdgeRightBegin
-
-CV_INLINE
-void _cvStickEdgeLeftEnd(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_left_next,
- pCvVoronoiSite pSite_left)
-{
- pEdge->next_edge = pEdge_left_next;
- if(pEdge_left_next == NULL)
- pSite_left->edge1 = pEdge;
- else
- {
- pEdge_left_next->node1 = pEdge->node2;
- pEdge_left_next->prev_edge = pEdge;
- }
-}//end of _cvStickEdgeLeftEnd
-
-CV_INLINE
-void _cvStickEdgeRightEnd(pCvVoronoiEdge pEdge,
- pCvVoronoiEdge pEdge_right_prev,
- pCvVoronoiSite pSite_right)
-{
- pEdge->prev_edge = pEdge_right_prev;
- if(pEdge_right_prev == NULL)
- pSite_right->edge2 = pEdge;
- else
- {
- pEdge_right_prev->node2 = pEdge->node1;
- pEdge_right_prev->next_edge = pEdge;
- }
-}//end of _cvStickEdgeRightEnd
-
-template <class T> CV_INLINE
-void _cvInitVoronoiNode(pCvVoronoiNode pNode,
- T pPoint,
- float radius)
-{
- pNode->node.x = (float)pPoint->x;
- pNode->node.y = (float)pPoint->y;
- pNode->radius = radius;
-}//end of _cvInitVoronoiNode
-
-CV_INLINE
-void _cvInitVoronoiSite(pCvVoronoiSite pSite,
- pCvVoronoiNode pNode1,
- pCvVoronoiNode pNode2,
- pCvVoronoiSite pPrev_site)
-{
- pSite->node1 = pNode1;
- pSite->node2 = pNode2;
- pSite->prev_site = pPrev_site;
-}//end of _cvInitVoronoiSite
-
-template <class T> CV_INLINE
-T _cvSeqPush(CvSeq* Seq, T pElem)
-{
- cvSeqPush(Seq, pElem);
- return (T)(Seq->ptr - Seq->elem_size);
-// return (T)cvGetSeqElem(Seq, Seq->total - 1,NULL);
-}//end of _cvSeqPush
-
-template <class T> CV_INLINE
-T _cvSeqPushFront(CvSeq* Seq, T pElem)
-{
- cvSeqPushFront(Seq,pElem);
- return (T)Seq->first->data;
-// return (T)cvGetSeqElem(Seq,0,NULL);
-}//end of _cvSeqPushFront
-
-CV_INLINE
-void _cvTwinNULLLeft(pCvVoronoiEdge pEdge_left_cur,
- pCvVoronoiEdge pEdge_left)
-{
- while(pEdge_left_cur!=pEdge_left)
- {
- if(pEdge_left_cur->twin_edge!=NULL)
- pEdge_left_cur->twin_edge->twin_edge = NULL;
- pEdge_left_cur = pEdge_left_cur->next_edge;
- }
-}//end of _cvTwinNULLLeft
-
-CV_INLINE
-void _cvTwinNULLRight(pCvVoronoiEdge pEdge_right_cur,
- pCvVoronoiEdge pEdge_right)
-{
- while(pEdge_right_cur!=pEdge_right)
- {
- if(pEdge_right_cur->twin_edge!=NULL)
- pEdge_right_cur->twin_edge->twin_edge = NULL;
- pEdge_right_cur = pEdge_right_cur->prev_edge;
- }
-}//end of _cvTwinNULLRight
-
-CV_INLINE
-void _cvSeqPushInOrder(CvVoronoiDiagramInt* pVoronoiDiagram, pCvVoronoiHole pHole)
-{
- pHole = _cvSeqPush(pVoronoiDiagram->HoleSeq, pHole);
- if(pVoronoiDiagram->HoleSeq->total == 1)
- {
- pVoronoiDiagram->top_hole = pHole;
- return;
- }
-
- pCvVoronoiHole pTopHole = pVoronoiDiagram->top_hole;
- pCvVoronoiHole pCurrHole;
- if(pTopHole->x_coord >= pHole->x_coord)
- {
- pHole->next_hole = pTopHole;
- pVoronoiDiagram->top_hole = pHole;
- return;
- }
-
- for(pCurrHole = pTopHole; \
- pCurrHole->next_hole != NULL; \
- pCurrHole = pCurrHole->next_hole)
- if(pCurrHole->next_hole->x_coord >= pHole->x_coord)
- break;
- pHole->next_hole = pCurrHole->next_hole;
- pCurrHole->next_hole = pHole;
-}//end of _cvSeqPushInOrder
-
-CV_INLINE
-pCvVoronoiEdge _cvDivideRightEdge(pCvVoronoiEdge pEdge,pCvVoronoiNode pNode, CvSeq* EdgeSeq)
-{
- CvVoronoiEdgeInt Edge1 = *pEdge;
- CvVoronoiEdgeInt Edge2 = *pEdge->twin_edge;
- pCvVoronoiEdge pEdge1, pEdge2;
-
- pEdge1 = _cvSeqPush(EdgeSeq, &Edge1);
- pEdge2 = _cvSeqPush(EdgeSeq, &Edge2);
-
- if(pEdge1->next_edge != NULL)
- pEdge1->next_edge->prev_edge = pEdge1;
- pEdge1->prev_edge = NULL;
-
- if(pEdge2->prev_edge != NULL)
- pEdge2->prev_edge->next_edge = pEdge2;
- pEdge2->next_edge = NULL;
-
- pEdge1->node1 = pEdge2->node2= pNode;
- pEdge1->twin_edge = pEdge2;
- pEdge2->twin_edge = pEdge1;
- return pEdge2;
-}//end of _cvDivideRightEdge
-
-CV_INLINE
-pCvVoronoiEdge _cvDivideLeftEdge(pCvVoronoiEdge pEdge,pCvVoronoiNode pNode, CvSeq* EdgeSeq)
-{
- CvVoronoiEdgeInt Edge1 = *pEdge;
- CvVoronoiEdgeInt Edge2 = *pEdge->twin_edge;
- pCvVoronoiEdge pEdge1, pEdge2;
-
- pEdge1 = _cvSeqPush(EdgeSeq, &Edge1);
- pEdge2 = _cvSeqPush(EdgeSeq, &Edge2);
-
- if(pEdge2->next_edge != NULL)
- pEdge2->next_edge->prev_edge = pEdge2;
- pEdge2->prev_edge = NULL;
-
- if(pEdge1->prev_edge != NULL)
- pEdge1->prev_edge->next_edge = pEdge1;
- pEdge1->next_edge = NULL;
-
- pEdge1->node2 = pEdge2->node1= pNode;
- pEdge1->twin_edge = pEdge2;
- pEdge2->twin_edge = pEdge1;
- return pEdge2;
-}//end of _cvDivideLeftEdge
-
-template<class T> CV_INLINE
-T _cvWriteSeqElem(T pElem, CvSeqWriter &writer)
-{
- if( writer.ptr >= writer.block_max )
- cvCreateSeqBlock( &writer);
-
- T ptr = (T)writer.ptr;
- memcpy(writer.ptr, pElem, sizeof(*pElem));
- writer.ptr += sizeof(*pElem);
- return ptr;
-}//end of _cvWriteSeqElem
-
-/* ///////////////////////////////////////////////////////////////////////////////////////
-// Mathematical functions //
-/////////////////////////////////////////////////////////////////////////////////////// */
-
-template<class T> CV_INLINE
-void _cvCalcPointImage(pCvPointFloat pImgPoint,pCvPointFloat pPoint,T* A)
-{
- pImgPoint->x = (float)(A[0]*pPoint->x + A[1]*pPoint->y + A[2]);
- pImgPoint->y = (float)(A[3]*pPoint->x + A[4]*pPoint->y + A[5]);
-}//end of _cvCalcPointImage
-
-template <class T> CV_INLINE
-void _cvSwap(T &x, T &y)
-{
- T z; z=x; x=y; y=z;
-}//end of _cvSwap
-
-template <class T> CV_INLINE
-int _cvCalcOrtogInverse(T* B, T* A)
-{
- int sign_det = SIGN(A[0]*A[4] - A[1]*A[3]);
-
- if(sign_det)
- {
- B[0] = A[4]*sign_det;
- B[1] = -A[1]*sign_det;
- B[3] = -A[3]*sign_det;
- B[4] = A[0]*sign_det;
- B[2] = - (B[0]*A[2]+B[1]*A[5]);
- B[5] = - (B[3]*A[2]+B[4]*A[5]);
- return 1;
- }
- else
- return 0;
-}//end of _cvCalcOrtogInverse
-
-template<class T> CV_INLINE
-void _cvCalcVectorImage(pCvDirection pImgVector,pCvDirection pVector,T* A)
-{
- pImgVector->x = A[0]*pVector->x + A[1]*pVector->y;
- pImgVector->y = A[3]*pVector->x + A[4]*pVector->y;
-}//end of _cvCalcVectorImage
-
-template <class T> CV_INLINE
-void _cvCalcComposition(T* Result,T* A,T* B)
-{
- Result[0] = A[0]*B[0] + A[1]*B[3];
- Result[1] = A[0]*B[1] + A[1]*B[4];
- Result[3] = A[3]*B[0] + A[4]*B[3];
- Result[4] = A[3]*B[1] + A[4]*B[4];
- Result[2] = A[0]*B[2] + A[1]*B[5] + A[2];
- Result[5] = A[3]*B[2] + A[4]*B[5] + A[5];
-}//end of _cvCalcComposition
-
-CV_INLINE
-float _cvCalcDist(pCvPointFloat pPoint, pCvVoronoiSite pSite)
-{
- if(pSite->node1==pSite->node2)
- return _cvPPDist(pPoint,&(pSite->node1->node));
- else
- return _cvPLDist(pPoint,&(pSite->node1->node),pSite->direction);
-}//end of _cvCalcComposition
-
-CV_INLINE
-float _cvPPDist(pCvPointFloat pPoint1,pCvPointFloat pPoint2)
-{
- float delta_x = pPoint1->x - pPoint2->x;
- float delta_y = pPoint1->y - pPoint2->y;
- return (float)sqrt((double)delta_x*delta_x + delta_y*delta_y);
-}//end of _cvPPDist
-
-
-CV_INLINE
-float _cvPLDist(pCvPointFloat pPoint,pCvPointFloat pPoint1,pCvDirection pDirection)
-{
- return (float)fabs(pDirection->x*(pPoint->y - pPoint1->y) -
- pDirection->y*(pPoint->x - pPoint1->x));
-}//end of _cvPLDist
-
-template <class T>
-int _cvSolveEqu2thR(T c2, T c1, T c0, T* X)
-{
- const T eps = (T)1e-6;
- if(fabs(c2)<eps)
- return _cvSolveEqu1th(c1,c0,X);
-
- T Discr = c1*c1 - c2*c0*4;
- if(Discr<-eps)
- return 0;
- Discr = (T)sqrt((double)fabs(Discr));
-
- if(fabs(Discr)<eps)
- {
- X[0] = -c1/(c2*2);
- if(fabs(X[0])<eps)
- X[0]=0;
- return 1;
- }
- else
- {
- if(c1 >=0)
- {
- if(c2>0)
- {
- X[0] = (-c1 - Discr)/(2*c2);
- X[1] = -2*c0/(c1+Discr);
- return 2;
- }
- else
- {
- X[1] = (-c1 - Discr)/(2*c2);
- X[0] = -2*c0/(c1+Discr);
- return 2;
- }
- }
- else
- {
- if(c2>0)
- {
- X[1] = (-c1 + Discr)/(2*c2);
- X[0] = -2*c0/(c1-Discr);
- return 2;
- }
- else
- {
- X[0] = (-c1 + Discr)/(2*c2);
- X[1] = -2*c0/(c1-Discr);
- return 2;
- }
- }
- }
-}//end of _cvSolveEqu2thR
-
-template <class T> CV_INLINE
-int _cvSolveEqu1th(T c1, T c0, T* X)
-{
- const T eps = (T)1e-6;
- if(fabs(c1)<eps)
- return 0;
-
- X[0] = -c0/c1;
- return 1;
-}//end of _cvSolveEqu1th