server/pointSmooth/ant.h.bak

#ifndef _ANT_LIST_HPP_
#define _ANT_LIST_HPP_

#include <math.h>
#include <array>
#include <deque>
#include <tuple>
#include <memory>
#include <algorithm>
#include "line.h"
#include <iostream>
#include "point.h"

NAMESPACE_POINT_BEGIN(NAMESPACE_POINT)

struct ant:point
{
	std::array<std::array<point,6>,3> m_path;//映射的天线坐标、路径坐标、夹角

	std::array<point,6>&operator[](int i)
	{
		return m_path[i];
	}

	const std::array<point,6>&operator[](int i)const
	{
		return m_path[i];
	}
};

struct site:point
{
	site(int id=-1);

	int m_id;
	bool m_path_empty;
	std::array<ant,2> m_ant;
	std::array<std::shared_ptr<line_v>,2> m_line;

/*
	const point&operator[](int ant_id)const
	{
		return m_ant[ant_id];
	}
	*/
	int line_n(int &n) const
	{
		int ret = 0;
		for(unsigned int i = 0 ; i < m_line.size();i++)
		{
			if(!m_line[i])
			{
				ret++;
				break;
			}
			else
				n = i;
		}
		return ret;
	}
	point &getlinePoint(const point &p) const
	{
		double d0 = m_line[0]->dist(p);
		double d1 = m_line[1]->dist(p);
		point p0 = m_line[0]->projection(p);
		point p1 = m_line[1]->projection(p);
		return d0==-1?p1:d1==-1?p0:d0>d1?p1:p0;
	}
	void mapping(const point &p,point &tmp) const
	{
		int n = 0;
		switch(line_n(n))
		{
		case 0:
			tmp =  getlinePoint(p);
			break;
		case 1:
			tmp =  m_line[n]->projection(p);
			break;
		case 2:
			std::cout << "++++++++++no path" <<m_id<<std::endl;
			break;
		default:
			std::cout << "++++++++++error path" <<m_id<<std::endl;
			break;
		}
	}
	
	void sort_path();
	bool is_path_empty()const
	{
		return m_path_empty;
	}

	bool have_valid_path()const
	{
		return m_ant[0].dist(m_ant[1])>0.1 && (dist(path(0))>1 || dist(path(1))>1);
	}

	std::string to_string()const
	{
		char buf[128];

		int len=sprintf(buf,"id=%d, ant=[(%.2f,%.2f),(%.2f,%.2f)],path=[(%.2f,%.2f),(%.2f,%.2f)],%d"
			,m_id
			,m_ant[0].x,m_ant[0].y
			,m_ant[1].x,m_ant[1].y
			,m_ant[0].m_path[0][1].x,m_ant[0].m_path[0][1].y
			,m_ant[0].m_path[1][1].x,m_ant[0].m_path[1][1].y
			,check_k()
		);

		return std::move(std::string(buf,len));
	}

	const point&path(int i)const
	{
		return m_ant[0].m_path[i][1];
	}

	bool check_k()const
	{
		if(is_path_empty())
			return false;

		return eq(path(0).cos_k(*this),cos_k(path(1)),0.1);
	}

	//Cannot handle a non straight line.
	point  intersection(const site&o)const
	{
		//The cover area is not a straight line, giving up
		if(!check_k() || !o.check_k())
			return point();
		//The same slope, directly back to the empty
		if(eq(cos_k(path(0)),o.cos_k(o.path(0)),0.0001))
			return point();

		auto abc1=  get_abc(path(0));
		auto abc2=o.get_abc(o.path(0));

		point pt(
				  (std::get<2>(abc1)*std::get<1>(abc2)-std::get<2>(abc2)*std::get<1>(abc1))
				 /(std::get<0>(abc2)*std::get<1>(abc1)-std::get<0>(abc1)*std::get<1>(abc2)) ,

				  (std::get<2>(abc1)*std::get<0>(abc2)-std::get<2>(abc2)*std::get<0>(abc1))
				 /(std::get<1>(abc2)*std::get<0>(abc1)-std::get<1>(abc1)*std::get<0>(abc2)) 
				);

//		printf("cp=(%lf,%lf)\n",pt.x,pt.y);

		return pt;
	}

	double dist_to_site(const site&o)const
	{
		point pt=intersection(o);
		return dist(pt)+pt.dist(o);
	}
	double  getSolPoint(const ant&a,int path,double dist) const
	{
		double real_dist = 0;
		double last_d = 0;
		double next_d = dist;
		std::for_each(a[path].begin()+3,a[path].end(),[&next_d,&dist,&real_dist,&last_d](const point & p){
			if(!p.empty() && next_d)
			{
				double dis = p.x-last_d;
				last_d = p.x;
				if(dist > p.x)
				{
					real_dist += dis*dis/(dis+p.y);
					next_d = dist-p.x;
				}
				else
				{
					real_dist += next_d*dis/(dis+p.y);
					next_d = 0;
				}
			}
			else if(next_d != dist && next_d)
			{
				real_dist += next_d;
				next_d = 0;
			}
		});
		return !real_dist?dist:real_dist;
	}

	void solving(point**o, int ant_id, double dist)const
	{
		point*r=*o;
		const ant&a=m_ant[ant_id];
		{
			if(dist<25 && dist>1.5)
			{
				dist=sqrt(dist*dist-1.5*1.5);
			}
		}
		double rd = getSolPoint(a,0,dist);
		*r++=point(a[0][0].x+rd*a[0][2].x, a[0][0].y+rd*a[0][2].y); //11
		rd = getSolPoint(a,1,dist);
		*r++=point(a[1][0].x+rd*a[1][2].x, a[1][0].y+rd*a[1][2].y); //22

		*o=r;
	}
};

struct sit_list
{
	std::array<site,1000> m_list;
public:
	sit_list();

	void load(const char*ant_file,const char*path_file)
	{
		read_sit_list(ant_file);
		read_ant_path(path_file);
	}

	std::string to_string()const
	{
		std::string rt;
		rt.reserve(4096);
		for(auto s:m_list)
		{
			if(s.m_id==-1)
				continue;

			rt+=s.to_string();
			rt+="\n";
		}

		return std::move(rt);
	}

	void read_sit_list(const char*fname);
	void read_ant_path(const char*fname);
	void init_sit_list(int32_t readerid,int32_t antid, double ax, double ay);
	void init_sit_list();
	void init_ant_path(int32_t readerid,int32_t antid, double ax, double ay);
	void init_ant_path();
	const site& operator[](int id) const;
};

NAMESPACE_POINT_END(NAMESPACE_POINT)
#endif