python - 2 つの座標とコーナーから 3 番目の座標を復元する

Question

私は3つの地理座標を持っています

first_coordinate = [55.266346, 25.053268]
second_coordinate = [55.266472, 25.053311]
third_coordinate = [55.266370, 25.0532]

次に、それらを EPSG:3997 に変換します。

def convert(point):
  return Point(transformer.transform(point[0], point[1]))

first_point_in_meters = convert(first_coordinate)
second_point_in_meters = convert(second_coordinate)
third_point_in_meter = convert(third_coordinate)

次に、次を使用して原点の 3 番目の座標を決定しようとします。

def calculate_third_point(Ax, Ay, Cx, Cy, b, c, A, alt):
  uACx = (Cx - Ax) / b
  uACy = (Cy - Ay) / b

  if alt:
      uABx = uACx * math.cos(A) - uACy * math.sin(A)
      uABy = uACx * math.sin(A) + uACy * math.cos(A)

      Bx = Ax + c * uABx
      By = Ay + c * uABy
  else:
      uABx = uACx * math.cos(A) + uACy * math.sin(A)
      uABy = - uACx * math.sin(A) + uACy * math.cos(A)

      Bx = Ax + c * uABx
      By = Ay + c * uABy

  return Point([Bx, By])

そして、この 2 つの座標を EPSG:4326 に変換しました。ただし、最も近い座標は原点から 2 メートル離れています

one distance: 2.6033912103159342 m.
anther distance: 19.215538365617018 m.

私が間違っていることは何ですか？

完全なコード:

import math
import numpy as np
from pyproj import Transformer

from shapely.geometry import Point

transformer_4326 = Transformer.from_crs(3997, 4326, always_xy=True)
transformer = Transformer.from_crs(4326, 3997, always_xy=True)

def calculate_third_point(Ax, Ay, Cx, Cy, b, c, A, alt):
  uACx = (Cx - Ax) / b
  uACy = (Cy - Ay) / b

  if alt:
      uABx = uACx * math.cos(A) - uACy * math.sin(A)
      uABy = uACx * math.sin(A) + uACy * math.cos(A)

      Bx = Ax + c * uABx
      By = Ay + c * uABy
  else:
      uABx = uACx * math.cos(A) + uACy * math.sin(A)
      uABy = - uACx * math.sin(A) + uACy * math.cos(A)

      Bx = Ax + c * uABx
      By = Ay + c * uABy

  return Point([Bx, By])

def find_angle(rone, rtwo, rthree):
  one = np.array(rone)
  two = np.array(rtwo)
  three = np.array(rthree)
  ba = one - two
  bc = three - two
  cosine_angle = np.dot(ba, bc) / (np.linalg.norm(ba) * np.linalg.norm(bc))
  angle = np.arccos(cosine_angle)
  return np.degrees(angle)

def convert(point):
  return Point(transformer.transform(point[0], point[1]))

first_coordinate = [55.266346, 25.053268]
second_coordinate = [55.266472, 25.053311]
third_coordinate = [55.266370, 25.0532]

first_point_in_meters = convert(first_coordinate)
second_point_in_meters = convert(second_coordinate)
third_point_in_meter = convert(third_coordinate)

angle = find_angle(third_point_in_meter, second_point_in_meters, first_point_in_meters)
distance = first_point_in_meters.distance(second_point_in_meters)
distance2 = first_point_in_meters.distance(third_point_in_meter)

one = calculate_third_point(
  first_point_in_meters.x,
  first_point_in_meters.y,
  second_point_in_meters.x,
  second_point_in_meters.y,
  distance,
  distance2,
  angle,
  True)

another = calculate_third_point(
  first_point_in_meters.x,
  first_point_in_meters.y,
  second_point_in_meters.x,
  second_point_in_meters.y,
  distance,
  distance2,
  angle,
  False)

print("one distance: {0} m.".format(one.distance(third_point_in_meter)))
print("anther distance: {0} m.".format(another.distance(third_point_in_meter)))