根据经纬度计算速度和角度

根据经纬度计算速度和角度

    /**
     *算角度
     * @param lat_a 纬度1
     * @param lng_a 经度1
     * @param lat_b 纬度2
     * @param lng_b 经度2
     * @return
     */
    public   double getAngle( double lng_a,double lat_a, double lng_b,double lat_b ) {

        double y = Math.sin(lng_b - lng_a) * Math.cos(lat_b);
        double x = Math.cos(lat_a) * Math.sin(lat_b) - Math.sin(lat_a) * Math.cos(lat_b) * Math.cos(lng_b - lng_a);
        double brng = Math.atan2(y, x);

        brng = Math.toDegrees(brng);
        if (brng < 0)
            brng = brng + 360;
        return brng;

    }

    /**
     * 算速度
     */
    public double getSpeed( double lng_a,double lat_a, double lng_b,double lat_b) {
        double x = Math.pow((lng_b - lng_a),2);
        double y = Math.pow((lat_b - lat_a), 2);
        double speed= Math.sqrt(x+y)*111322.2222*3600/1000/1.825;
        return speed;
    }

/* ————————————————

    版权声明：本文为CSDN博主「月光日光」的原创文章，遵循CC 4.0 by-sa版权协议，转载请附上原文出处链接及本声明。
    原文链接：https://blog.csdn.net/xiaobai091220106/article/details/50879414*/