JP2001235533A - Method and device for detecting three-dimensional position and three-dimensional angle of moving body - Google Patents
Method and device for detecting three-dimensional position and three-dimensional angle of moving bodyInfo
- Publication number
- JP2001235533A JP2001235533A JP2000044824A JP2000044824A JP2001235533A JP 2001235533 A JP2001235533 A JP 2001235533A JP 2000044824 A JP2000044824 A JP 2000044824A JP 2000044824 A JP2000044824 A JP 2000044824A JP 2001235533 A JP2001235533 A JP 2001235533A
- Authority
- JP
- Japan
- Prior art keywords
- dimensional position
- dimensional
- coordinate system
- radio wave
- moving body
- 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
Links
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Aerials With Secondary Devices (AREA)
- Variable-Direction Aerials And Aerial Arrays (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は、車輌等移動体の3
次元位置及びその地点における移動体の3次元角度を検
出する方法、及びその方法で使用する検出装置に関す
る。[0001] The present invention relates to a moving object such as a vehicle.
The present invention relates to a method for detecting a three-dimensional position of a moving object at a three-dimensional position and a point thereof, and a detection device used in the method.
【0002】[0002]
【従来の技術】無人で田畑を耕耘したり、造成地の盛土
を転圧するなど車輌の自律走行・自動作業を行う場合、
移動体用GPS受信機を車輌等の移動体に搭載し、複数
の電波発信機器、例えばGPS衛星から送信される電波
を受信することによって、移動体の絶対座標系(地球中
心を原点とし、地球に固定した直交3軸を座標軸とする
直交座標系)における3次元位置を検出し、その位置情
報をもとに移動体の走行を制御する技術が知られてい
る。しかしながら、移動体の位置情報だけでは移動体が
どちらの方向を向いているかが分からないために、予め
指定されたコースの方向も分からないという不具合を免
れない。ゆえに上記位置情報に加えて、その地点におけ
る移動体の姿勢、つまり方位角や仰角,傾斜角等の角度
情報が必要である。なお、以下では移動体の方位角など
1つの角度を1次元角度とし、これに仰角などを加えた
2つの角度を2次元角度、さらに傾斜角などを加えた3
つの角度を3次元角度とする。2. Description of the Related Art Autonomous running and automatic work of vehicles such as uncultivated tilling of fields and compaction of embankment on lands,
A GPS receiver for a mobile object is mounted on a mobile object such as a vehicle and receives radio waves transmitted from a plurality of radio wave transmitting devices, for example, GPS satellites. There is known a technique of detecting a three-dimensional position in an orthogonal coordinate system having three orthogonal axes fixed to a coordinate system (i.e., a coordinate axis) and controlling the traveling of a moving body based on the position information. However, since it is not possible to know which direction the moving body is facing only from the position information of the moving body, it is inevitable that the direction of the course specified in advance is not known. Therefore, in addition to the position information, the posture of the moving body at that point, that is, angle information such as an azimuth angle, an elevation angle, and an inclination angle is required. In the following, one angle such as the azimuth of the moving object is defined as a one-dimensional angle, and two angles obtained by adding an elevation angle to the two-dimensional angle are added to a two-dimensional angle.
The three angles are three-dimensional angles.
【0003】上記移動体の位置情報及び角度情報を特定
する従来の技術として、特開平11−231038号公
報に記載のものが知られている。これは、無指向性アン
テナと指向性アンテナとを組み合わせ、無指向性アンテ
ナにてGPS測位を行って移動体の位置を特定し、次い
で、移動体の位置と特定のGPS衛星(衛星Sとする)
の位置とを比較することによって、移動体から見た衛星
Sの絶対方位角を算出するとともに、方位角方向に指向
性を有する指向性アンテナにて衛星Sから送信される電
波を受信し、その強弱を測定することによって、移動体
から見た衛星Sの相対方位角を検出し、これら絶対方位
角と相対方位角とから、移動体の絶対座標系における方
位角、つまり移動体の向きを算出している。[0003] As a conventional technique for specifying the position information and the angle information of the moving body, there is known a technique disclosed in Japanese Patent Application Laid-Open No. H11-231038. This involves combining an omni-directional antenna and a directional antenna, performing GPS positioning with the omni-directional antenna to specify the position of the mobile object, and then specifying the position of the mobile object and a specific GPS satellite (satellite S). )
By calculating the absolute azimuth of the satellite S viewed from the moving object by comparing with the position of the mobile object, the radio wave transmitted from the satellite S is received by the directional antenna having directivity in the azimuth direction, and the By measuring the strength, the relative azimuth of the satellite S viewed from the mobile is detected, and the azimuth of the mobile in the absolute coordinate system, that is, the direction of the mobile, is calculated from the absolute azimuth and the relative azimuth. are doing.
【0004】しかしながら上記特開平11−23103
8号公報に記載の技術によれば、検出される移動体の角
度情報は、方位角情報のみ、つまり1次元角度であっ
て、その他ピッチ角・ロール角など2次元,3次元角度
を検出するものではない。このため、急斜面や起伏の激
しい路面を走行する場合には測定誤差が大きくなること
がある。これについて、移動体における衛星の上記相対
方位角の測定誤差について図5をもとに説明する。特定
方向として移動体Cの進行方向(X軸)を選択すれば、
移動体Cが水平に保たれた同図aに示す状態における上
記相対方位角は、衛星SのX−Y平面への投影Pと移動
体の中心Oとを結ぶ直線OPとX軸との角αとなるが、
同じ地点で移動体Cがβだけ傾斜すれば、上記相対方位
角は同図bに示す如く、衛星SのX−Y′平面への投影
P′と移動体の中心Oとを結ぶ直線OP′とX軸との角
α′と検出されることになり、誤差(α′−α)が生じ
る。ゆえに、より正確な角度情報を得るためには、上記
相対方位角の他に仰角などを追加した2次元角度、さら
に傾斜角などを追加した3次元角度を検出する必要があ
る。However, Japanese Patent Application Laid-Open No.
According to the technology described in Japanese Patent Application Laid-Open No. 8 (1999) -1995, the detected angle information of the moving body is only azimuth angle information, that is, a one-dimensional angle, and detects two-dimensional and three-dimensional angles such as a pitch angle and a roll angle. Not something. Therefore, when traveling on a steep slope or a rugged road surface, a measurement error may increase. This will be described with reference to FIG. 5 regarding the measurement error of the relative azimuth of the satellite in the moving object. If the traveling direction (X axis) of the moving object C is selected as the specific direction,
The relative azimuth angle in the state shown in FIG. 7A in which the moving body C is kept horizontal is the angle between the straight line OP connecting the projection P of the satellite S onto the XY plane and the center O of the moving body and the X axis. α
If the moving object C is inclined by β at the same point, the relative azimuth angle becomes a straight line OP ′ connecting the projection P ′ of the satellite S on the XY ′ plane and the center O of the moving object as shown in FIG. And an angle α ′ between the angle and the X axis, and an error (α′−α) occurs. Therefore, in order to obtain more accurate angle information, it is necessary to detect a two-dimensional angle obtained by adding an elevation angle and the like in addition to the relative azimuth angle, and a three-dimensional angle obtained by adding a tilt angle and the like.
【0005】上記2次元あるいは3次元角度を検出する
手段として、移動体の異なる2点あるいは3点にGPS
受信機を設置して測位し、その位置情報から移動体の2
次元角度あるいは3次元角度を算出する方法が知られて
いる。ただし、このような複数のGPS受信機の位置情
報から移動体の角度情報を検出する方法では、各GPS
受信機の位置を数cmオーダーの測位精度で特定する必
要がある。なぜならば、移動体に設置するGPS受信機
の設置間隔はせいぜい数mであり、それらの測位誤差が
数十cmもあると角度情報に含まれる誤差が大きすぎ、
実用性を失うからである。このため、特定位置に設けら
れた基準局にて同様なGPS測位を行い、そのデータを
移動体に送信して移動体の測位データを補正することに
よって、誤差数cmオーダーの測位精度を確保してい
る。しかしこの場合、1機例えば数百万円のGPS受信
機が3機乃至4機必要であるばかりでなく、基準局と、
基準局で得られた補正データを移動体に送信するための
データ送信設備も必要となり、システム費用が非常に高
価なものとなる。[0005] As means for detecting the two-dimensional or three-dimensional angle, a GPS is provided at two or three different points of the moving body.
A receiver is installed and positioning is performed.
Methods for calculating a three-dimensional angle or a three-dimensional angle are known. However, in such a method of detecting the angle information of the moving object from the position information of the plurality of GPS receivers, each GPS
It is necessary to specify the position of the receiver with positioning accuracy on the order of several cm. Because, the installation interval of the GPS receivers installed on the moving object is at most several meters, and if the positioning error is several tens cm, the error included in the angle information is too large,
This is because practicality is lost. For this reason, the same GPS positioning is performed at the reference station provided at the specific position, and the data is transmitted to the mobile unit to correct the positioning data of the mobile unit, thereby ensuring the positioning accuracy of the order of a few cm error. I have. In this case, however, not only three or four GPS receivers of, for example, several million yen are required, but also a reference station and
Data transmission equipment for transmitting the correction data obtained by the reference station to the mobile unit is also required, and the system cost becomes very high.
【0006】そこで、移動体の2次元角度をGPS受信
機1機で検出する特許第2916625号に記載の技術
が提案されている。これは、移動体上を摺動移動可能な
GPS受信機を移動体の前部及び後部にて測位し、それ
らの位置情報から移動体の2次元角度を算出するもので
ある。しかしながら、この技術によれば移動体が停止し
ている時しか2次元角度を検出することができず、しか
も検出に時間がかかるという難点を有する。Therefore, a technique disclosed in Japanese Patent No. 2916625 in which a two-dimensional angle of a moving object is detected by one GPS receiver has been proposed. In this method, a GPS receiver slidable on a moving body is positioned at a front portion and a rear portion of the moving body, and a two-dimensional angle of the moving body is calculated from the position information. However, according to this technique, the two-dimensional angle can be detected only when the moving body is stopped, and there is a disadvantage that the detection takes time.
【0007】[0007]
【発明が解決しようとする課題】本発明は上記の問題点
に鑑み、移動体の3次元位置に加えて、その地点におけ
る3次元角度を、安価にかつリアルタイムに検出可能な
検出方法及び検出装置を提供することを目的とする。SUMMARY OF THE INVENTION In view of the above problems, the present invention provides a detection method and a detection apparatus capable of detecting a three-dimensional angle at a point in addition to a three-dimensional position of a moving body at low cost in real time. The purpose is to provide.
【0008】[0008]
【課題を解決するための手段】上記の目的を達成するた
めの請求項1に記載の発明は、地球中心を原点とする絶
対座標系における3次元位置が既知である、少なくとも
3個の電波発信機器から送信される電波を受信すること
により、移動体の3次元位置及び3次元角度を検出する
検出方法であって、前記移動体と前記各電波発信機器と
の距離、及び移動体における前記各電波発信機器から送
信される電波の入射方向を検出し、前記距離及び電波の
入射方向をもとに、移動体を原点とする相対座標系にお
ける各電波発信機器の3次元位置を算出した後、各電波
発信機器の前記絶対座標系における3次元位置情報と前
記相対座標系における3次元位置情報とから、移動体の
絶対座標系での3次元位置、及び移動体の向きを算出す
る方法にある。According to a first aspect of the present invention, there is provided an apparatus for transmitting at least three radio waves having a known three-dimensional position in an absolute coordinate system having an origin at the center of the earth. A method for detecting a three-dimensional position and a three-dimensional angle of a moving body by receiving a radio wave transmitted from a device, wherein the distance between the moving body and each of the radio wave transmitting devices, and each of the distances in the moving body. After detecting the incident direction of the radio wave transmitted from the radio wave transmitting device, based on the distance and the incident direction of the radio wave, after calculating the three-dimensional position of each radio wave transmitting device in the relative coordinate system with the moving body as the origin, A method of calculating a three-dimensional position of a moving body in an absolute coordinate system and a direction of the moving body from three-dimensional position information of each radio wave transmitting device in the absolute coordinate system and three-dimensional position information in the relative coordinate system. .
【0009】また上記方法を具現化した請求項2に記載
の発明の構成は、地球中心を原点とする絶対座標系にお
ける3次元位置が既知である少なくとも3個の電波発信
機器から送信される電波を受信することにより、移動体
の3次元位置及び3次元角度を検出する検出装置であっ
て、前記移動体と前記各電波発信機器との距離を検出す
る距離検出手段と、移動体における前記各電波の入射方
向を検出する入射方向検出手段と、前記距離及び入射方
向をもとに、移動体を原点とする相対座標系における各
電波発信機器の3次元位置を算出する相対座標値算出手
段と、各電波発信機器の前記絶対座標系での3次元位置
情報と前記相対座標系での3次元位置情報とから、相対
座標原点の絶対座標系での3次元位置、及び相対座標各
軸の絶対座標系での方向余弦を算出する座標変換回路
と、を備えたものである。A second aspect of the present invention which embodies the above method is a radio wave transmitted from at least three radio wave transmitting devices whose three-dimensional position in an absolute coordinate system whose origin is the center of the earth is known. A distance detecting means for detecting a distance between the moving body and each of the radio wave transmitting devices, and a detecting device for detecting a three-dimensional position and a three-dimensional angle of the moving body. Incident direction detecting means for detecting an incident direction of a radio wave, and relative coordinate value calculating means for calculating a three-dimensional position of each radio wave transmitting device in a relative coordinate system having a moving body as an origin based on the distance and the incident direction; From the three-dimensional position information of each radio wave transmitting device in the absolute coordinate system and the three-dimensional position information in the relative coordinate system, the three-dimensional position of the relative coordinate origin in the absolute coordinate system and the absolute value of each relative coordinate axis In the coordinate system Those having a coordinate transformation circuit for calculating the direction cosines, the.
【0010】さらに請求項3に記載の発明の構成は、請
求項2に記載の構成に加えて、前記入射方向検出手段
が、特定方向からの入射電波を遮蔽する遮蔽板を無指向
性アンテナの外縁部に少なくとも1つ回動自在に設けて
なる指向性アンテナと、前記遮蔽板を回動移動すること
により電波の遮蔽及び解除を行う指向性制御手段とを備
えたものである。According to a third aspect of the present invention, in addition to the configuration of the second aspect, the incident direction detecting means includes a shielding plate for shielding an incident radio wave from a specific direction. At least one directional antenna is rotatably provided on the outer edge portion, and directional control means for shielding and releasing radio waves by rotating the shielding plate.
【0011】[0011]
【発明の実施の形態】以下、本発明にかかる移動体の3
次元位置及び3次元角度検出装置(以下6次元情報検出
装置という)について、図面をもとに説明する。図1は
本発明にかかる6次元情報検出装置1の概要説明図であ
り、図2は図1における無指向性アンテナ9及び指向性
アンテナ11の説明図である。ここで便宜上、移動体を
原点とし、移動体に固定した3軸を座標軸とする相対座
標系(x,y,z)を選定する。また、地球の中心を原
点とする絶対座標系(X,Y,Z)が与えられている。BEST MODE FOR CARRYING OUT THE INVENTION The following is a description of a mobile unit according to the present invention.
A three-dimensional position and three-dimensional angle detection device (hereinafter referred to as a six-dimensional information detection device) will be described with reference to the drawings. FIG. 1 is a schematic explanatory diagram of a six-dimensional information detecting device 1 according to the present invention, and FIG. 2 is an explanatory diagram of an omnidirectional antenna 9 and a directional antenna 11 in FIG. Here, for convenience, a relative coordinate system (x, y, z) having the moving body as the origin and three axes fixed to the moving body as coordinate axes is selected. Also, an absolute coordinate system (X, Y, Z) having the origin at the center of the earth is given.
【0012】6次元情報検出装置1は、地球上空26,
000kmの軌道上を周回している24基のGPS衛星
(以下単に衛星という)から、後述する条件を満たす4
基の衛星を選択する衛星選択回路2と、移動体Cと選択
された衛星との距離dを検出する距離検出手段3と、各
衛星から送信される電波の入射方向を検出する入射方向
検出手段4と、絶対座標値出力回路5にて出力される衛
星の位置情報(X,Y,Z)をもとに、各衛星間の距離
Lを算出する衛星間距離算出回路6と、それら衛星との
距離dと電波の入射方向θ、及び衛星間距離Lとから、
衛星の相対座標系における3次元位置(x,y,z)を
算出する相対座標値算出回路7と、相対座標原点の絶対
座標系における3次元位置(XC,YC,ZC) 及び相対
座標各軸の絶対座標系における方向余弦(λx,μx,ν
x),(λy,μy,νy),(λz,μz,νz) を算出す
る座標変換回路8と、を備えている。[0012] The six-dimensional information detecting device 1 is provided with a 26
From 24 GPS satellites (hereinafter simply referred to as “satellite”) orbiting 000 km,
A satellite selection circuit 2 for selecting a base satellite; a distance detecting means 3 for detecting a distance d between the mobile unit C and the selected satellite; and an incident direction detecting means for detecting an incident direction of a radio wave transmitted from each satellite. 4, an inter-satellite distance calculation circuit 6 for calculating a distance L between the satellites based on the position information (X, Y, Z) of the satellites output from the absolute coordinate value output circuit 5, From the distance d, the incident direction θ of the radio wave, and the distance L between the satellites,
A relative coordinate value calculating circuit 7 for calculating a three-dimensional position (x, y, z) in the relative coordinate system of the satellite; a three-dimensional position (X C , Y C , Z C ) in the absolute coordinate system of the origin of the relative coordinate; Direction cosine (λ x , μ x , ν) of each axis in the absolute coordinate system
x ), (λ y , μ y , ν y ) and (λ z , μ z , ν z ).
【0013】距離検出手段3は、あらゆる方向の衛星か
ら送信される電波を同時に受信可能な無指向性アンテナ
9と、選択された4衛星と移動体Cとの距離dを算出す
る距離算出回路10と、から構成されている。また入射
方向検出手段4は、方位角方向に指向性を有する指向性
アンテナ11と、それらの受信強度を感知する受信レベ
ル感知器12と、その強弱の情報をもとに、指向性アン
テナ11の指向性を制御する指向性制御回路13と、制
御されたアンテナの回動角度を出力する入射方向出力回
路14と、から構成されている。なお上記無指向性アン
テナ9及び指向性アンテナ11は、移動体Cの上部など
電波を受信しやすい箇所に設置される。The distance detecting means 3 includes an omnidirectional antenna 9 capable of simultaneously receiving radio waves transmitted from satellites in all directions, and a distance calculating circuit 10 for calculating a distance d between the selected four satellites and the moving object C. And is composed of The incident direction detecting means 4 includes a directional antenna 11 having directivity in the azimuth direction, a reception level sensor 12 for detecting the reception intensity of the directional antenna 11, and a directional antenna 11 based on the strength information. It comprises a directivity control circuit 13 for controlling the directivity, and an incident direction output circuit 14 for outputting a controlled rotation angle of the antenna. The omni-directional antenna 9 and the directional antenna 11 are installed at a location where radio waves can be easily received, such as above the moving object C.
【0014】無指向性アンテナ9は、グランドプレーン
15と、その中心に設置されたGPS受信機(以下単に
受信機という)16とを備えており、受信機16は衛星
選択回路2を経て受信レベル感知器に接続されている。
また、指向性アンテナ11は、無指向性アンテナ9のグ
ランドプレーン外縁部に、仰角方向に広く方位角方向に
狭い4枚の遮蔽板17,17・・が回動移動自在に設け
られるとともに、遮蔽板17,17・・をそれぞれ独立
に回動移動する駆動手段18が設けられている。また、
受信機16は受信レベル感知器12に接続されており、
指定された衛星からの電波の強度減衰を感知することが
できる。なお、遮蔽板17裏面(受信機側)は電波吸収
素材で覆われており、電波の反射・撹乱を防止してい
る。また、図2には説明の都合上、遮蔽板17を3枚し
か図示していない。The omni-directional antenna 9 includes a ground plane 15 and a GPS receiver (hereinafter simply referred to as a receiver) 16 installed at the center thereof. Connected to the sensor.
The directional antenna 11 has four shield plates 17, 17... Which are wide in the elevation direction and narrow in the azimuth direction and are rotatably provided on the outer edge of the ground plane of the non-directional antenna 9. A driving means 18 for independently rotating the plates 17, 17,... Is provided. Also,
The receiver 16 is connected to the reception level sensor 12,
Attenuation of the intensity of radio waves from the designated satellite can be sensed. The back surface of the shielding plate 17 (receiver side) is covered with a radio wave absorbing material to prevent reflection and disturbance of radio waves. FIG. 2 shows only three shielding plates 17 for convenience of explanation.
【0015】図3は本発明にかかる6次元情報検出装置
1における6次元情報算出のフローチャート図である。
以下、上記6次元情報検出装置1の作用について、図3
に即して説明する。まず、検出工程P1にて、24基の
衛星のうちから選択した4基の衛星Si (i=1,2,
3,4)の絶対座標系における3次元位置(Xi,Yi,
Zi) と、衛星Si と移動体Cとの距離di 、及び衛星
Si から送信される電波の入射方向θi とを検出し、次
の相対座標値算出工程P2にて、これらのデータをもと
に衛星Si の相対座標系における3次元位置(xi,
yi,zi) を算出し、続く座標変換工程P3にて、算
出された衛星Si の相対座標値(xi,yi,zi )と、
既知の情報である絶対座標値(Xi,Yi,Zi) とを比
較することにより、移動体Cの絶対座標系における3次
元位置(XC,YC,ZC)、 及び3次元角度(λx,
μx,νx),(λy,μy,νy),(λz,μz,νz)を
算出する。以下ステップごとに述べる。FIG. 3 is a flowchart for calculating six-dimensional information in the six-dimensional information detecting apparatus 1 according to the present invention.
Hereinafter, the operation of the six-dimensional information detecting device 1 will be described with reference to FIG.
It will be described according to. First, in the detection step P1, four satellites S i (i = 1, 2, 2) selected from the 24 satellites
3-dimensional position in the absolute coordinate system of the 3,4) (X i, Y i ,
Z i ), the distance d i between the satellite S i and the moving object C, and the incident direction θ i of the radio wave transmitted from the satellite S i are detected, and these are detected in the next relative coordinate value calculation step P2. 3-dimensional position in the relative coordinate system of the satellite S i on the basis of data (x i,
y i, calculates the z i), in the subsequent coordinate conversion step P3, the relative coordinate values of the calculated satellite S i (x i, y i , and z i),
By comparing the absolute coordinate values (X i , Y i , Z i ) which are known information, the three-dimensional position (X C , Y C , Z C ) of the moving object C in the absolute coordinate system, and the three-dimensional position Angle (λ x ,
μ x , v x ), (λ y , μ y , v y ), and (λ z , μ z , v z ) are calculated. The following describes each step.
【0016】検出工程P1のステップ1(以下S1等と
略記する)にて、移動体Cの作業地点の大まかな位置情
報をもとに、衛星選択回路2にて、24基の衛星のう
ち、移動体Cの直上付近及び地平付近以外で、互いの方
位角方向の位相差が90度程度の4衛星を選択する。次
いでS2にて、選択された4基の衛星Si の絶対座標値
(Xi,Yi,Zi) を、絶対座標値出力回路5が衛星間
距離算出回路6に出力する。そしてS3で、その絶対座
標値(Xi,Yi,Zi) のデータをもとに、衛星間距離
算出回路6が以下の式〔数1〕にしたがって各衛星間距
離Lii+1を算出し、相対座標値算出回路7に出力する。In step 1 (hereinafter abbreviated as S1 or the like) of the detection process P1, the satellite selection circuit 2 selects one of the 24 satellites based on the rough position information of the work point of the moving object C. Four satellites having a phase difference of about 90 degrees in the azimuthal direction are selected outside the vicinity of the moving object C and the vicinity of the horizon. Next, at S2, the absolute coordinate values of the satellite S i of four selected (X i, Y i, Z i) of the absolute coordinate value output circuit 5 outputs to the satellite distance calculation circuit 6. Then, in S3, based on the data of the absolute coordinate values (X i , Y i , Z i ), the inter-satellite distance calculation circuit 6 calculates each inter-satellite distance L ii + 1 according to the following equation (Equation 1). It is calculated and output to the relative coordinate value calculation circuit 7.
【数1】Lii+1 2 =(Xi+1−Xi)2 +(Yi+1−Yi)
2 +(Zi+1−Zi)2 L ii + 1 2 = (X i + 1 −X i ) 2 + (Y i + 1 −Y i )
2 + (Z i + 1 -Z i ) 2
【0017】上記各衛星間距離Lii+1の算出と同時に、
S4にて、選択された4基の衛星S i に対して通常のG
PS測位を行い、S5で移動体Cとの距離di を距離算
出回路10にて公知の方法でリアルタイムに算出し、そ
の距離情報を相対座標値算出回路7に出力する。またS
6にて、4基の衛星Si に4枚の遮蔽板17,17・・
をそれぞれ対応させるとともに、対応する衛星Si から
送信される電波の受信強度の極小値を検出し、S7にて
受信強度が極小値から増大したか否かを判別する。受信
強度が増大した場合は、S8にて受信強度が減衰する方
向に遮蔽板17,17・・を回動移動させる。換言すれ
ば、指定された衛星Si と受信機16とを遮蔽板17,
17・・が常に遮るように、指向性制御回路13が駆動
手段18を制御する。そして、受信強度が増大しない場
合はS9にて、その時の遮蔽板17の基端中心と指向性
アンテナ11の中心とを結ぶ直線aとx軸との角度θi
を、入射方向出力回路14にて相対座標値算出回路7に
出力する。The distance L between the above satellitesii + 1At the same time
At S4, the four selected satellites S iNormal G for
Performs PS positioning, and at S5, distance d from mobile unit C.iThe distance calculation
The output circuit 10 calculates in real time by a known method, and
Is output to the relative coordinate value calculation circuit 7. Also S
At 6, four satellites SiFour shield plates 17, 17 ...
And the corresponding satellite SiFrom
The minimum value of the reception intensity of the transmitted radio wave is detected, and in S7
It is determined whether the reception intensity has increased from the minimum value. Receiving
If the strength is increased, the receiving strength is attenuated in S8
Are rotated in the directions shown in FIG. Paraphrase
If the specified satellite SiAnd the receiver 16 with the shielding plate 17,
The directivity control circuit 13 is driven so that 17.
Control means 18. And if the reception strength does not increase,
In S9, the center of the base end of the shielding plate 17 at that time and the directivity
Angle θ between straight line a connecting the center of antenna 11 and x-axisi
To the relative coordinate value calculation circuit 7 by the incident direction output circuit 14.
Output.
【0018】次に、検出工程P1で検出された各衛星間
距離Lii+1と衛星Si との距離di、及び入射方向θi
とから、衛星Si の相対座標値(xi,yi,zi)をS
10にて算出する。以下その原理を説明する。衛星Si
との距離di と、衛星Si の相対座標系における方向余
弦(λi,μi,νi) との関係は次のように表すことが
できる。ここでは、(i=1,2,3)の3つに限って
説明を続ける。Next, the distance between each satellite detected by the detecting step P1 L ii + 1 and the satellite S i distance between d i, and the direction of incidence theta i
From the relative coordinates of the satellite S i (x i, y i , z i) the S
Calculated at 10. The principle will be described below. Satellite S i
The relationship between the distance d i, a satellite S i of direction cosine in the relative coordinate system (λ i, μ i, ν i) and the can be expressed as follows. Here, the description will be continued only for three (i = 1, 2, 3).
【数2】d1 2+d2 2−2α12d1d2−L12 2 =0 d2 2+d3 2−2α23d2d3−L23 2 =0 d3 2+d1 2−2α31d3d1−L31 2 =0 αii+1=λiλi+1+μiμi+1+νiνi+1 [Number 2] d 1 2 + d 2 2 -2α 12 d 1 d 2 -L 12 2 = 0 d 2 2 + d 3 2 -2α 23 d 2 d 3 -L 23 2 = 0 d 3 2 + d 1 2 -2α 31 d 3 d 1 −L 31 2 = 0 α ii + 1 = λ i λ i + 1 + μ i μ i + 1 + ν i ν i + 1
【0019】また、衛星Si の入射方向θi と方向余弦
(λi,μi,νi) との関係は、次の通りである。Further, the incident direction theta i and the direction cosine of the satellite S i (λ i, μ i , ν i) have a relationship as follows.
【数3】μi/λi=tanθi (i=1,2,3) さらに、幾何学の条件Μ i / λ i = tan θ i (i = 1,2,3)
【数4】λi 2+μi 2+νi 2=1 (i=1,2,3) が成り立つ。そして、衛星Si の相対座標値(xi,
yi,zi) は次式によって計算される。Λ i 2 + μ i 2 + ν i 2 = 1 (i = 1, 2, 3) holds. The satellite S relative coordinate values of i (x i,
y i , z i ) is calculated by the following equation.
【数5】(xi,yi,zi)=di(λi,μi,νi) 上記の関係を利用し、相対座標値算出回路7が、〔数
2〕の3式と〔数3〕の3式、及び〔数4〕の3式の合
計9式に数値計算法を適用することによって9個の未知
数(λi,μi,νi) を解き、可能な限り余剰解を棄却
する。さらに、S11にて同様の計算を(i=4)を含
めて実行し、さらに余剰解を棄却し、真の解(λi, μ
i,νi)を決定するとともに、方向余弦(λi,μi,ν
i) の精度を高める。すなわち、衛星S1,S2,S4 の
組、衛星S1,S3,S4 の組、衛星S2,S3,S4 の組
から各衛星の方向余弦を重複して算出し、これらを平均
することによって、方向余弦(λi,μi,νi) に含ま
れる誤差を確率的に小さくする。そして、S12で衛星
の相対座標値(xi,yi,zi) を〔数5〕に従って算
出する。(X i , y i , z i ) = d i (λ i , μ i , v i ) Using the above relationship, the relative coordinate value calculation circuit 7 calculates Nine unknowns (λ i , μ i , ν i ) are solved by applying a numerical calculation method to a total of nine equations of the three equations of [Equation 3] and the three equations of [Equation 4]. Reject the solution. Further, in S11, the same calculation including (i = 4) is executed, the surplus solution is rejected, and the true solution (λ i , μ
i , v i ) and the direction cosine (λ i , μ i , v
i ) Increase accuracy. That is, the satellite S 1, S 2, S 4 sets, satellite S 1, S 3, S 4 sets, calculates duplicate direction cosines of each satellite from the set of satellites S 2, S 3, S 4 , By averaging these, the error included in the direction cosine (λ i , μ i , ν i ) is reduced stochastically. The relative coordinate values of the satellite in S12 (x i, y i, z i) is calculated according to the [Equation 5].
【0020】続いて、相対座標値算出工程P2で算出さ
れた衛星Si の相対座標値(xi,yi,zi) と、既知
の情報である衛星Si の絶対座標値(Xi,Yi,Zi)
(i=1,2,3)とを比較して、相対座標原点つまり
移動体Cの3次元位置(X C,YC,ZC)、 及び相対座
標各軸の絶対座標系における方向余弦、つまり移動体の
3次元角度(λx, μx,νx),(λy,μy,νy),
(λz,μz,νz)を、座標変換回路8が以下のように
算出する。Subsequently, in the relative coordinate value calculating step P2,
Satellite SiRelative coordinate value (xi, Yi, Zi) And known
Satellite S which is the information ofiAbsolute coordinate value (Xi, Yi, Zi)
(I = 1, 2, 3), and the relative coordinate origin, that is,
The three-dimensional position (X C, YC, ZC), And relative seat
The direction cosine of the axis in the absolute coordinate system,
Three-dimensional angle (λx, Μx, Νx), (Λy, Μy, Νy),
(Λz, Μz, Νz) By the coordinate conversion circuit 8 as follows:
calculate.
【数6】 とする回転ベクトルRを用いて、S13にて衛星Si の
相対座標値(xi,yi,zi) と絶対座標値(Xi,
Yi,Zi) に関する連立2次方程式(Equation 6) Using a rotating vector R to the relative coordinates of the satellite S i at S13 (x i, y i, z i) and the absolute coordinate values (X i,
Y i , Z i )
【数7】 (Equation 7)
【数8】λx 2+μx 2+νx 2=1 λy 2+μy 2+νy 2=1 λz 2+μz 2+νz 2=1 を解き、相対座標各軸の絶対座標系における方向余弦
(λx,μx,νx), (λy,μy,νy),(λz,
μz,νz)を2組ずつ算出した後、座標軸の直交条件等
で余剰解を棄却して回転ベクトルRを算出し、S14で
相対座標各軸(λx,μx,νx),(λy,μy,νy),
(λz,μz,νz) つまり移動体Cの3次元角度を特
定する。最後に、S15で移動体Cの3次元位置
(XC,YC,ZC) を〔数7〕より算出する。Equation 8] λ x 2 + μ x 2 + ν x 2 = 1 λ y 2 + μ y 2 + ν y 2 = 1 λ z 2 + μ z 2 + ν z 2 = 1 solves, direction in the absolute coordinate system of relative coordinates axes Cosines (λ x , μ x , v x ), (λ y , μ y , v y ), (λ z ,
μ z , ν z ) are calculated two by two, and then a surplus solution is rejected under orthogonal conditions of the coordinate axes and the like, and a rotation vector R is calculated. At S14, relative coordinate axes (λ x , μ x , ν x ), (Λ y , μ y , ν y ),
(Λ z , μ z , ν z ) That is, the three-dimensional angle of the moving object C is specified. Finally, in S15, the three-dimensional position (X C , Y C , Z C ) of the moving object C is calculated from [Equation 7].
【0021】上記のように算出された移動体Cの3次元
位置情報及び3次元角度情報(6次元情報)を、6次元
情報出力回路19が移動体制御装置20に出力し、移動
体Cの走行を制御する。The six-dimensional information output circuit 19 outputs the three-dimensional position information and three-dimensional angle information (six-dimensional information) of the moving object C calculated as described above to the moving object control device 20, and Control running.
【0022】ここで、上記検出工程P1にて使用される
入射方向検出手段4の測定誤差について評価するため
に、以下の実験を行った。図2に示す指向性アンテナ1
1に設置された遮蔽板17を、受信機16との距離l
と、板幅wとを変えて衛星からの電波を遮蔽し、受信レ
ベル感知器12にて電波強度の減衰度を測定した。その
結果を平均して、図4に示す実験データを得た。グラフ
の横軸は受信機16との距離l〔cm〕、縦軸は受信電
波の減衰度〔dB〕である。これを見ると、遮蔽板17
の板幅wを1cmとし、受信機16からの距離lを15
cmとして電波を遮蔽した場合でも、平均して約10d
Bの減衰を記録していることが分かる。従って、このレ
ベルの強度減衰を感知できる感知器を使用すれば、遮蔽
板17の板幅wを1cmとしても、遮蔽板17を常に衛
星方向に回動移動させるように制御することができる。
例えば、受信レベル感知器12で感知される電波の受信
強度が極小値より平均的に10dB増大した場合に、遮
蔽板17を左右いずれかに回動移動させて、受信強度が
減衰する方向を選択する、などの制御方法をとることが
できる。この場合、図2に示す受信機中心と遮蔽板17
の基端部中心とを結ぶ直線aと、受信機中心と衛星とを
結ぶ直線bとがなす角δが測定誤差であるが、仮に、遮
蔽板17が衛星からずれて電波が直接受信機16に入っ
た瞬間に、受信電波強度が極小値より10dB増大する
とすれば、最大測定誤差をδMAX として、Here, the following experiment was conducted in order to evaluate the measurement error of the incident direction detecting means 4 used in the detecting step P1. Directional antenna 1 shown in FIG.
1 and the distance l from the receiver 16
And the board width w were changed to shield the radio wave from the satellite, and the reception level sensor 12 measured the degree of attenuation of the radio wave intensity. The results were averaged to obtain experimental data shown in FIG. The horizontal axis of the graph is the distance l [cm] from the receiver 16, and the vertical axis is the attenuation [dB] of the received radio wave. Looking at this, the shielding plate 17
And the distance l from the receiver 16 is 15 cm.
about 10d on average, even when blocking radio waves as cm
It can be seen that the decay of B was recorded. Therefore, if a sensor capable of detecting this level of intensity attenuation is used, even if the width w of the shield plate 17 is set to 1 cm, it is possible to control the shield plate 17 to always rotate and move toward the satellite.
For example, when the reception intensity of the radio wave detected by the reception level sensor 12 is increased by 10 dB on average from the minimum value, the shielding plate 17 is rotated left or right to select a direction in which the reception intensity is attenuated. Control method. In this case, the receiver center shown in FIG.
The angle δ formed by a straight line a connecting the center of the base end of the receiver and a straight line b connecting the center of the receiver to the satellite is a measurement error. Assuming that the received signal strength increases by 10 dB from the minimum value at the moment of entering, the maximum measurement error is δ MAX ,
【数9】tan(δMAX)≒w/(2・l) と近似できる。よってこの場合には、入射方向の測定誤
差δは2度程度に抑えることができる。そして、この誤
差δを含む入射方向θi から導出される衛星S i の方向
余弦(λi,μi,νi) にも当然誤差が生じるが、前述
したようにS12で(i=4)を適用して各衛星の方向
余弦を重複して算出し、これを平均することにより誤差
を確率的に小さくすることができる。なお、4機の指向
性アンテナ11,11・・の設置部位の差異による電波
の入射方向のずれは、衛星への距離を考慮すれば無視で
きるオーダーである。Tan (δMAX) ≒ w / (2 · l). Therefore, in this case, measurement error in the incident direction
The difference δ can be suppressed to about 2 degrees. And this mistake
Incident direction θ including difference δiSatellite S derived from iDirection
Cosine (λi, Μi, Νi) Also has an error,
As described above, applying (i = 4) in S12, the direction of each satellite
Calculate the cosine duplicatively and average it to get the error
Can be stochastically reduced. The orientation of the four aircraft
Radio waves due to differences in the installation locations of the directional antennas 11, 11
The deviation of the incident direction of the satellite is negligible considering the distance to the satellite.
It is an order that can be done.
【0023】ところで、GPS受信機を移動体に4機,
基準局に1機設置して測位し、それらの位置情報から移
動体の3次元角度を算出する従来の装置を用いた場合の
測定誤差について、移動体に設置した各受信機の設置間
隔はせいぜい1〜3mであるから、測位精度が数cmの
オーダーであっても、算出される角度情報には1〜3°
の測定誤差が含まれる。してみれば、上記6次元情報検
出装置1は、基準局からデータを送信して補正する従来
の検出装置と比較しても、何ら遜色のない測定精度であ
るといえる。By the way, four GPS receivers are mounted on a mobile body,
Regarding the measurement error when using a conventional apparatus that installs and measures the position of one receiver at the reference station and calculates the three-dimensional angle of the mobile from the position information, the installation interval of each receiver installed on the mobile is at most 1 33 m, even if the positioning accuracy is on the order of several cm, the calculated angle information contains 11〜33 °.
Measurement error is included. Thus, it can be said that the six-dimensional information detecting device 1 has measurement accuracy comparable to that of a conventional detecting device that transmits and corrects data from a reference station.
【0024】以上詳述したように、上記6次元情報検出
装置1によれば、距離検出手段としての無指向性アンテ
ナ9及び距離検出回路10によって、電波発信機器とし
てのGPS衛星Si と移動体Cとの距離をリアルタイム
に検出し、また入射方向検出手段としての指向性アンテ
ナ11,11・・と受信レベル感知器12,指向性制御
回路13,遮蔽板17,17・・,及び駆動手段18,
18・・によって、移動体Cにおける特定方向に対する
衛星の入射方向をリアルタイムに検出し、それらの位置
及び入射方向のデータをもとに、相対座標値算出回路7
にて衛星の相対座標系における3次元位置を算出し、そ
の相対座標値と既知の絶対座標値とから、座標変換回路
8にて相対座標系を絶対座標系に変換する回転ベクトル
Rを算出することによって、移動体Cの3次元位置情報
及び3次元角度情報(6次元情報)を算出しているの
で、高価な基準局やデータ送信設備を要せずして、移動
体Cの6次元情報すべてを、移動中・停止中ともに充分
な精度で検出することができる。しかも、無指向性アン
テナ8の外縁部に設置した4枚の遮蔽板をそれぞれ独立
に制御することにより、各衛星から送信される電波の入
射方向を検出しているので、高価なGPS受信機を2機
しか必要とせず、装置を低コスト化に抑えることができ
る。さらに、移動体Cにて検出されたデータを基準局等
外部から補正する必要がないので、データ処理に要する
時間が短く、ほぼリアルタイムに上記6次元情報が算出
される。したがって、起伏の激しい作業路面において
も、移動体Cをより的確に制御することができる。[0024] As described above in detail, according to the six-dimensional information detecting device 1, the omnidirectional antenna 9 and the distance detection circuit 10 serving as a distance detecting means, the moving body and the GPS satellite S i as the radio signal transmitting device , And a directional antenna 11, 11,... And a reception level sensor 12, a directivity control circuit 13, shielding plates 17, 17,. ,
.., The incident direction of the satellite with respect to the specific direction on the moving object C is detected in real time, and the relative coordinate value calculating circuit 7 is calculated based on the data on the position and the incident direction.
Calculates the three-dimensional position of the satellite in the relative coordinate system, and calculates a rotation vector R for converting the relative coordinate system to the absolute coordinate system in the coordinate conversion circuit 8 from the relative coordinate values and the known absolute coordinate values. Thus, since the three-dimensional position information and the three-dimensional angle information (six-dimensional information) of the mobile unit C are calculated, all the six-dimensional information of the mobile unit C can be used without an expensive reference station or data transmission equipment. Can be detected with sufficient accuracy both during movement and during stoppage. In addition, since the direction of incidence of radio waves transmitted from each satellite is detected by independently controlling the four shielding plates installed at the outer edge of the omnidirectional antenna 8, an expensive GPS receiver can be used. Only two units are required, and the cost of the apparatus can be reduced. Further, since it is not necessary to correct data detected by the mobile unit C from the outside such as a reference station, the time required for data processing is short, and the six-dimensional information is calculated almost in real time. Therefore, the moving body C can be controlled more accurately even on a work road surface with severe ups and downs.
【0025】なお、本発明の6次元情報検出装置は、上
記実施の形態に何ら限定されるものではなく、電波発信
機器,衛星選択回路,距離検出手段,入射方向検出手
段,相対座標値算出手段,座標変換回路等、本発明の趣
旨に逸脱しない範囲で適宜変更できる。例えば、電波発
信機器にあっては、実施形態のGPS衛星に限定され
ず、静止衛星など各時刻における3次元位置が既知のも
のならば何でもよい。また、距離検出手段にあって、無
指向性のGPS受信機を採用する場合には、移動体にG
PS受信機を1機のみならず複数機搭載し、その測位精
度を向上させる構成としても差し支えない。さらに、入
射方向検出手段について、上記実施形態では無指向性ア
ンテナのグランドプレーン外縁部に設置した4枚の遮蔽
板をそれぞれ独立に制御することにより電波の入射方向
を検出する構成について説明したが、遮蔽板を1本のみ
グランドプレーン外縁部に固定し、アンテナ基端部を方
位角方向に回動可能とした指向性アンテナを4機搭載す
る構成とすることもできる。また、上記遮蔽板に代え
て、下端縁から仰角方向にスリットを設けた半球状のド
ームを受信機にかぶせ、電波の受信レベルが高くなった
方向をもって電波の入射方向とする構成としてもよい。
また指向性アンテナの設置数も4個に限定するものでは
ない。さらに、上記実施形態では方位角方向に指向性を
持たせたアンテナを採用しているが、仰角方向に指向性
を持たせたアンテナを用いても同等の結果を得ることが
できる。加えて、上記実施形態では無指向性アンテナと
指向性アンテナとを別個に設けた構成について述べた
が、1つのアンテナの無指向性・指向性をソフト的に切
り替える構成とすることも可能である。このようにすれ
ば、高価なGPS受信機の設置数を1機のみとすること
ができ、装置をさらに低コストに抑えることができる。It should be noted that the six-dimensional information detecting device of the present invention is not limited to the above-described embodiment, but includes a radio wave transmitting device, a satellite selecting circuit, a distance detecting means, an incident direction detecting means, and a relative coordinate value calculating means. , Coordinate conversion circuit, etc. can be changed as appropriate without departing from the spirit of the present invention. For example, the radio wave transmitting device is not limited to the GPS satellite of the embodiment, but may be any device such as a geostationary satellite as long as its three-dimensional position at each time is known. In the case where an omnidirectional GPS receiver is used in the distance detecting means, the moving body is
A configuration may be adopted in which not only one PS receiver but also a plurality of PS receivers are mounted to improve the positioning accuracy. Furthermore, as for the incident direction detecting means, in the above-described embodiment, the configuration has been described in which the incident direction of the radio wave is detected by independently controlling the four shielding plates provided at the outer edge of the ground plane of the omnidirectional antenna. It is also possible to adopt a configuration in which only one shielding plate is fixed to the outer edge of the ground plane, and four directional antennas whose base end is rotatable in the azimuthal direction are mounted. Further, instead of the shielding plate, a hemispherical dome provided with a slit in the elevation angle direction from the lower edge may be placed over the receiver, and the direction in which the radio wave reception level becomes higher may be used as the radio wave incident direction.
The number of directional antennas is not limited to four. Furthermore, in the above embodiment, an antenna having directivity in the azimuth direction is employed, but the same result can be obtained by using an antenna having directivity in the elevation direction. In addition, in the above-described embodiment, the configuration in which the omnidirectional antenna and the directional antenna are separately provided has been described. However, a configuration in which the omnidirectional / directivity of one antenna is switched by software may be employed. . In this way, the number of expensive GPS receivers can be reduced to only one, and the cost of the apparatus can be further reduced.
【0026】また、上記実施形態では4基の衛星からの
情報を利用した算出工程について説明したが、より多く
の衛星からの情報を活用すれば、測定精度をさらに向上
させることができる。なお、本発明の6次元情報検出装
置は、トラクター,転圧機等どのような移動体にも設置
可能であることは勿論であり、受信機の配置等も任意で
ある。In the above embodiment, the calculation step using information from four satellites has been described. However, if information from more satellites is used, measurement accuracy can be further improved. In addition, it goes without saying that the six-dimensional information detecting device of the present invention can be installed on any moving body such as a tractor and a compactor, and the arrangement of the receiver is arbitrary.
【0027】[0027]
【発明の効果】請求項1に記載の3次元位置及び3次元
角度検出方法によれば、移動体の3次元位置及び3次元
角度のすべてが検出される。また、基準局やデータ送信
設備を必要としないので、前記3次元位置及び3次元角
度を低コストに検出することが可能である。また請求項
2に記載の3次元位置及び3次元角度検出装置によれ
ば、高価な基準局やデータ送信設備を要せずして、移動
体の3次元位置及び3次元角度のすべてを検出すること
ができる。また、移動体にて検出されたデータを基準局
等外部から補正する必要がないので、データ処理に要す
る時間が短く、前記3次元位置及び3次元角度がほぼリ
アルタイムに算出される。これにより、起伏の激しい作
業路面においても、移動体をより的確に制御することが
可能となる。さらに請求項3に記載の発明において、無
指向性アンテナの外縁部に遮蔽板を複数設置し、1機の
受信機で複数の電波発信機器からの電波の入射方向を検
出する構成とした場合には、請求項2の効果に加え、受
信機の設置数を減らすことができ、装置をさらに低コス
トに抑えることができる。According to the three-dimensional position and three-dimensional angle detection method of the present invention, all of the three-dimensional position and three-dimensional angle of the moving object are detected. Further, since no reference station or data transmission equipment is required, the three-dimensional position and the three-dimensional angle can be detected at low cost. According to the three-dimensional position and three-dimensional angle detecting device of the second aspect, all of the three-dimensional position and three-dimensional angle of the moving object can be detected without requiring an expensive reference station or data transmission equipment. Can be. Further, since it is not necessary to correct the data detected by the mobile unit from outside such as a reference station, the time required for data processing is short, and the three-dimensional position and the three-dimensional angle are calculated almost in real time. This makes it possible to more accurately control the moving body even on a work road surface with undulations. Further, in the invention according to claim 3, when a plurality of shielding plates are provided at the outer edge of the omnidirectional antenna, and one receiver detects the incident directions of radio waves from a plurality of radio wave transmitting devices, In addition to the effect of claim 2, the number of receivers can be reduced, and the apparatus can be further reduced in cost.
【図1】本発明にかかる移動体の3次元位置及び3次元
角度検出装置の概要説明図である。FIG. 1 is a schematic explanatory diagram of a three-dimensional position and three-dimensional angle detection device of a moving object according to the present invention.
【図2】図1における無指向性アンテナ及び指向性アン
テナの説明図である。FIG. 2 is an explanatory diagram of an omnidirectional antenna and a directional antenna in FIG. 1;
【図3】本発明にかかる3次元位置及び3次元角度検出
装置における、3次元位置及び3次元角度算出のフロー
チャート図である。FIG. 3 is a flowchart for calculating a three-dimensional position and a three-dimensional angle in the three-dimensional position and three-dimensional angle detection device according to the present invention.
【図4】図2に示す指向性アンテナに設置された遮蔽板
を、受信機との距離と板幅とを変えて衛星からの電波を
遮蔽し、その受信電波の減衰度を測定して得た実験結果
の平均値を示すグラフである。FIG. 4 shows a shielding plate installed on the directional antenna shown in FIG. 2 shielded from a satellite by changing the distance to the receiver and the plate width, and measuring the attenuation of the received radio wave. 9 is a graph showing average values of experimental results obtained.
【図5】衛星の方位角の従来の測定方法における測定誤
差に関する説明図である。FIG. 5 is an explanatory diagram relating to a measurement error in a conventional method of measuring the azimuth of a satellite.
1・・6次元情報検出装置、2・・衛星選択回路、3・
・距離検出手段、4・・入射方向検出手段、5・・絶対
座標値出力回路、6・・衛星間距離算出回路、7・・相
対座標値算出回路、8・・座標変換回路、9・・無指向
性アンテナ、10・・距離算出回路、11・・指向性ア
ンテナ、12・・受信レベル感知器、13・・指向性制
御回路、14・・入射方向出力回路、15・・グランド
プレーン、16・・GPS受信機、17・・遮蔽板、1
8・・駆動手段、19・・6次元情報出力回路、20・
・移動体制御装置、C・・移動体、S・・衛星。1. 6-dimensional information detection device 2. Satellite selection circuit 3.
.. Distance detecting means, 4... Incident direction detecting means, 5... Absolute coordinate value output circuit, 6... Inter-satellite distance calculating circuit, 7... Relative coordinate value calculating circuit, 8. Non-directional antenna, 10 distance calculation circuit, 11 directional antenna, 12 reception level sensor, 13 directional control circuit, 14 incident direction output circuit, 15 ground plane, 16 ..GPS receivers, 17 shield plates, 1
8 ··· Drive means, 19 ·· 6-dimensional information output circuit, 20 ···
-Mobile control unit, C-Mobile, S-Satellite.
フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) H01Q 15/18 H01Q 15/18 21/28 21/28 Fターム(参考) 5J020 AA03 BA06 BA08 BC02 BC08 BD01 BD04 CA02 DA10 5J021 BA01 DA03 DA04 DA05 DA06 DA07 EA04 FA14 FA15 FA16 FA17 FA20 GA02 HA03 HA04 HA05 HA07 5J062 AA01 AA09 AA11 BB01 BB08 DD22 GG02 Continued on the front page (51) Int.Cl. 7 Identification symbol FI Theme coat II (Reference) H01Q 15/18 H01Q 15/18 21/28 21/28 F term (Reference) 5J020 AA03 BA06 BA08 BC02 BC08 BD01 BD04 CA02 DA10 5J021 BA01 DA03 DA04 DA05 DA06 DA07 EA04 FA14 FA15 FA16 FA17 FA20 GA02 HA03 HA04 HA05 HA07 5J062 AA01 AA09 AA11 BB01 BB08 DD22 GG02
Claims (3)
る3次元位置が既知である、少なくとも3個の電波発信
機器から送信される電波を受信することにより、移動体
の3次元位置及び3次元角度を検出する検出方法であっ
て、前記移動体と前記各電波発信機器との距離、及び移
動体における前記各電波発信機器から送信される電波の
入射方向を検出し、前記距離及び電波の入射方向をもと
に、移動体を原点とする相対座標系における各電波発信
機器の3次元位置を算出した後、各電波発信機器の前記
絶対座標系における3次元位置情報と前記相対座標系に
おける3次元位置情報とから、移動体の絶対座標系での
3次元位置、及び移動体の向きを算出することを特徴と
する移動体の3次元位置及び3次元角度の検出方法。1. A three-dimensional position and a three-dimensional position of a moving object by receiving radio waves transmitted from at least three radio wave transmitting devices whose three-dimensional position in an absolute coordinate system whose origin is the center of the earth is known. A method for detecting an angle, comprising detecting a distance between the moving object and each of the radio wave transmitting devices, and an incident direction of a radio wave transmitted from each of the radio wave transmitting devices on the moving object, and detecting the distance and the incidence of the radio wave. After calculating the three-dimensional position of each radio wave transmitting device in the relative coordinate system with the moving body as the origin based on the direction, the three-dimensional position information of each radio wave transmitting device in the absolute coordinate system and the three-dimensional position information in the relative coordinate system are calculated. A method for detecting a three-dimensional position and a three-dimensional angle of a moving body, comprising calculating a three-dimensional position of the moving body in an absolute coordinate system and a direction of the moving body from the three-dimensional position information.
る3次元位置が既知である少なくとも3個の電波発信機
器から送信される電波を受信することにより、移動体の
3次元位置及び3次元角度を検出する検出装置であっ
て、前記移動体と前記各電波発信機器との距離を検出す
る距離検出手段と、移動体における前記各電波の入射方
向を検出する入射方向検出手段と、前記距離及び入射方
向をもとに、移動体を原点とする相対座標系における各
電波発信機器の3次元位置を算出する相対座標値算出手
段と、各電波発信機器の前記絶対座標系での3次元位置
情報と前記相対座標系での3次元位置情報とから、相対
座標原点の絶対座標系での3次元位置、及び相対座標各
軸の絶対座標系での方向余弦を算出する座標変換回路
と、を備えた移動体の3次元位置及び3次元角度の検出
装置。2. A three-dimensional position and a three-dimensional angle of a moving object by receiving radio waves transmitted from at least three radio wave transmitting devices whose three-dimensional positions in an absolute coordinate system having the origin at the center of the earth are known. A detecting device for detecting a distance between the moving body and each of the radio wave transmitting devices, an incident direction detecting means for detecting an incident direction of each of the radio waves on the moving body, the distance and Relative coordinate value calculating means for calculating the three-dimensional position of each radio wave transmitting device in a relative coordinate system with the moving body as the origin based on the incident direction; and three-dimensional position information of each radio wave transmitting device in the absolute coordinate system And a coordinate conversion circuit for calculating a three-dimensional position of the relative coordinate origin in the absolute coordinate system and a direction cosine of each relative coordinate axis in the absolute coordinate system from the three-dimensional position information in the relative coordinate system. Moving body 3 A three-dimensional position and three-dimensional angle detection device.
射電波を遮蔽する遮蔽板を無指向性アンテナの外縁部に
少なくとも1つ回動自在に設けてなる指向性アンテナ
と、前記遮蔽板を回動移動することにより電波の遮蔽及
び解除を行う指向性制御手段とを有することを特徴とす
る請求項2に記載の移動体の3次元位置及び3次元角度
の検出装置。3. The directional antenna, wherein the incident direction detecting means is provided with at least one shielding plate for shielding incident radio waves from a specific direction at an outer edge of the omnidirectional antenna, and 3. The three-dimensional position and three-dimensional angle detecting device according to claim 2, further comprising: a directivity control unit configured to block and release a radio wave by rotating.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000044824A JP2001235533A (en) | 2000-02-22 | 2000-02-22 | Method and device for detecting three-dimensional position and three-dimensional angle of moving body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000044824A JP2001235533A (en) | 2000-02-22 | 2000-02-22 | Method and device for detecting three-dimensional position and three-dimensional angle of moving body |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2001235533A true JP2001235533A (en) | 2001-08-31 |
Family
ID=18567527
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000044824A Pending JP2001235533A (en) | 2000-02-22 | 2000-02-22 | Method and device for detecting three-dimensional position and three-dimensional angle of moving body |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2001235533A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007024617A (en) * | 2005-07-14 | 2007-02-01 | National Institute Of Information & Communication Technology | Directional information acquisition method |
JP2009031000A (en) * | 2007-07-24 | 2009-02-12 | Daido Signal Co Ltd | Metal body detection system |
JP2013533467A (en) * | 2010-05-24 | 2013-08-22 | ロバート・ジェイ・ウェリントン | Determination of spatial orientation information of an object from multiple electromagnetic signals |
JP2016133364A (en) * | 2015-01-19 | 2016-07-25 | 古野電気株式会社 | Bearing calculation device, bearing calculation method, bearing calculation program, and mobile entity |
KR101925570B1 (en) * | 2017-10-20 | 2018-12-06 | 국방과학연구소 | Method and apparatus for providing target tracing in antenna system |
-
2000
- 2000-02-22 JP JP2000044824A patent/JP2001235533A/en active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007024617A (en) * | 2005-07-14 | 2007-02-01 | National Institute Of Information & Communication Technology | Directional information acquisition method |
JP2009031000A (en) * | 2007-07-24 | 2009-02-12 | Daido Signal Co Ltd | Metal body detection system |
JP2013533467A (en) * | 2010-05-24 | 2013-08-22 | ロバート・ジェイ・ウェリントン | Determination of spatial orientation information of an object from multiple electromagnetic signals |
US9719788B2 (en) | 2010-05-24 | 2017-08-01 | Robert J. Wellington | Determining spatial orientation information of a body from multiple electromagnetic signals |
KR101809294B1 (en) * | 2010-05-24 | 2017-12-14 | 로버트 제이. 웰링톤 | Method and system of determining spatial orientation information of a body from multiple electromagnetic signals |
JP2016133364A (en) * | 2015-01-19 | 2016-07-25 | 古野電気株式会社 | Bearing calculation device, bearing calculation method, bearing calculation program, and mobile entity |
KR101925570B1 (en) * | 2017-10-20 | 2018-12-06 | 국방과학연구소 | Method and apparatus for providing target tracing in antenna system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
AU2020201378B2 (en) | Radar mounting estimation with unstructured data | |
US9612342B2 (en) | GNSS positioning system including an anti-jamming antenna and utilizing phase center corrected carrier | |
US8378885B2 (en) | Device and method for locating a mobile approaching a surface reflecting electromagnetic waves | |
US20050043039A1 (en) | Position detecting system, and transmitting and receiving apparatuses for the position detecting system | |
CN107850671A (en) | Antenna direction graphical data mining for automotive global navigational satellite system receiver | |
CN110058204B (en) | Satellite-borne antenna beam center calibration method based on directional diagram matching | |
US10996316B1 (en) | Vehicle sensor alignment using photogrammetry | |
CN115061156A (en) | Array antenna satellite navigation deception resisting method and system based on integrated navigation | |
US6816117B2 (en) | Distributed antenna system and method | |
WO2005124387A1 (en) | Attitude determination system using null-steered array | |
JP2003064725A (en) | Unmanned mechanical earth work system | |
US20030048221A1 (en) | Method and system using a GPS-based phased-array scheme for three-axis attitude determination | |
CN111505669A (en) | GNSS deception detection method and system using double antennas | |
JP5159718B2 (en) | Antenna device | |
JP2001235533A (en) | Method and device for detecting three-dimensional position and three-dimensional angle of moving body | |
JP7419119B2 (en) | working machine | |
CN109425875A (en) | Satellite-signal separating and treating apparatus and method | |
CN114545448B (en) | Satellite-borne GNSS-R/S integrated receiving system and ocean intelligent detection method | |
FR2819657A1 (en) | Satellite terrestrial transmitter position finding having satellite with antenna measuring two different instants/three orthogonal planes electromagnetic field calculating vectors and finding propagation intersection point/location. | |
US12000922B2 (en) | Determination of cardinal direction | |
JP2001264405A (en) | Method for detecting three-dimensional position and angle of movable body and device therefor | |
US11300687B2 (en) | Discriminating and mitigating SNS spoofing signals | |
JP3640433B2 (en) | ANTENNA DIRECTION DIRECTION CALCULATION METHOD AND ANTENNA DIRECTION DIRECTION CONTROL DEVICE | |
JP3610907B2 (en) | Object detection system and method | |
JP7102071B2 (en) | Work machine |