package com.hxzkappboot.util;
import java.text.DecimalFormat;


import static java.util.Locale.US;


public class GnssToXY {

	static 	double a=6378.137;//地球半径
	static 	double e=0.0818192;//地球曲率
	static 	double k0=0.9996; 
	static double e2=e*e;//e的平方
	static double e4=e2*e2;//e的4次方
	static double e6=e4*e2;//e的6次方
	static double E0=500;
	static double N0=0; 
	//	static String floor="0";
	static  double lat_a =0;//原点的纬度	
	static  double lon_a =0;//原点的经度
	static double lon_b=0;//B点经度		
	static double lat_b=0;//B点纬度	
	static double xa=0;	//A点X坐标
	static double ya=0;//A点Y坐标	
	static double xb=0;//B点X坐标
	static double yb=0;//B点Y坐标
	static int k=0;	
	static int sizes=2;
	//	static double[] xycs=null;	
	//	static double utme0; 
	//	static double utmn0; 
	//	static double c; 
	//	static double s;
	//	static double t;
	//	static double f;
	static DecimalFormat df = new DecimalFormat("0.0000000");
	static int baoxu=1;

	static {
		//Map_Dell.get_foor_xycs();
		//		String ya1=Map_Dell.getAjwxy();
		//		String yb1=Map_Dell.getBjwxy();
		//		if(ya1 !=null && yb1 !=null) {
		//			String[] A=ya1.split(";");
		//			String[] B=yb1.split(";");
		//			lon_a=Double.parseDouble(A[0]);//经度
		//			lat_a=Double.parseDouble(A[1]);//纬度
		//			sizes=A.length;
		//			if(A.length==4) {
		//				xa=Double.parseDouble(A[2]);
		//				ya=Double.parseDouble(A[3]);
		//			}else if(A.length==2){
		//				xa=0;
		//				ya=0;
		//			}
		//
		//			if(B.length==4) {
		//				lon_b=Double.parseDouble(B[0]);//经度
		//				lat_b=Double.parseDouble(B[1]);//纬度
		//				xb=Double.parseDouble(B[2]);
		//				yb=Double.parseDouble(B[3]);			
		//				xycs=initiize_ublox_AB(lat_a, lon_a,lat_b, lon_b,xb,yb);
		//				if(sizes==4) {
		//					xycs=initiize_ublox_AB2(lat_a, lon_a,lat_b, lon_b,xa,ya,xb,yb);
		//					utme0=xycs[0];
		//					utmn0=xycs[1];
		//					c=xycs[2];
		//					s=xycs[3];
		//					t=xycs[4];
		//					f=xycs[5];
		//				}
		//
		//			}else {
		//				ShowMessage.zidingyi_24("B点经纬度正确");
		//			}
		//		}else {
		//			ShowMessage.zidingyi_24("tb_mab字段baoliu1和boaliu2不能为null");
		//		}
		//
	}


	/**通过经纬度获取XY坐标*/
	public static double[] utm(double lat,double lon) {
		double[] dxy=new double[3];

		double zonenum1=lon/6;		
		//floor是地板的意思，表示向下取整
		if(zonenum1>0) {
			zonenum1=Math.floor(zonenum1);
		}else {//向上取整
			zonenum1=Math.ceil(zonenum1);//向上取整
		}

		double Zonenum=zonenum1+31;

		double lambda0=((Zonenum-1)*6-180+3)*(Math.PI)/180;

		double phi=lat*(Math.PI)/180;

		double lambda=lon*(Math.PI)/180;

		double v=1/Math.sqrt((1-e2*Math.pow(Math.sin(phi),2)));

		double A=(lambda-lambda0)* Math.cos(phi); 
		double A2=A*A;
		double A3=A2*A;
		double A4=A3*A;
		double A5=A4*A; 
		double A6=A5*A; 

		double T=Math.tan(phi)* Math.tan(phi); 
		double T2=T*T;

		double C=e2* Math.cos(phi)* Math.cos(phi)/(1-e2); 
		double C2=C*C; 

		double s=(1-e2/4-3*e4/64-5*e6/256)* phi-
				(3*e2/8+3*e4/32+45*e6/1024)* Math.sin(2*phi)+
				(15*e4/256+45*e6/1024)* Math.sin(4* phi)-35*e6/3072* Math.sin(6*phi); 

		dxy[0]=E0+k0*a*v*(A+(1-T+C)*A3/6+(5-18*T+T2)*A5/120); 

		dxy[1]=N0+k0*a*(s+v* Math.tan(phi)*(A2/2+(5-T+9*C+4*C2)*A4/24+(61-58*T+T2)*A6/720));
		dxy[2]=Zonenum;
		return dxy;		
	}


