java - 三辺測量法 Android Java

Question

少し問題があります...これを実装する方法を知っている人はいますか?

次のようなJavaのメソッドが必要です。

public /*COORDINATE OBJECT*/ getTrilaterationPointBetween(
/*COORDINATE OBJECT*/ coordinate1, double distance1,
/*COORDINATE OBJECT*/ coordinate2, double distance2,
/*COORDINATE OBJECT*/ coordinate3, double distance3){

    //MAGIC

    return /*COORDINATE OBJECT*/;
}

実際には、このメソッドは 3 つの座標と、「myLocation」とそれらの 1 つとの間の距離を受け取ります...

三辺測量のアルゴリズムが必要です!!

私はいくつかの検索を行い、いくつかのテストを行いましたが、結果は私を太平洋の真ん中に駆り立てています!!

OBJECT については、非常に単純で、緯度と経度を表す 2 つの変数があります。

私はこの方法を試しました：

static double[] MyTrilateration(Ponto ponto1, double dist1,
                                    Ponto ponto2, double dist2,
                                    Ponto ponto3, double dist3) {

        double[] tmpWAP1 = new double[3];
        double[] tmpWAP2 = new double[3];
        double[] tmpWAP3 = new double[3];

        double tmpLat2, tmpLong2, tmpLat3, tmpLong3;
        double tmpSlide, deg;
        double MyLat, MyLong;

        double[] MyLocation = new double[2];

        tmpLat2  = ponto2.getX() - ponto1.getX();
        tmpLong2 = ponto2.getY() - ponto1.getY();
        tmpLat3  = ponto3.getX() - ponto1.getX();
        tmpLong3 = ponto3.getY() - ponto1.getY();

        tmpSlide = Math.sqrt(Math.pow(tmpLat2,2)+Math.pow(tmpLong2,2));

        deg = (180/Math.PI)*Math.acos( Math.abs(tmpLat2)/Math.abs(tmpSlide));

        if( (tmpLat2>0 && tmpLong2>0) ) {
            deg = 360 - deg;
        }
        else if( (tmpLat2<0 && tmpLong2>0) ) {
            deg = 180 + deg;
        }
        else if( (tmpLat2<0 && tmpLong2<0)){
            deg = 180 - deg;
        }
        else if( (tmpLat2>0 && tmpLong2<0)) {
            deg = deg;
        }

        tmpWAP1[0] = 0.0;
        tmpWAP1[1] = 0.0;
        tmpWAP1[2] = dist1;
        tmpWAP2 = myRotation(tmpLat2, tmpLong2, dist2, deg);
        tmpWAP3 = myRotation(tmpLat3, tmpLong3, dist3, deg);


        MyLat = (Math.pow(tmpWAP1[2],2)-Math.pow(tmpWAP2[2],2)+Math.pow(tmpWAP2[0],2))/(2*tmpWAP2[0]);

        MyLong = (Math.pow(tmpWAP1[2],2)-Math.pow(tmpWAP3[2],2)-Math.pow(MyLat,2)
                +Math.pow(MyLat-tmpWAP3[0],2)+Math.pow(tmpWAP3[1], 2))/(2*tmpWAP3[1]);

        MyLocation = myRotation(MyLat, MyLong, 0, -deg);

        MyLocation[0] = MyLocation[0] + ponto1.getX();
        MyLocation[1] = MyLocation[1] + ponto1.getY();

        return MyLocation;
    }

そしてこの方法：

public String getCoordinateWith(
            Ponto a, Ponto b, Ponto c,
            Float dA,
            Float dB,
            Float dC) {
        Float W, Z, x, y, y2;
        W = dA*dA - dB*dB - a.getX()*a.getX() - a.getY()*a.getY() + b.getX()*b.getX() + b.getY()*b.getY();
        Z = dB*dB - dC*dC - b.getX()*b.getX() - b.getY()*b.getY() + c.getX()*c.getX() + c.getY()*c.getY();

        x = (W*(c.getY()-b.getY()) - Z*(b.getY()-a.getY())) / (2 * ((b.getX()-a.getX())*(c.getY()-b.getY()) - (c.getX()-b.getX())*(b.getY()-a.getY())));
        y = (W - 2*x*(b.getX()-a.getX())) / (2*(b.getY()-a.getY()));
        //y2 is a second measure of y to mitigate errors
        y2 = (Z - 2*x*(c.getX()-b.getX())) / (2*(c.getY()-b.getY()));
        y = (y + y2) / 2;
        return "Position: " + x + " , " + y;
    }

ありがとうございました！