WireRouting/include/BranchPoint.h

#include "stdafx.h"
#include "Clip.h"
#include<cmath>
#include<vector>
#include<queue>
#include<map>
#include<iostream>
#include<fstream>
#include<sstream>
using namespace std;

//��֧����������
struct BranchPoint{
	P coord; //������
	double t; // ��֧������λ�ã���0-1֮��
	double Dis; //����������֮���ľ���
	bool fixed; //λ���Ƿ��Ѿ��̶�
	Clip * pc1,*pc2;  //�洢�����ڵ���������
	BranchPoint *pb1,*pb2; //�洢�����ڵ�������֧��
	double l,r; //����t�ķ�Χ
	vector<int> branchPointsInSameSegment; //ͬһ�ֶ���������֧���ı���
	P ndir; //���ڷ�֧�ķ��߷���
	double position;	//�����ο������ľ���
	double tempt[2]; //�洢��֧�������������µ�����λ�ã�0�������ν�ͬ�γ�
	string referClip;	//�����������
	int id;	//��֧������
	int mode; //�洢��֧����һ�α�����·����������������0�������ν�ͬ�γ���1����ͬ�ν����˳�
	int bundleNodeID; //��֧�����ڵ�bundle��id
	bool used; //��֧���Ƿ���ʹ��

	void init(){
		l=0;r=1;
		pc1=pc2=NULL;
		pb1=pb2=NULL;
		t=0.5;Dis=0;
		fixed=false;
		position=0;
		id=0;
		bundleNodeID=0;
		used=0;

	}
	
	//��ʼ��
	BranchPoint(){
		init();
	}
	
	//������������ʼ��
	BranchPoint(Clip *c1,Clip *c2){
		init();
		pc1=c1;pc2=c2;
		Dis=distan1(c1->coord,c2->coord);
		double ratio=MinClipToBranchPointDistance/Dis;
		l=max(l,ratio);r=min(r,1-ratio);
		t=(l+r)/2;
		//cout<<"BranchPoint2: ratio:"<<ratio<<" l:"<<l<<" r:"<<r<<" t:"<<t<<endl;
		coord=(c1->coord)*(1-t)+(c2->coord)*t;
	}
	
	//�������ͷ�Χ��ʼ��
	BranchPoint(Clip *c1,Clip *c2,double L,double R){
		init();
		pc1=c1;pc2=c2;
		Dis=distan1(c1->coord,c2->coord);
		double ratio=MinClipToBranchPointDistance/Dis;
		l=max(L,ratio);r=min(R,1-ratio);
		t=(l+r)/2;
		cout<<"BranchPoint L+R: ratio:"<<ratio<<" l:"<<l<<" r:"<<r<<" t:"<<t<<endl;
		coord=(c1->coord)*(1-t)+(c2->coord)*t;
	}

	//�������ߵķ�֧��
	void addL(BranchPoint b){
		pb1=&b;
	}

	//�����ұߵķ�֧��
	void addR(BranchPoint b){
		pb2=&b;
	}
	
	//�����߽����ұ���d����
	void pushL(double d){
		if(d<=0)return;
		l+=d/Dis;
	}

	//���ұ߽���������d����
	void pushR(double d){
		if(d<=0)return;
		r-=d/Dis;
	}

	//�̶���֧��λ��
	void fix(){
		if(fixed==true)return;
		fixed=true;
		t=tempt[mode];
		/*
		if(pb1!=NULL){
			pb1->pushL(t*Dis+MinBranchPointDistance-r*Dis);
		}
		if(pb2!=NULL){
			pb2->pushR(l*Dis-(t*Dis-MinBranchPointDistance));
		}
		*/
		cout<<"***********";
		if(!Equal(t,l)&&!Equal(t,r))cout<<"-------";
		cout<<endl;

		referClip=pc1->name;
		position=t*Dis;
		assert(position<=Dis);
	}

	//ͨ���������򣬷�֧��Ҳ�ı�����ʾ��ʽ
	void reverse(){
		referClip=pc2->name;
		position=Dis-position;
	}


	//���ط�֧���ڷ�֧�Ͽ������ӵ�����һ����
	//offSet������֧��������ƫ��ֵ
	inline vector<int> getNext(int offSet){	
		vector<int> rc=branchPointsInSameSegment;
		for(int i=0;i<rc.size();i++)rc[i]+=offSet;
		rc.push_back(pc1->id);
		rc.push_back(pc2->id);
		return rc;
	}

	/*������֧�㵽��������Ȩֵ
		reverse=0�����ӷ�֧�㵽p
		reverse=1������p����֧��
	*/
	inline double computeWeight(P& p,int inOut,bool reverse){
		if(l>=r)return 1e9;
		
		if(fixed==false){
			double X1=pc1->coord.x,Y1=pc1->coord.y,Z1=pc1->coord.z;
			double X2=pc2->coord.x,Y2=pc2->coord.y,Z2=pc2->coord.z;

			double X0=p.x,Y0=p.y,Z0=p.z;

			double FZ=(X1-X0)*(X1-X2)+(Y1-Y0)*(Y1-Y2)+(Z1-Z0)*(Z1-Z2);
			double FM=2*Dis*Dis;

			t=FZ/FM; //��ʽ����t��Сֵ��

			t=max(t,l);t=min(t,r);
		}
		
		//if(!Equal(t,l)&&!Equal(t,r))cout<<"-------"<<endl;
		coord=pc1->coord*(1-t)+pc2->coord*t;

		coord.type=1;

		if(reverse)return distan(p,coord,inOut,0);
		return distan(coord,p,0,inOut);
		
	}

	//��¼��֧������λ��
	void recordPos(int mode){
		//if(!Equal(t,l)&&!Equal(t,r))cout<<"-------"<<endl;
		//else t=(l+r)/2;
		tempt[mode]=t;
	}

	void check(int i){
		//if(!Equal(t,l)&&!Equal(t,r))cout<<"--"<<i<<"--"<<endl;
	}

	
};

//ά�����з�֧���ļ���
struct BranchPointSet{
	BranchPoint b[MAXPointNum];	//��֧������
	int branchPointNum;	//��֧������
	
	
	BranchPointSet(){
		branchPointNum=0;
	}


	//����һ����֧��,������ָ������ָ��
	BranchPoint* addBranchPoint(Clip* pc1,Clip* pc2,int bundleNodeID){
		branchPointNum++;
		b[branchPointNum]=BranchPoint(pc1,pc2);
		b[branchPointNum].bundleNodeID=bundleNodeID;
		b[branchPointNum].id=branchPointNum;
		b[branchPointNum].coord.type=1;
		b[branchPointNum].coord.ref=branchPointNum;
		return &b[branchPointNum];
	}

	//��ȡָ������Ϊid�ķ�֧����ָ��
	BranchPoint * getBranchPointPointer(int id){
		assert(id>=1&&id<=branchPointNum);
		return &b[id];
	}

	


}branchPointSet;