欢迎使用CSDN-markdown编辑器

// 计算线上两点之间的方向    private double calculateDirectionBetweenRoutePoints(double p1x, double p1y,            double p2x, double p2y) {        double dx, dy;        dx = p2x - p1x;        dy = p2y - p1y;        if (Math.abs(dx) <= 0.0001 && Math.abs(dy) <= 0.0001)            return 0;        if (Math.abs(dx) <= 0.0001) {            if (dy < 0)                return 180;            else                return 0;        }        if (Math.abs(dy) <= 0.0001) {            if (dx < 0) {                return 270;            } else                return 90;        }        // System.out.println("dx: " + dx + ", dy: " + dy);        double cta = arad(Math.atan(dx / dy));        if (dx < 0 && dy <= 0) {            cta = 180 + cta;        } else if (dy < 0) {            cta = 180 + cta;        } else if (dx < 0) {            cta = 360 + cta;        }        // System.out.println(cta);        return cta;    }    private double arad(double rad) {        return rad * 180 / Math.PI;    }    private double rad(double degree) {        return degree * Math.PI / 180;    }    // 计算线上两点之间的距离    private double calculateDistanceBetweenRoutePoints(double p1x, double p1y,            double p2x, double p2y) {        return lineSpace(p1x, p1y, p2x, p2y);    }    // 计算两点之间的距离    private double lineSpace(double x1, double y1, double x2, double y2) {        double lineLength = 0;        lineLength = Math.sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2));        return lineLength;    }