package com.hxzkoa.udp;
|
|
import java.util.List;
|
|
import org.springframework.beans.factory.annotation.Autowired;
|
|
import com.hxzkoa.json.tb_system;
|
import com.hxzkoa.util.Config;
|
import com.hxzkoa.util.HttpUtil;
|
|
import net.sf.json.JSONObject;
|
|
public class GnssToxy {
|
|
static String postUrl = Config.getPostUrl();
|
static String url_sysSetting_bw = postUrl + "sysSetting_bw.do";
|
|
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;
|
|
/**通过经纬度获取XY坐标*/
|
public static double[] utm(double lat,double lon) {
|
double[] dxy=new double[2];
|
|
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));
|
|
return dxy;
|
}
|
|
|
/**将度分格式数据转为度格式输出*/
|
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;
|
}
|
|
|
/**初始化原点位置和方向
|
* 输出原点以米为单位的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;
|
}
|
|
|
|
/**输入ublox的度分经纬度，输出xy,单位米*/
|
public static double[] ubloxraw2xy(double lat, double lon) {
|
double[] xy=new double[2];
|
double lond = ublox_dm2d(lon);
|
double latd = ublox_dm2d(lat);
|
double[] dxy = utm(latd, lond);
|
xy[0]= dxy[0]* 1000;
|
xy[1]= dxy[1]* 1000;
|
return xy;
|
|
}
|
|
/**将实时经纬度转为XY坐标输出
|
* @param lat 纬度
|
* @param lon 经度
|
* @param 原点纬度X0
|
* @param 原点经度y0*/
|
public int[] run_gps2xy(String tagid,double lat, double lon, double xzb, double yzb, double jia) {
|
|
int[] realxy=new int[2];
|
double[] xycs=initiize_ublox_zeropoint(xzb, yzb, jia);
|
|
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;
|
}
|
}
|
