JPS59148976A - 飛翔体の位置、姿勢パラメ−タ推定方式 - Google Patents

飛翔体の位置、姿勢パラメ−タ推定方式

Info

Publication number
JPS59148976A
JPS59148976A JP58022750A JP2275083A JPS59148976A JP S59148976 A JPS59148976 A JP S59148976A JP 58022750 A JP58022750 A JP 58022750A JP 2275083 A JP2275083 A JP 2275083A JP S59148976 A JPS59148976 A JP S59148976A
Authority
JP
Japan
Prior art keywords
picture
image
ground
flying object
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP58022750A
Other languages
English (en)
Inventor
Fuminobu Furumura
文伸 古村
Yoichi Seto
洋一 瀬戸
Koichi Honma
弘一 本間
Nobutake Yamagata
山縣 振武
Yutaka Kubo
裕 久保
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP58022750A priority Critical patent/JPS59148976A/ja
Publication of JPS59148976A publication Critical patent/JPS59148976A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T5/00Image enhancement or restoration
    • G06T5/80Geometric correction

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Theoretical Computer Science (AREA)
  • Image Analysis (AREA)
  • Image Processing (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔発明の利用分野〕 本発明は、人工衛星、航空機等に搭載されたセンナが地
表を撮影した画像中に含まれる形状歪の補正方式に係り
、特に補正に必要な人工衛星または航空機の位置、姿勢
を正確に推定するのに好適な推定方式に関する。
〔従来技術〕
上記形状歪の補正は従来次のように行なわれている(詳
細は例えば文献R,Bernstein 。
” Digital Image processin
g of EarthQl)servation 56
w5or [)ata”、 IBM Journalo
f Re5earch 、  Jan、  1976、
を参照のこと)。
従来法の概略は次のとおりである=第1図の1を人工衛
星、航空機等の飛翔体、2を飛翔体1に搭載されたセン
ナ、3を地表とする。地表の1点6はセンサ面4上の点
5に像を作る。このとき点6と像5の位置関係は、飛翔
体の空間における位置。
姿勢、センナ光学系のモデルおよび地表の形状モデルを
用いて幾何学計算によ請求められる。いまセンサ面4上
の受光信号をサンプリングして得た画像を観測画像、そ
の各サンプルを画素と呼ぶ。
第2図(1)は観測画像の各画素を等間隔格子点(図の
黒点)に並べたものでこれを観測画像空間と名づける。
この空間の任意の点は座標(t、p)で指定される。一
方画像の利用解析の目的に供する。
所望の画像は第2図(2)に示すごとく所定の地図投影
法に従う座標系X−Yの上で画素が等間隔格子点(図の
白点)に並んだものである。これを補正画像と名づける
。観測画像から補正画像を得るには画素の位置並べかえ
、すなわちリサンプリング処理が必要となる。これは次
のように行なう。前述の地表点と観測画像の画素位置と
を対応づける幾何学計算を用いて、補正画像空間の画素
位置(x、ylを観測画像空間の画素位置(t、p)に
写像する歪補正モデルを作る。次にこのモデルを用いて
補正画像の格子9上の各画素に対応する観測画像の格子
8上の各画素位置を算出する。この画素位置は一般に整
数格子点、すなわち格子7の黒点と一致しない。そこで
格子7の各点の画像強度から格子8の各点の画像強度を
補間する。これが補正画像における所望の格子9の各点
の強度となる。この際観測点、すなわち格子7の各点が
等間隔にあるとみなせば、補間計算は前述の文献にある
ニアレストネイバ法、パイリニア法、キュービックコン
ボリューション法等を適用できる。
以上の画像歪補正方式は、飛翔体の位置、姿勢。
センサモデルおよび地球形状モデルから成る幾何学モデ
ルを用いる。このうち飛翔体の位置、姿勢の測定データ
には測定誤差が含捷れるため、これを用いた幾何学モデ
ルに誤差が生じ、これが結果として補正画像の歪(補正
誤差)となる。そこで一般に、画像中の特徴点で地表の
位置が正確に知られた点すなわち地上標準点の情報を用
いて、飛翔体の位置、姿勢をより正確に推定することに
より画像の補正精度を高めるという方法がとられている
まず幾何学モデルは次式で与えられる。
ヱl−9(玉r t1+ pl+ tl)+シ …(1
)ここに下付き添字iは第1番目の地上標準点11、あ
るいはそれに対応する観測画像の画素12を意味する。
(t、p)は画素12の座標、tはその撮像時刻を表わ
すものとする。いま座標系13を任意に設定する。通常
は地球中心固定座標系を用いる。この座標系での地上標
準点の位置ベクトルを y=(xyz)”           ・・・ (2
)で表わす。(1)式のGは画素の座標(t、p)k地
表点に対応づけるベクトル関数である。またelは地上
標準点の位置ベクトルy1の測定誤差とベクトル関数G
の誤差の和である。また関数Gの引数であるベクトルX
は次のように与えられる、飛翔体の位置、姿勢パラメー
タである。通常飛翔体の位置ベクトルy=(xyz)”
の各座標成分X。
y、zの時刻1の多項式関数で近似することができる。
ここにNは多項式の次数で3程度である。一方姿勢角を
ロール角(θF)+ ピッチ角(ら)、ヨー角(θy)
で表わせば、これらはいずれもtの多項式関数で近似で
きる。
このときパラメータベクトルXは(3)、 (4)式の
係数によって作られるベクトルである。
””(XoX+ =・Xw’f1’!2−ywZIZ2
− ZNθrQθ1.・・・θrNθ、1θ、2・・・
θ、−7゜θア、・・・θyN)T(F5)以上の幾何
学モデルに従い、地上標準点の情報を用いて従来は次の
方法により飛翔体の位置、姿勢を精密に推定されている
(詳細は例えば文献R1H1Coron and K、
W、 Simon @t AttitL1de’pim
e−8eries Estimator for 1(
ectificationof 5pacel)orn
e Imagery”、 Journal ofSpa
cecraft 、  VOl、 12 、A I 、
 1975.  を参照のこと)。すなわちM個のGC
Pデータ(i=1、・・・、M)が与えられたとき、カ
ルマンフィルタの手法を適用してx=i推定する。この
とき(1)式はカルマンフィルタにおける観測方程式と
なるが、Xに関し非線形なのでこれを線形化近似してか
らカルマンフィルタを適用する。
以上述べた従来方式の処理フローを第3図に示す。カル
マンフィルタによる処理ステップ150入カデータ14
として、各地上標準点の位置ベクトル3’l+誤差e1
の共分散マトリックスW+。
その誤差共分散1)oを与える。パラメータの推定結果
からステップ16で歪補正モデルの作成が行なわれる。
そのモデルを用いてあらかじめ磁気テープ等に格納され
た観測画像17にステップ18でリサンプリング処理を
ほどこすことにより補正画像19を得る。
この従来方式には次の欠点があった。すなわち上述のご
とく(1)式の線形化近似を行なうため得られるXの推
定結果が最適でない。例えば誤差e1の重みマトリック
スWi  (’=t+・・・、M)に対し、評価関数 を最小にする推定値、すなわち最小2乗推定値にはなら
ない。但しeIは(1)式より eI  −yt   G(X、t+、[)++’+) 
     (7)である。