	/**
	 * 将度分格式数据转为度格式输出
	 * @param ddmm_dot_m 度分格式经纬度数据
	 * @return 度格式数据
	 */
	public static double ublox_dm2d(double ddmm_dot_m) {
		double d0=Math.floor(ddmm_dot_m/100);//取整
		double d=d0+(ddmm_dot_m-d0*100)/60;
		return d;
	}



	/**将度分格式数据转为度格式输出*/
	public static String ublox_dm2dstr(double ddmm_dot_m) {
		double d0=Math.floor(ddmm_dot_m/100);
		double d=d0+(ddmm_dot_m-d0*100)/60;
		String a=df.format(d);
		return a;
	}

	/**初始化原点位置和方向
	 * 输出原点以米为单位的xy坐标, cos值, sin值*/
	public static double[] initiize_ublox_zeropoint(double lat, double lon, double th){
		double[] xycs=new double[4];
		xycs[0]=ubloxraw2xy(lat,lon)[0];
		xycs[1]=ubloxraw2xy(lat,lon)[1];
		double th1=th*Math.PI/180;//x轴与正北方向夹角th(单位是度)
		xycs[2]=Math.cos(th1);
		xycs[3]=Math.sin(th1);		
		return xycs;
	}

	public static double[] initiize_ublox_AB(
			double lat0, 
			double lon0, 
			double latB, 
			double lonB, 
			double xB, 
			double yB){
		double[] xycstf=new double[6];
		double[] a = ubloxraw2xy(lat0, lon0);
		double[] b = ubloxraw2xy(latB, lonB);

		double[] ab=new double[2];
		ab[0] = b[0] - a[0];
		ab[1] = b[1] - a[1];

		double the=Math.atan2(ab[0], ab[1]);
		double thp=Math.atan2(yB, xB);

		double th=the-thp;

		double c=Math.cos(th);
		double s=Math.sin(th);
		double th_deg=th*180/Math.PI;

		xycstf[0]=a[0];
		xycstf[1]=a[1];
		xycstf[2]=c;
		xycstf[3]=s;
		xycstf[4]=th_deg;
		xycstf[5]=a[2];

		return xycstf;
	}

	public static double[] initiize_ublox_AB2(
			double lat0, 
			double lon0, 
			double latB, 
			double lonB, 
			double xA1, 
			double yA1,
			double xB1, 
			double yB1){
		double  xA=xA1/100;
		double  yA=yA1/100;
		double  xB=xB1/100;
		double  yB=yB1/100;

		double[] xycstf=new double[6];
		double[] a = ubloxraw2xy(lat0, lon0);
		double[] b = ubloxraw2xy(latB, lonB);

		double[] ab=new double[2];
		ab[0] = b[0] - a[0];
		ab[1] = b[1] - a[1];


		double[] AB=new double[2];
		AB[0] = xB -xA;
		AB[1] = yB- yA;

		double the=Math.atan2(ab[0], ab[1]);
		double thp=Math.atan2(AB[1], AB[0]);

		double th=the-thp;

		double c=Math.cos(th);
		double s=Math.sin(th);
		double th_deg=th*180/Math.PI;

		double xap= c*yA + s*xA;
		double yap=-s*yA + c*xA;

		xycstf[0]=a[0]-xap;
		xycstf[1]=a[1]-yap;
		xycstf[2]=c;
		xycstf[3]=s;
		xycstf[4]=th_deg;
		xycstf[5]=a[2];

		return xycstf;
	}




