关于GPS定位较正的实现的阐明

我们在做定位车辆或其它相关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)的线的间隔。