关于GPS定位较正的实现的解析[Java编程]

我们在做定位车辆或别的相关GPS点的时刻,由于返回得到的数据并非很精确,如车辆传上来的GPS坐标点偏离了道路很远,而实质坐标应当是在道路上的,这时刻需求做个较正,把在答应范围内的点较正到道路上.怎么实现呢?

可以先用操纵得到的GPS坐标值循环遍历得到距离道路近来的两个节点,然后通过得到的两个近来节点的坐标,操纵求垂足的办法得到垂足的坐标就是所要求的点,也就是较正后的点了.

具体的代码以下:

Java代码

　//按照线路id和点坐标,找出该线路上距离改点的近来点
　public　static　Point　getPoint(String　roadid,　double　x,　double　y)　{
　RoadlineDao　dao　=　(RoadlineDao)　DaoConfig.getDaoManager().getDao(　
　　RoadlineDao.class);
　List　list　=　dao.getPoints(roadid);

　double　distance　=　Integer.MAX_VALUE;
　Point　pt1　=　null,　pt2　=　null;
　Point　tmp_pt1,　tmp_pt2;
　double　tmp_distance;
　for　(int　i　=　1;　i　<　list.size();　i++)　{
　　tmp_pt1　=　(Point)　list.get(i　-　1);
　　tmp_pt2　=　(Point)　list.get(i);
　　tmp_distance　=　Line2D.ptSegDist(tmp_pt1.getX(),　tmp_pt1.getY(),
　　　tmp_pt2.getX(),　tmp_pt2.getY(),　x,　y);
　　if　(distance　>　tmp_distance)　{
　　distance　=　tmp_distance;
　　pt1　=　tmp_pt1;
　　pt2　=　tmp_pt2;
　　}
　}

　if　(pt1　==　null　||　pt2　==　null)
　　return　null;
　else
　　return　getLatestPoint(pt1,　pt2,　x,　y);
　}

　//点到线段的近来点
　private　static　Point　getLatestPoint(Point　pt1,　Point　pt2,　double　x,　double　y)　{
　Point　pt　=　new　Point();

　Point　pf　=　new　Point();
　if　(pt1.getX()　==　pt2.getX())　{
　　pf.setX(pt1.getX());
　　pf.setY(y);
　}　else　if　(pt1.getY()　==　pt2.getY())　{
　　pf.setX(x);
　　pf.setY(pt1.getY());
　}　else　{
　　double　k　=　(pt2.getY()　-　pt1.getY())　/　(pt2.getX()　-　pt1.getX());
　　pf.setX((k　*　k　*　pt1.getX()　+　k　*　(y　-　pt1.getY())　+　x)
　　　/　(k　*　k　+　1));
　　pf.setY(k　*　(pf.getX()　-　pt1.getX())　+　pt1.getY());
　}

　if　(Math.min(pt1.getX(),　pt2.getX())　<=　pf.getX()
　　&&　pf.getX()　<=　Math.max(pt1.getX(),　pt2.getX())
　　&&　Math.min(pt1.getY(),　pt2.getY())　<=　pf.getY()
　　&&　pf.getY()　<=　Math.max(pt1.getY(),　pt2.getY()))
　{
　　pt　=　pf;
　　double　dx　=　pt2.getX()　-　pt1.getX();
　　double　dy　=　pt2.getY()　-　pt1.getY();
　　double　dm　=　pt2.getMile()　-　pt1.getMile();
　　if　(dx　!=　0)　{
　　pt.setMile((float)　(pt1.getMile()　+　(pt.getX()　-　pt1.getX())
　　　/　dx　*　dm));
　　}　else　{
　　pt.setMile((float)　(pt1.getMile()　+　(pt.getY()　-　pt1.getY())
　　　/　dy　*　dm));
　　}
　}　else
　{
　　if　(Math.abs(pt1.getX()　-　pf.getX())　<=　Math.abs(pt2.getX()
　　　-　pf.getX())
　　　&&　Math.abs(pt1.getY()　-　pf.getY())　<=　Math.abs(pt2.getY()
　　　　-　pf.getY()))　{
　　pt　=　pt1;
　　}　else　{
　　pt　=　pt2;
　　}
　}
　return　pt;
　}

以上代码应注意的是:

1.其实经纬度转桩号也是一样的原理,通过计算终究得到道路上的Point对象.

2.这里大量用了Point类,终究求的点也是通过Point的get办法来得到的.

3.Line2D.ptSegDist(x1,y1,x2,y2,x,y)办法是得到(x,y)到两个端点(x1,y1),(x2,y2)的线的距离.