mk-mode BLOG

このブログは自作の自宅サーバに構築した Debian GNU/Linux で運用しています。
PC・サーバ構築等の話題を中心に公開しております。(クローンサイト: GitHub Pages

ブログ開設日2009-01-05
サーバ連続稼働時間
Reading...
Page View 合計
Reading...
今日
Reading...
昨日
Reading...

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

[ プログラミング, 暦・カレンダー ] [ Python ]

こんばんは。

WGS84 の緯度(Beta)/経度(Lambda)/楕円体高(Height)を ECEF(Earth Centered Earth Fixed; 地球中心・地球固定直交座標系)座標に変換する処理を Python で実装してみました。

0. 前提条件

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

1. Python スクリプトの作成

  • Shebang ストリング(1行目)では、フルパスでコマンド指定している。(当方の慣習
blh2ecef.py
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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
#! /usr/local/bin/python3.6
"""
BLH -> ECEF 変換
: WGS84 の緯度(Beta)/経度(Lambda)/楕円体高(Height)を
  ECEF(Earth Centered Earth Fixed; 地球中心・地球固定直交座標系)座標に
  変換する。

  Date          Author          Version
  2018.06.28    mk-mode.com     1.00 新規作成

Copyright(C) 2018 mk-mode.com All Rights Reserved.
---
引数: LATITUDE(BETA) LONGITUDE(LAMBDA) HEIGHT
"""
import math
import sys
import traceback


class BlhToEcef:
    USAGE = "[USAGE] ./blh2ecef.py LATITUDE(BETA) LONGITUDE(LAMBDA) HEIGHT"
    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

    def __init__(self):
        """ Initialization
            : コマンドライン引数の取得
        """
        try:
            if len(sys.argv) < 4:
                print(self.USAGE)
                sys.exit(0)
            self.lat, self.lon, self.ht = \
                map(lambda x: float(x), sys.argv[1:4])
        except Exception as e:
            raise

    def exec(self):
        """ Execution """
        try:
            print((
                "BLH: LATITUDE(BETA) = {:12.8f}°\n"
                "  LONGITUDE(LAMBDA) = {:12.8f}°\n"
                "             HEIGHT = {:7.3f}m"
            ).format(self.lat, self.lon, self.ht))
            x, y, z = self.__blh2ecef(self.lat, self.lon, self.ht)
            print("--->")
            print((
                "ECEF: X = {:12.3f}m\n"
                "      Y = {:12.3f}m\n"
                "      Z = {:12.3f}m"
            ).format(x, y, z))
        except Exception as e:
            raise

    def __blh2ecef(self, lat, lon, ht):
        """ BLH -> ECEF 変換

        :param  float lat: Latitude
        :param  float lon: Longitude
        :param  float  ht: Height
        :return list ecef: ECEF Coordinate [x, y, z]
        """
        try:
            n = lambda x: self.A / \
                math.sqrt(1.0 - self.E2 * math.sin(x * self.PI_180)**2)
            x = (n(lat) + ht) \
              * math.cos(lat * self.PI_180) \
              * math.cos(lon * self.PI_180)
            y = (n(lat) + ht) \
              * math.cos(lat * self.PI_180) \
              * math.sin(lon * self.PI_180)
            z = (n(lat) * (1.0 - self.E2) + ht) \
              * math.sin(lat * self.PI_180)
            return [x, y, z]
        except Exception as e:
            raise


if __name__ == '__main__':
    try:
        obj = BlhToEcef()
        obj.exec()
    except Exception as e:
        traceback.print_exc()
        sys.exit(1)

2. Python スクリプトの実行

まず、実行権限を付与。

1
$ chmod +x blh2ecef.py

そして、コマンドライン引数に 緯度、経度、楕円体高を指定して実行する。

1
2
3
4
5
6
7
8
$ ./blh2ecef.py 38.13579617 140.91581617 41.940
BLH: LATITUDE(BETA) =  38.13579617°
  LONGITUDE(LAMBDA) = 140.91581617°
             HEIGHT =  41.940m
--->
ECEF: X = -3899086.094m
      Y =  3166914.545m
      Z =  3917336.601m

3. 参考文献


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

以上。

Comments