〔発明の目的〕
本発明の目的は、飛翔体に搭載されたセンサにより撮影
された画像の形状歪を精密に補正するために必要な飛翔
体の位置、姿勢パラメータを精度よく推定するのに好適
な方式を提供することにある。
〔発明の概要〕
ここで本発明で用いるパラメータ推定方式について概要
を説明しておく。まず、未知パラメータXの推定値を(
6)式の評価関数Jを最小にするものと定義し、もしX
についての先験情報Xoが正規分布の確率変数で、誤差
e1がiに関して独立の正規分布の確率変数という条件
が成立つならば、得られる推定値は、与えられた地上標
準点データに対して最尤推定値となる。通常は上記条件
が近似的に成立つと考えてよい。さて(6)式はXに関
して非線形なので、Jの最小値を与えるXは解析的には
求まらない。そこで本発明では逐次解法としてニュート
ンラフノン法を用いる点に特徴がある。
その処理フローを第4図に示す。始めにステップ20〜
22において初期値設定を行なう。ΔXは逐次計算過程
における推定値Xの修正量である。
ステップ23〜27は繰返しの各回における演算である
。ステップ24では推定値Xの修正演算をおこなう。ス
テップ25における修正量ΔXの計算の内容は次の式で
ある。
(8) 但しMは地上標数点の数、nは未知パラメータの数であ
る。ステップ26のJ (X)は(6)式によって算出
される。判定のステップ27はJの収束を判定するもの
で、εは十分小さな正の数である。
〔発明の実権例〕 以下、実施例にもとづき本発明の詳細な説明する。第5
図は本発明による画像歪の補正装置の全体構成図である
。最小2乗法にもとづくパラメータ推定装置31に対し
外部端子28から未知パラメータXの先験情報Xoとそ
の誤差共分散マトリックスpOを与える。一方面像メモ
リ33には観測画像が蓄えられているものとする。画像
ディス(9) プレイ30は観測画像の一部を画像メモリ33から読み
出して表示する。表示内容は例えば第6図のごとくなる
。スクリーン36の中に地上標準点付近の観測画像37
が表示される。オペレータはこの表示をみて画像中の地
上標準点の位置を座標入力装置29から入力する。これ
は装置31に送られる。同時に外部端子28から該地上
標準点の位置ベクトルy+  とその誤差共分散マトリ
ックスWIを入力する。この操作を与えられたM個のす
べての地上標準点について繰返す。そののちパラメータ
推定装置31は、これらの入力情報にもとづき第4図の
処理フローに従い、飛翔体の位置。
姿勢パラメータを推定する。歪補正モデル算出装置32
はこの推定パラメータ値を用いて歪補正モデルを作成す
る。そのあとリサンプリング装置34は観測画像の画素
データを画像メモリ33から順次読出し、歪補正モデル
に従ってリサンプリング処理を行ない、補正画像の画素
データを磁気テープ35に順次書き出す。リサンプリン
グ装置34は所定寸法に相当する画素数を持つ補正画像
(10) が作成されるまで以上の動作を繰り返す。
〔発明の効果〕
以上述べたごとく本発明によれば、非線形推定問題を線
形近似することなく直接数値解を求める方式を用いたこ
とにより観測画像中に数個程度選定した地上標準点の情
報から、飛翔体の位置、姿勢パラメータを精密に推定で
きるので、観測画像の形状歪を精密に補正することが可
能になるという効果がある。
【図面の簡単な説明】
第1図は飛翔体に搭載したセンサにより地表を観測する
状態を示す図、第2図は観測画像と補正画像の関係を示
す図、第3図は従来方式による歪補正処理のフローを示
す図、第4図は本発明の方式による非線形推定問題の解
法フローを示す図、第5図は本発明による画像歪補正装
置の全体構成図、第6図は該装置を構成する画像表示装
置における地上標準点の表示例を示す図である。 1・・・飛翔体、31・・・パラメータ推定装置。 代理人 弁理士 高橋明夫 (11) 第  1  図 1 η 2  図 (1ン                   (2,
)嘉 3 図 第 4 図 z f 図 1 z 第 に ロ

Claims (1)

    【特許請求の範囲】
  1. 複数個の地上標準データから飛翔体の位置、姿勢パラメ
    ータを推定し、該パラメータにもとづいて雫爵を両売画
    像歪補正モデルを作成し、該モデルを用いて観測画像を
    リサンプリングして補正画像を得る画像歪補正方式にお
    いて、上記位置、姿勢パラメータは上記地上標準データ
    から非線形最小2乗法にもとづき推定することを特徴と
    する飛翔体の位置、姿勢パラメータ推定方式。
JP58022750A 1983-02-16 1983-02-16 飛翔体の位置、姿勢パラメ−タ推定方式 Pending JPS59148976A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP58022750A JPS59148976A (ja) 1983-02-16 1983-02-16 飛翔体の位置、姿勢パラメ−タ推定方式

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP58022750A JPS59148976A (ja) 1983-02-16 1983-02-16 飛翔体の位置、姿勢パラメ−タ推定方式

Publications (1)

Publication Number Publication Date
JPS59148976A true JPS59148976A (ja) 1984-08-25

Family

ID=12091363

Family Applications (1)

Application Number Title Priority Date Filing Date
JP58022750A Pending JPS59148976A (ja) 1983-02-16 1983-02-16 飛翔体の位置、姿勢パラメ−タ推定方式

Country Status (1)

Country Link
JP (1) JPS59148976A (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6257071A (ja) * 1985-09-06 1987-03-12 Hitachi Ltd 画像歪の補正方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5466168A (en) * 1977-11-07 1979-05-28 Toshiba Corp Geometric distortion corrector of picture

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5466168A (en) * 1977-11-07 1979-05-28 Toshiba Corp Geometric distortion corrector of picture

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6257071A (ja) * 1985-09-06 1987-03-12 Hitachi Ltd 画像歪の補正方法

Similar Documents

Publication Publication Date Title
US9355453B2 (en) Three-dimensional measurement apparatus, model generation apparatus, processing method thereof, and non-transitory computer-readable storage medium
JP2786207B2 (ja) 走査型顕微鏡における表面形状算出方法
CN104897175B (zh) 多相机光学推扫卫星在轨几何定标方法及系统
US6353678B1 (en) Method and apparatus for detecting independent motion in three-dimensional scenes
Wu et al. Autonomous flight in GPS-denied environments using monocular vision and inertial sensors
Hinsken et al. Triangulation of LH systems ADS40 imagery using Orima GPS/IMU
EP1357516B1 (en) A method for correcting an image acquired by a satellite
CN112230242A (zh) 位姿估计系统和方法
Caballero et al. Homography based Kalman filter for mosaic building. applications to UAV position estimation
CN107192376B (zh) 基于帧间连续性的无人机多帧图像目标定位校正方法
US6148250A (en) Altitude detection by use of planar approximation of a region of ground surface
CN111524194A (zh) 一种激光雷达和双目视觉相互融合的定位方法及终端
JPH11252440A (ja) 画像を整列させて目標点にカメラを固定する方法及び装置
JPH08201021A (ja) キャリブレーション方法
US20030031382A1 (en) Process for the stabilization of the images of a scene correcting offsets in grey levels, detection of mobile objects and harmonization of two snapshot capturing apparatuses based on the stabilization of the images
JP4448187B2 (ja) 映像の幾何補正方法およびその装置
Hussnain et al. An automatic procedure for mobile laser scanning platform 6dof trajectory adjustment
JPH06195472A (ja) 画像処理システム
JPS59148976A (ja) 飛翔体の位置、姿勢パラメ−タ推定方式
JP4046476B2 (ja) ナビゲーション算出装置及びナビゲーション算出方法
CN114255457B (zh) 基于机载LiDAR点云辅助的同机影像直接地理定位方法及系统
Kinoshita et al. Simultaneous determination of camera pose and intrinsic parameters by visual servoing
JPS6257071A (ja) 画像歪の補正方法
JPH01312411A (ja) 画像を用いた物体位置推定方法及びセンサ状態推定方法
CN121430587B (zh) 位姿估计方法、装置、存储介质及电子设备