	/**输入ublox的度分经纬度，输出xy,单位米*/
	public static double[] ubloxraw2xy(double lat, double lon) {
		double[] xy=new double[3];
		double[] dxy = utm(lat, lon);
		xy[0]= dxy[0]* 1000;
		xy[1]= dxy[1]* 1000;
		xy[2]= dxy[2];
		return xy;

	}






	public static double stringToDouble(String a){
		double b = Double.valueOf(a);
		DecimalFormat df = new DecimalFormat("#.0");//此为保留1位小数，若想保留2位小数，则填写#.00 ，以此类推
		String temp = df.format(b);
		b = Double.valueOf(temp);
		return b;
	}



	/**
	 * 经纬度转XY坐标
	 * @param A A[0]经度，A[1]纬度，A[2]x，A[3]y
	 * @param B B[0]经度，B[1]纬度，B[2]x，B[3]y
	 * @param jd1 经度
	 * @param wd1 维度
	 * @return
	 */
	public static int[] gps_xy(
			String[] A,
			String[] B,
			String jd1,
			String wd1) {


		double lon_a1=Double.parseDouble(A[0]);//经度
		double lat_a1=Double.parseDouble(A[1]);//纬度
		double xa1=0;
		double ya1=0;
		int size2=A.length;
		if(size2==4) {
			xa1=Double.parseDouble(A[2]);
			ya1=Double.parseDouble(A[3]);
		}

		double lon_b1=Double.parseDouble(B[0]);//经度
		double lat_b1=Double.parseDouble(B[1]);//纬度
		double xb1=Double.parseDouble(B[2]);
		double yb1=Double.parseDouble(B[3]);



		double lat=Double.parseDouble(wd1);
		double lon=Double.parseDouble(jd1);

		int[] realxy=new int[2];
		double[] xycs=initiize_ublox_AB(lat_a1, lon_a1,lat_b1, lon_b1,xb1,yb1);
		if(size2==4) {
			xycs=initiize_ublox_AB2(lat_a1, lon_a1,lat_b1, lon_b1,xa1,ya1,xb1,yb1);
		}

		double x0=xycs[0];
		double y0=xycs[1];
		double c=xycs[2];
		double s=xycs[3];

		double[] xy=new double[2];
		double x= ubloxraw2xy(lat,lon)[0]-x0;
		double y=ubloxraw2xy(lat,lon)[1]-y0;
		xy[0] =c*x - s*y;
		xy[1] =s*x + c*y;

		double x1=xy[1]*100;
		double y1=xy[0]*100;

		realxy[0]=(int)x1;
		realxy[1]=(int)y1;
		return realxy;

	}

	/**计算2个经纬度之间的距离*/
	public static int distance(String jd0,String wd0,String jd1,String wd1) {
		int dis=0;
		double lat_x0 =Double.parseDouble(wd0);
		//原点的经度
		double lon_y0 =Double.parseDouble(jd0);

		if (jd1==null||wd1==null){

			return 999999999;
		}
		double lat=Double.parseDouble(wd1);
		double lon=Double.parseDouble(jd1);
		double[] xycs=initiize_ublox_zeropoint(lat_x0, lon_y0,0);

		double x0=xycs[0];
		double y0=xycs[1];
		double c=xycs[2];
		double s=xycs[3];

		double[] xy=new double[2];
		double x= ubloxraw2xy(lat,lon)[0]-x0;
		double y=ubloxraw2xy(lat,lon)[1]-y0;
		xy[0] =c*x - s*y;
		xy[1] =s*x + c*y;

		double disd=Math.sqrt(xy[0]*xy[0]+xy[1]*xy[1])*100;
		dis=(int)disd;		
		return dis;
	}
	


	/**计算2个经纬度之间的距离*/
	public static int distance2(double lon_y0,double lat_x0,double lon,double lat) {
		int dis=0;
		double[] xycs=initiize_ublox_zeropoint(lat_x0, lon_y0,0);

		double x0=xycs[0];
		double y0=xycs[1];
		double c=xycs[2];
		double s=xycs[3];

		double[] xy=new double[2];
		double x= ubloxraw2xy(lat,lon)[0]-x0;
		double y=ubloxraw2xy(lat,lon)[1]-y0;
		xy[0] =c*x - s*y;
		xy[1] =s*x + c*y;

		double disd=Math.sqrt(xy[0]*xy[0]+xy[1]*xy[1])*100;
		dis=(int)disd;		
		return dis;
	}


