Ruby - ECEF 座標 -> WGS84 (BLH) 座標 変換!

更新日時:


先日、 WGS84(World Geodetic System 1984) 測地系の緯度(Beta)/経度(Lambda)/楕円体高(Height)を ECEF(Earth Centered Earth Fixed; 地球中心・地球固定直交座標系)座標に変換する方法を Ruby で実装しました。

今回は、逆に、 ECEF 座標を WGS84 の緯度(Beta)/経度(Lambda)/楕円体高(Height)に変換する方法を Ruby で実装してみました。

過去には Python で実装しています。

0. 前提条件

  • Ruby 2.6.3 での動作を想定。
  • ここでは、 WGS84(World Geodetic System 1984) 測地系や ECEF(Earth Centered Earth Fixed; 地球中心・地球固定直交座標系)の詳細についての説明はしない。

1. Ruby スクリプトの作成

  • Shebang ストリング(1行目)では、フルパスでコマンド指定している。(当方の慣習

File: ecef2blh.rb

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
#! /usr/local/bin/ruby
#---------------------------------------------------------------------------------
# ECEF -> BLH 変換
# : ECEF(Earth Centered Earth Fixed; 地球中心・地球固定直交座標系)座標を
#   WGS84 の緯度(Latitude)/経度(Longitude)/楕円体高(Height)に変換する。
#
# Date          Author          Version
# 2019.02.19    mk-mode.com     1.00 新規作成
#
# Copyright(C) 2019 mk-mode.com All Rights Reserved.
#---------------------------------------------------------------------------------
#
class ConvEcef2Blh
  USAGE = "[USAGE] ./ecef2blh.rb X Y Z"
  PI_180 = Math::PI / 180.0
  # WGS84 座標パラメータ
  A      = 6378137.0                # a(地球楕円体長半径(赤道面平均半径))
  ONE_F  = 298.257223563            # 1 / f(地球楕円体扁平率=(a - b) / a)
  B      = A * (1.0 - 1.0 / ONE_F)  # b(地球楕円体短半径)
  E2     = (1.0 / ONE_F) * (2 - (1.0 / ONE_F))
                                    # e^2 = 2 * f - f * f
                                    #     = (a^2 - b^2) / a^2
  ED2    = E2 * A * A / (B * B)     # e'^2= (a^2 - b^2) / b^2

  # Initialization
  # * コマンドライン引数の取得
  def initialize
    if ARGV.size < 3
      puts USAGE
      exit
    end
    @ecef = ARGV[0, 3].map(&:to_f)
  end

  # Execution
  def exec
    puts "ECEF: X = %12.3fm" % @ecef[0]
    puts "      Y = %12.3fm" % @ecef[1]
    puts "      Z = %12.3fm" % @ecef[2]
    blh = ecef2blh(@ecef)
    puts "--->"
    puts "BLH: LATITUDE(BETA) = %12.8f°" % blh[0]
    puts "  LONGITUDE(LAMBDA) = %12.8f°" % blh[1]
    puts "             HEIGHT = %12.3fm"  % blh[2]
  rescue => e
    msg = "[#{e.class}] #{e.message}\n"
    e.backtrace.each { |tr| msg << "\t#{tr}\n" }
    $stderr.puts msg
    exit 1
  end

  private

  # ECEF -> BLH  変換
  #
  # @param ecef: ECEF 座標 [x, y, z]
  # @return blh: BLH  座標 [latitude, longitude, height]
  def ecef2blh(ecef)
    x, y, z = ecef
    n = lambda do |x|
      s = Math.sin(x * PI_180)
      A / Math.sqrt(1.0 - E2 * s * s)
    end
    p = Math.sqrt(x * x + y * y)
    theta = Math.atan2(z * A, p * B) / PI_180
    lat = Math.atan2(
      z + ED2 * B * Math.sin(theta * PI_180)**3,
      p - E2  * A * Math.cos(theta * PI_180)**3
    ) / PI_180
    lon = Math.atan2(y, x) / PI_180
    ht = (p / Math.cos(lat * PI_180)) - n.call(lat)
    return [lat, lon, ht]
  rescue => e
    raise
  end
end

ConvEcef2Blh.new.exec if __FILE__ == $0

2. Ruby スクリプトの実行

まず、実行権限を付与。

$ chmod +x ecef2blh.rb

そして、コマンドライン引数に ECEF 座標 X, Y, Z を指定して実行する。

$ ./ecef2blh.rb -3899086.094 3166914.545 3917336.601
ECEF: X = -3899086.094m
      Y =  3166914.545m
      Z =  3917336.601m
--->
BLH: LATITUDE(BETA) =  38.13579617°
  LONGITUDE(LAMBDA) = 140.91581617°
             HEIGHT =       41.940m

3. 参考文献


人工衛星の正確な軌道計算等に利用できるでしょう。

以上。

 

Sponsored Link

 

コメントする