	/**URT模式下经纬度转XY*/

	public static int[] run_gps2xyurt(
			double lat0,
			double lon0,
			double lat,
			double lon) {
		int[] realxy=new int[2];
		double[] xycs=initiize_ublox_zeropoint(lat0, lon0,0);
		double x0=xycs[0];
		double y0=xycs[1];
		double c=xycs[2];
		double s=xycs[3];

		double[] xy=new double[2];
		double x= ubloxraw2xy(lat,lon)[0]-x0;
		double y=ubloxraw2xy(lat,lon)[1]-y0;
		xy[0] =c*x - s*y;
		xy[1] =s*x + c*y;

		double x1=xy[1]*100;
		double y1=xy[0]*100;

		realxy[0]=(int)x1;
		realxy[1]=(int)y1;
		return realxy;   
	}



	/**计算2个经纬度的距离*/
	public static double disab(String jwd) {		
		String[] bb=jwd.split(";");
		double jd0=Double.parseDouble(bb[1]);
		double wd0=Double.parseDouble(bb[0]);
		double jd1=Double.parseDouble(bb[3]);
		double wd1=Double.parseDouble(bb[2]);		
		int[] a=run_gps2xyurt(wd0,jd0,wd1,jd1);
		double disa=a[0]*a[0]+a[1]*a[1];
		double dis=Math.sqrt(disa);
//		System.out.println(jwd+"的距离是："+dis);
		return dis;

	}

	/**将度分秒格式转为度格式*/
	public static String todufen(String Du,String Fen,String Miao){
		Float strDu = Float.valueOf(Du);
		Float strFen = Float.valueOf(Fen) / 60;
		Float strMiao = Float.valueOf(Miao) / 60;
		Float dufenmiao = strDu+strFen+strMiao;
		String format = String .format(US,"%.6f", dufenmiao);
		return format;
	}

	

	/**变电站模式下经纬度转XY，绘制围栏第一个点做为坐标原点
	 *String weidu经度
	 *String jingdu,
	 *String gps_state 经度状态*/


	/**变电站模式下确定原点经纬度
	 * gao 围栏开始绘制时候的高度*/


	public static double getLat_a() {
		return lat_a;
	}


	public static void setLat_a(double lat_a) {
		GnssToXY.lat_a = lat_a;
	}


	public static double getLon_a() {
		return lon_a;
	}


	public static void setLon_a(double lon_a) {
		GnssToXY.lon_a = lon_a;
	}


	public static double getLon_b() {
		return lon_b;
	}


	public static void setLon_b(double lon_b) {
		GnssToXY.lon_b = lon_b;
	}


	public static double getLat_b() {
		return lat_b;
	}


	public static void setLat_b(double lat_b) {
		GnssToXY.lat_b = lat_b;
	}


	public static double getXa() {
		return xa;
	}


	public static void setXa(double xa) {
		GnssToXY.xa = xa;
	}


	public static double getYa() {
		return ya;
	}


	public static void setYa(double ya) {
		GnssToXY.ya = ya;
	}


	public static double getXb() {
		return xb;
	}


	public static void setXb(double xb) {
		GnssToXY.xb = xb;
	}


	public static double getYb() {
		return yb;
	}


	public static void setYb(double yb) {
		GnssToXY.yb = yb;
	}


	//	public static double getUtme0() {
	//		return utme0;
	//	}
	//
	//
	//	public static double getC() {
	//		return c;
	//	}
	//
	//
	//	public static double getS() {
	//		return s;
	//	}
	//
	//
	//	public static double getT() {
	//		return t;
	//	}
	//
	//
	//	public static double getF() {
	//		return f;
	//	}
	//
	//
	//	public static double getUtmn0() {
	//		return utmn0;
	//	}



}