Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP2763464B2 - Moving state detection device - Google Patents
[go: Go Back, main page]

JP2763464B2 - Moving state detection device - Google Patents

Moving state detection device

Info

Publication number
JP2763464B2
JP2763464B2 JP4326137A JP32613792A JP2763464B2 JP 2763464 B2 JP2763464 B2 JP 2763464B2 JP 4326137 A JP4326137 A JP 4326137A JP 32613792 A JP32613792 A JP 32613792A JP 2763464 B2 JP2763464 B2 JP 2763464B2
Authority
JP
Japan
Prior art keywords
shield machine
directions
acceleration
traveling
components
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.)
Expired - Fee Related
Application number
JP4326137A
Other languages
Japanese (ja)
Other versions
JPH06146781A (en
Inventor
利博 奥村
清一 松下
匡剛 安本
昭二 高橋
耕一 伊藤
忠 樋口
毅 柳楽
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.)
Toda Corp
Original Assignee
Toda Corp
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 Toda Corp filed Critical Toda Corp
Priority to JP4326137A priority Critical patent/JP2763464B2/en
Publication of JPH06146781A publication Critical patent/JPH06146781A/en
Application granted granted Critical
Publication of JP2763464B2 publication Critical patent/JP2763464B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Excavating Of Shafts Or Tunnels (AREA)

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【産業上の利用分野】本発明は移動体の進行状態検出装
置、特にシールド機などの移動体の進行方向を測定する
ことができる進行状態検出装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an apparatus for detecting the traveling state of a moving body, and more particularly to a traveling state detecting apparatus capable of measuring the traveling direction of a moving body such as a shield machine.

【0002】[0002]

【従来の技術】シールド機等を用いてトンネルの掘削を
行う場合には、一般にジャイロコンパスを用いてシール
ド機の姿勢方向を検出し、あらかじめ定められた目標経
路に沿ってシールド機が進行するよう制御をしている。
2. Description of the Related Art When a tunnel is excavated using a shield machine or the like, generally, the attitude direction of the shield machine is detected using a gyrocompass so that the shield machine proceeds along a predetermined target path. Has control.

【0003】ところが、シールド掘進を行う場合、図5
(A)に示すようシールド機10の姿勢方向100と実
際の進行方向200が一致しない場合がある。この場
合、ジャイロコンパスでは、シールド機10の姿勢方向
100しか検出できないため、姿勢方向100と実際の
進行方向200との差が検出誤差となって現われるとい
う問題があった。
[0003] However, when shield excavation is performed, FIG.
As shown in (A), the attitude direction 100 of the shield machine 10 and the actual traveling direction 200 may not match. In this case, since the gyro compass can detect only the attitude direction 100 of the shield machine 10, there is a problem that a difference between the attitude direction 100 and the actual traveling direction 200 appears as a detection error.

【0004】また、図5(B)に示すようシールド機1
0がシールド掘進中に平行移動(横すべり)した場合、
姿勢方向100は変化しない。このため、ジャイロコン
パスではこの平行移動を検出できず、この結果、シール
ド機10の実際の進行方向200に対する測定誤差が生
じてしまうという問題もあった。
[0004] Further, as shown in FIG.
If 0 moves parallel (slides) during shield excavation,
The posture direction 100 does not change. For this reason, the gyro compass cannot detect this translation, and as a result, there is a problem that a measurement error occurs in the actual traveling direction 200 of the shield machine 10.

【0005】この様な測定誤差対策として、現状では、
1リングのセグメントを組み立てる毎に、光学測量によ
り誤差補正を行っているが、それではジャイロコンパス
の特徴である、掘削経路測定機器の設置用坑内空間が不
要、機器の設置換えが不要等のメリットが生かされな
い。
As a measure against such a measurement error, at present,
Each time a single ring segment is assembled, error correction is performed by optical surveying. However, the advantages of the gyrocompass are that there is no need for an underground space for installing excavation path measuring equipment, and there is no need to change equipment. It cannot be used.

【0006】特に、このような光学測量による誤差補正
は、径の大きなトンネルを掘削する場合には機器設置ス
ペースに余裕があるため可能であるが、上下水道などの
径の小さなトンネル掘削を行う場合には難しいという問
題があった。
[0006] In particular, such error correction by optical surveying is possible when excavating a large-diameter tunnel because there is sufficient space for installing equipment, but when excavating a small-diameter tunnel such as water and sewage. Had a problem that was difficult.

【0007】[0007]

【発明が解決しようとする課題】このように、ジャイロ
コンパスを用いた従来の進行状態検出装置では、シール
ド機10の姿勢方向100のみを検出しているため、姿
勢方向100と実際の進行方向200との間に誤差があ
る場合や、シールド機10が横すべりを起こしたような
場合には、これが測定誤差となって現われるため、定期
的に光学測量あるいは他の手段を用いて誤差補正を行う
必要があり、正確な進行方向のリアルタイム測定ができ
ないという問題があった。
As described above, in the conventional traveling state detecting device using the gyro compass, only the attitude direction 100 of the shield machine 10 is detected. In the case where there is an error between them and when the shield machine 10 has caused a side slip, this appears as a measurement error. Therefore, it is necessary to periodically correct the error using optical surveying or other means. There is a problem that accurate real-time measurement of the traveling direction cannot be performed.

【0008】特に、このような誤差補正を必要とする従
来技術では、高価な測量機械を必要とし、また時間と手
間もかかるため、これらが工事単価を引き上げる要因の
1つとなっていた。
In particular, in the prior art requiring such error correction, an expensive surveying machine is required, and it takes time and labor. Therefore, these are one of the factors that increase the construction unit cost.

【0009】本発明は、このような従来の課題に鑑みな
されたものであり、その目的は、シールド機などの移動
体の進行方向を直接にほぼリアルタイム測定することが
できる進行状態検出装置を提供することにある。
SUMMARY OF THE INVENTION The present invention has been made in view of such conventional problems, and has as its object to provide a traveling state detecting device capable of directly and almost real-time measuring the traveling direction of a moving body such as a shield machine. Is to do.

【0010】[0010]

【課題を解決するための手段】前記目的を達成するた
め、本発明は、移動体の姿勢方向を含む移動平面内での
加速度成分を、前記姿勢方向をはさんだ両側の領域に向
き、かつ互いに交叉する第1および第2の方向の加速度
成分として検出する第1および第2の加速度センサと、
前記第1および第2の方向への加速度成分に基づき、前
記第1および第2の方向への移動体の速度成分を演算す
る速度成分演算手段と、前記姿勢方向に対する第1およ
び第2の方向の交叉角と、前記第1および第2の方向へ
の移動体の速度成分とに基づき、移動体の進行方向を演
算する進行方向演算手段と、を含むことを特徴とする。
In order to achieve the above-mentioned object, the present invention is directed to a method in which an acceleration component in a movement plane including a posture direction of a moving body is directed to regions on both sides of the posture direction, and First and second acceleration sensors that detect as intersecting acceleration components in first and second directions;
Speed component calculating means for calculating a speed component of the moving body in the first and second directions based on the acceleration components in the first and second directions; and first and second directions with respect to the attitude direction And a traveling direction calculating means for calculating a traveling direction of the moving body based on the crossing angle of the moving body and the velocity components of the moving body in the first and second directions.

【0011】また、本発明は、シールド機の姿勢方向を
含む移動平面内での加速度成分を、前記姿勢方向をはさ
んだ両側の領域に向き、かつ互いに交叉する第1および
第2の方向の加速度成分として検出する第1および第2
の加速度センサと、前記第1および第2の方向への加速
度成分に基づき、前記第1および第2の方向へのシール
ド機の速度成分を演算する速度成分演算手段と、前記姿
勢方向に対する第1および第2の方向の交叉角と、前記
第1および第2の方向へのシールド機の速度成分とに基
づき、シールド機の進行方向を演算する進行方向演算手
段と、を含むことを特徴とする。
Further, according to the present invention, an acceleration component in a movement plane including a posture direction of a shield machine is directed to regions on both sides of the posture direction and intersects with each other in first and second directions. First and second components detected as components
An acceleration sensor, speed component calculating means for calculating a speed component of the shield machine in the first and second directions based on the acceleration components in the first and second directions, and a first component for the attitude direction. And a traveling direction computing means for computing the traveling direction of the shield machine based on the intersection angle of the shield machine in the second direction and the speed component of the shield machine in the first and second directions. .

【0012】ここにおいて、前記第1および第2の加速
度センサは、その第1および第2の方向と前記姿勢方向
とが鋭角的に交叉するよう形成することが好ましい。
Here, it is preferable that the first and second acceleration sensors are formed such that the first and second directions intersect the posture direction at an acute angle.

【0013】[0013]

【作用】本発明によれば、第1および第2の加速度セン
サを用い、移動体の加速度を、移動体の姿勢方向を介し
互いに交差する第1および第2の方向に向けた加速度成
分として検出している。
According to the present invention, the first and second acceleration sensors are used to detect the acceleration of a moving body as acceleration components directed in first and second directions intersecting each other via the posture direction of the moving body. doing.

【0014】そして、この第1および第2の方向への加
速度成分に基づき、これら第1および第2の方向への移
動体の速度成分を演算し、この速度成分をベクトル的に
合成することにより、移動体の進行方向を演算してい
る。
Then, based on the acceleration components in the first and second directions, the speed components of the moving body in the first and second directions are calculated, and the speed components are vector-wise synthesized. , The traveling direction of the moving object is calculated.

【0015】このように、本発明によれば、シールド機
などの移動体の実際の進行方向を複数の加速度成分から
ほぼリアルタイムで正確に検出することができる。
As described above, according to the present invention, the actual traveling direction of a moving body such as a shield machine can be accurately detected almost in real time from a plurality of acceleration components.

【0016】さらに、第1および第2の方向へ向けた移
動体の速度成分に基づき、これら第1および第2の方向
への移動体の移動距離成分を演算し、これを積算するこ
とにより、移動体の現在の進行位置を正確に検出するこ
とができる。
Further, based on the velocity components of the moving body in the first and second directions, the moving distance components of the moving body in the first and second directions are calculated, and these are integrated, whereby The current traveling position of the moving body can be accurately detected.

【0017】このように、本発明によれば、加速度セン
サを用いて移動体の実際の進行方向そのものを、例えば
図5に示すような姿勢方向100と進行方向200との
誤差や、移動体の平行移動等に影響されることなく、ほ
ぼリアルタイムで正確に測定することができる。
As described above, according to the present invention, the actual traveling direction of the moving object itself using the acceleration sensor is determined by, for example, an error between the attitude direction 100 and the traveling direction 200 as shown in FIG. The measurement can be performed accurately in almost real time without being affected by parallel movement or the like.

【0018】[0018]

【実施例】次に本発明の好適な実施例を図面に基づき詳
細に説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Preferred embodiments of the present invention will be described in detail with reference to the drawings.

【0019】図1には、本発明が適用されたシールド機
の好適な一例が示されている。実施例のシールド機10
は、カッターが設けられた面板12を回転駆動し切羽を
掘削していく。このシールド機10の姿勢方向100
は、面板12の回転軸と一致するように設定されてい
る。
FIG. 1 shows a preferred example of a shield machine to which the present invention is applied. The shield machine 10 of the embodiment
, A face plate 12 provided with a cutter is driven to rotate to excavate a face. Posture direction 100 of this shield machine 10
Is set to coincide with the rotation axis of the face plate 12.

【0020】そして、シールド機10は、その後端側
に、周方向に間隔をあけて複数のジャッキ14が設けら
れており、このジャッキ14によって、掘削坑の内周面
に取付け固定されたセグメント16に反力を与えること
により掘進方向へ向けた推力を得ており、また、各セグ
メント16からの反力を制御することにより、掘進方向
を変化させるように構成されている。
In the shield machine 10, a plurality of jacks 14 are provided at the rear end side of the shield machine 10 at intervals in the circumferential direction. , A thrust directed in the excavation direction is obtained by applying a reaction force to the excavation direction, and the excavation direction is changed by controlling the reaction force from each segment 16.

【0021】この様なシールド機10では、面板12の
回転方向や、切羽の土質状態によってシールド機10が
図5(A)に示すよう姿勢方向100と異なる方向20
0へ向け進行したり、あるいは同図(B)に示すよう横
すべりしたりすることがある。特にこのような現象は、
縦方向より、横方向へ向けて発生しやすい。このため、
実施例のシールド機10には、姿勢方向100を検出す
るジャイロ18と、実際の進行方向200を検出するた
めの3個の加速度センサ20,22,24とが設けられ
ている。
In such a shield machine 10, depending on the rotation direction of the face plate 12 and the soil condition of the face, the shield machine 10 has a direction 20 different from the attitude direction 100 as shown in FIG.
In some cases, the vehicle may move toward zero or slide as shown in FIG. Especially such a phenomenon,
It is more likely to occur in the horizontal direction than in the vertical direction. For this reason,
The shield machine 10 of the embodiment is provided with a gyro 18 for detecting a posture direction 100 and three acceleration sensors 20, 22, and 24 for detecting an actual traveling direction 200.

【0022】図2(A)には、前記3個の加速度センサ
20,22,24の取付け状態が示されている。姿勢方
向100を含むシールド機10の横方向(姿勢方向10
0が水平面内にある場合には水平方向)移動平面内にお
いて、第1および第2の加速度センサ20,22は、姿
勢方向100をはさんだ両側の領域に向き、かつ互いに
交差する第1および第2の方向110,120へ向けた
加速度α1 ,α2 を検出するように設置されている。こ
れら各加速度センサ20,22は、設置方向110,1
20へ向けた加速度成分のみを選択的に検出する単軸型
加速度計を用いることが好ましい。
FIG. 2A shows how the three acceleration sensors 20, 22, and 24 are mounted. Lateral direction of the shield machine 10 including the posture direction 100 (posture direction 10
In the movement plane, the first and second acceleration sensors 20 and 22 are directed to the regions on both sides of the posture direction 100 and intersect with each other in the movement plane. It is installed to detect accelerations α1, α2 toward two directions 110, 120. Each of these acceleration sensors 20, 22 has an installation direction 110, 1
It is preferable to use a single-axis accelerometer that selectively detects only the acceleration component toward 20.

【0023】また、姿勢方向100と直交する方向13
0への加速度成分は、比較的小さな値である。このた
め、これを通常感度の加速度センサを用いる場合には、
横方向130へ向けた加速度成分を、姿勢方向100へ
向けた大きな値の加速度成分と合成し、全体として比較
的大きな値としてピックアップすること好ましい。この
ため第1および第2の加速度センサ20,22は、横方
向130への加速度成分が検出できる範囲で、できるだ
け姿勢方向100へ近い方向へ向けて設置することが好
ましい。この設置角度θは、センサの検出感度等に応じ
て適宜変更されるが、実施例ではθ=5°に設定されて
いる。
A direction 13 perpendicular to the posture direction 100
The acceleration component to 0 is a relatively small value. Therefore, when using an acceleration sensor with normal sensitivity,
It is preferable that the acceleration component toward the lateral direction 130 is combined with the acceleration component having a large value toward the posture direction 100 and the whole is picked up as a relatively large value. For this reason, it is preferable that the first and second acceleration sensors 20 and 22 be installed in a direction as close as possible to the posture direction 100 as long as the acceleration component in the lateral direction 130 can be detected. The installation angle θ is appropriately changed according to the detection sensitivity of the sensor and the like, but is set to θ = 5 ° in the embodiment.

【0024】また、前記補助加速度センサ24は、姿勢
方向100に対し直交する横方向130へ向けた加速度
成分を検出するように設置されている。従って、この補
助加速度センサ24の検出加速度を、時間で2回積分す
ることによって、横すべり距離を検出することができ
る。なお、この補助加速度センサ24も、前記第1およ
び第2の加速度センサ20,22と同様、単軸型の加速
度計を用いて構成されている。
The auxiliary acceleration sensor 24 is installed so as to detect an acceleration component in a lateral direction 130 perpendicular to the posture direction 100. Therefore, the sideslip distance can be detected by integrating the detected acceleration of the auxiliary acceleration sensor 24 twice in time. The auxiliary acceleration sensor 24 is also configured using a single-axis type accelerometer, similarly to the first and second acceleration sensors 20 and 22.

【0025】以上の構成とすることにより、前記第1お
よび第2の加速度センサ20,22の検出する第1およ
び第2の方向110,120への加速度成分α1 ,α2
を時間で積分することにより、図2(B)に示すような
第1および第2の方向110,120へ向けた速度成分
v1 ,v2 を求めることができ、この速度成分ベクトル
をベクトル合成することにより、実際の進行方向200
へ向けた速度ベクトルVを求めることができる。
With the above configuration, the acceleration components α 1 and α 2 in the first and second directions 110 and 120 detected by the first and second acceleration sensors 20 and 22 are provided.
Is integrated over time, velocity components v1 and v2 directed to the first and second directions 110 and 120 as shown in FIG. 2B can be obtained. The actual traveling direction 200
The speed vector V toward can be obtained.

【0026】このように、実施例のシールド機10で
は、その実際の進行方向200を直接測定しているた
め、姿勢方向100と実際の進行方向200との間にず
れ角αが存在する場合でも、これに影響されることなく
進行方向200をリアタイム測定することが可能とな
る。
As described above, in the shield machine 10 of the embodiment, since the actual traveling direction 200 is directly measured, even if the deviation angle α exists between the attitude direction 100 and the actual traveling direction 200, It is possible to measure the traveling direction 200 in real time without being affected by this.

【0027】さらに、第1および第2の方向110,1
20への速度成分v1 ,v2 を時間積分し単位時間当た
りの移動距離成分を求め、このようにして求めた移動距
離成分ベクトルから実際の進行方向200へ向けた単位
時間当たりの移動距離を求め、これをベクトル情報とし
て積算していくことにより、シールド機10の進行経路
をリアルタイムで正確に把握することができる。
Further, the first and second directions 110, 1
The speed components v1 and v2 to 20 are time-integrated to obtain a moving distance component per unit time, and a moving distance per unit time toward the actual traveling direction 200 is obtained from the moving distance component vector thus obtained, By integrating this as vector information, the traveling path of the shield machine 10 can be accurately grasped in real time.

【0028】なお、加速度は、シールド機が等速になっ
たら測定できないと思われがちであるが、実際のシール
ド掘進は、シールド機10が脈動しながら進行するのが
一般であり、本実施例の装置を用いほぼリアルタイムで
かつ連続的に進行方向200を検出することができる。
Although it is often thought that the acceleration cannot be measured when the shield machine has a constant velocity, the actual shield excavation generally proceeds while the shield machine 10 pulsates. The traveling direction 200 can be detected almost in real time and continuously using the apparatus described above.

【0029】図3には、前記加速度センサ20,22,
24として用いられる単軸型加速度計の一例が示されて
いる。この加速度計は、図中横方向が検出加速度方向を
表す入力軸となっている。そして、この加速度計は、ハ
ウジング30内にフレキシャヒンジ32を介して入力軸
方向へ傾動自在に取り付けられたビーム34の偏位量
を、偏位ピックアップ36を用いて検出し、サーボアン
プ38を介して加速度信号として出力するように構成さ
れている。なお、同図において37はマグネット,39
はトルカコイルをそれぞれ表わしている。
FIG. 3 shows the acceleration sensors 20, 22,
An example of a single-axis accelerometer used as 24 is shown. In this accelerometer, the horizontal direction in the figure is an input axis indicating the detected acceleration direction. The accelerometer detects the amount of deflection of a beam 34 attached to the housing 30 via a flexure hinge 32 via a flexure hinge 32 so as to be tiltable in the direction of the input axis, using a deflection pickup 36, and controls the servo amplifier 38. It is configured to output as an acceleration signal via In the same figure, 37 is a magnet, 39
Represents a Toruca coil, respectively.

【0030】図4には、実施例のシールド機10に設け
られた進行状態検出装置のブロック図が示されている。
FIG. 4 is a block diagram of a traveling state detecting device provided in the shield machine 10 according to the embodiment.

【0031】第1および第2の加速度センサ20,22
および補助加速度センサ24を用い検出された各方向1
10,120,130の加速度成分α1 ,α2 ,α3
は、対応する速度演算部40,42,44で時間積分さ
れ、速度成分v1 ,v2 ,v3として出力される。
First and second acceleration sensors 20, 22
And each direction 1 detected using the auxiliary acceleration sensor 24
Acceleration components α1, α2, α3 of 10, 120, 130
Are time-integrated by the corresponding speed calculation units 40, 42, and 44 and output as speed components v1, v2, v3.

【0032】速度ベクトル演算部46は、第1および第
2の方向110,120へ向けた速度成分v1 ,v2
と,姿勢方向100に対する第1および第2の方向11
0,120の交叉角θとに基づき、速度成分v1 ,v2
をベクトル合成する。このように求めた速度ベクトルV
は、図2(B)に示すよう、実際の進行方向200へ向
けたシールド機の速度ベクトルであ。従って、この速度
ベクトルVから、進行状況演算部56はシールド機10
の実際の進行方向200をリアルタイムで把握すること
ができる。
The velocity vector calculator 46 calculates the velocity components v 1, v 2 in the first and second directions 110, 120.
And the first and second directions 11 with respect to the posture direction 100
Velocity components v1, v2 based on the crossing angle .theta.
Are vector synthesized. The velocity vector V thus obtained
Is a velocity vector of the shield machine in the actual traveling direction 200 as shown in FIG. Therefore, based on the velocity vector V, the progress calculation unit 56
Can be grasped in real time.

【0033】特に、図5(A)に示すようシールド機1
0の姿勢方向100と進行方向200とが異なる場合
や、同図(B)に示すようシールド機10が横すべりす
るような場合でも、進行状況演算部56は、入力される
速度ベクトルVからシールド機10の実際の進行方向2
00を、前記従来の誤差要因に影響されることなく、直
接かつリアルタイムで正確に把握することができる。
In particular, as shown in FIG.
In the case where the attitude direction 100 of 0 is different from the traveling direction 200, or in the case where the shield machine 10 slides as shown in FIG. 10 actual travel directions 2
00 can be accurately grasped directly and in real time without being affected by the conventional error factors.

【0034】また、前記速度演算部40,42で演算さ
れた第1および第2の方向110,120への速度成分
v1 ,v2 は、距離演算部48,50により時間積分さ
れ移動距離成分l1 ,l2 に換算される。移動距離演算
部54は、これら第1および第2の方向110,120
へ向けた移動距離成分l1 ,l2 をベクトル合成し、シ
ールド機10実際の進行方向200へ向けた単位時間当
たりの移動距離Lを演算し、これを進行状況演算部56
へ向け演算出力する。
The speed components v1 and v2 in the first and second directions 110 and 120 calculated by the speed calculation units 40 and 42 are time-integrated by the distance calculation units 48 and 50, and the moving distance components l1 and It is converted to l2. The moving distance calculation unit 54 calculates the first and second directions 110 and 120.
The moving distance components l1 and l2 toward the vector are synthesized, and the moving distance L per unit time toward the actual traveling direction 200 of the shield machine 10 is calculated.
Operation output to

【0035】従って、進行状況演算部56は、前述した
ように入力される速度ベクトルVと実際の単位時間当た
りの移動距離Lとに基づきシールド機10の掘進経路お
よび現在の座標位置をリアルタイムで演算出力する。
Accordingly, the progress calculation unit 56 calculates the excavation path of the shield machine 10 and the current coordinate position in real time based on the speed vector V and the actual moving distance L per unit time as described above. Output.

【0036】さらに、実施例では、速度演算部44の出
力する横方向130への速度成分v3 を横すべり量演算
部52で時間積分し、これを横方向130への横すべり
量l3 として進行状況演算部56へ向け出力する。従っ
て、進行状況演算部56は、速度ベクトル演算部46お
よび移動距離演算部54から入力されるデータに基づ
き、横方向130への移動距離を演算し、この移動距離
が横すべり量演算部52から演算出力される横すべり量
l3 と等しいかどうかを照合しながら、速度ベクトル演
算部46,移動距離演算部54の演算出力に誤差成分が
含まれていないか否かの監視をリアルタイムで行うこと
ができる。
Further, in the embodiment, the speed component v3 in the lateral direction 130 output from the speed computing unit 44 is time-integrated in the lateral slip amount computing unit 52, and this is calculated as the lateral slip amount l3 in the lateral direction 130. Output to 56. Therefore, the progress calculation unit 56 calculates the moving distance in the horizontal direction 130 based on the data input from the velocity vector calculating unit 46 and the moving distance calculating unit 54, and the moving distance is calculated by the side slip amount calculating unit 52. It is possible to monitor in real time whether or not an error component is included in the calculation outputs of the speed vector calculation unit 46 and the movement distance calculation unit 54 while checking whether the output is equal to the side slip amount l3.

【0037】さらに、実施例の装置では、ジャイロコン
パス18で検出されるシールド機10の姿勢方向100
が進行状況演算部56に入力されている。
Further, in the apparatus of the embodiment, the attitude direction 100 of the shield machine 10 detected by the gyro compass 18
Is input to the progress calculation unit 56.

【0038】そして、進行状況演算部56は、シールド
機10の実際の進行方向200、掘進経路および現在の
座標位置や、ジャイロコンパス18から入力されるシー
ルド機10の姿勢方向100などのデータをシールド制
御部58へ向け出力する。シールド制御部58は、この
ような入力データに基づきシールド機10の掘進方向お
よびその他の制御を行う。
The progress calculation unit 56 shields data such as the actual traveling direction 200 of the shield machine 10, the excavation route and the current coordinate position, and the attitude direction 100 of the shield machine 10 inputted from the gyro compass 18. Output to the control unit 58. The shield control unit 58 controls the direction of excavation of the shield machine 10 and other controls based on such input data.

【0039】特に、本実施例では、シールド機10の現
在の姿勢方向100と、実際の進行方向200とがリア
ルタイムで測定でき、しかも現在のシールド機10の座
標位置もリアルタイム演算できるため、シールド機制御
部58は、所定の目標経路に沿ってシールド機10が進
むよう、その方向を正確に制御することができる。
In particular, in the present embodiment, the current attitude direction 100 of the shield machine 10 and the actual traveling direction 200 can be measured in real time, and the current coordinate position of the shield machine 10 can be calculated in real time. The control unit 58 can accurately control the direction of the shield machine 10 so that the shield machine 10 advances along a predetermined target route.

【0040】なお、本発明は前記実施例に限定されるも
のではなく、本発明の要旨の範囲内で各種の変形実施が
可能である。
The present invention is not limited to the above embodiment, and various modifications can be made within the scope of the present invention.

【0041】例えば、前記実施例では、速度センサ2
0,22を姿勢方向100を含む横方向移動面内にのみ
設置した場合を例にとり説明したが、同様な構成の速度
センサを姿勢方向100を含む縦方向移動平面内(好ま
しくは、横方向移動平面と直交する面内)に、同様な手
法により設置し、進行状態検出回路を構成してもよい。
これにより、シールド機10の、横方向への進行方向の
みならず、縦方向への実際の進行方向もリアルタイムで
把握し、シールド機10をより正確に制御することが可
能となる。
For example, in the above embodiment, the speed sensor 2
Although the case where 0 and 22 are installed only in the horizontal movement plane including the posture direction 100 has been described as an example, a speed sensor having the same configuration is provided in the vertical movement plane including the posture direction 100 (preferably, the horizontal movement plane). (In a plane perpendicular to the plane) by a similar method to form a progress detection circuit.
Thereby, not only the traveling direction of the shield machine 10 in the horizontal direction but also the actual traveling direction in the vertical direction can be grasped in real time, and the shield machine 10 can be controlled more accurately.

【0042】また、前記実施例では、第1および第2の
加速度センサ20,22と、姿勢方向100との交叉角
を等しく設定したが、必要に応じ前記交叉角は異なる角
度に設定してもよい。
In the above-described embodiment, the intersection angle between the first and second acceleration sensors 20 and 22 and the posture direction 100 is set to be equal. However, if necessary, the intersection angle may be set to a different angle. Good.

【0043】また、前記実施例では、本発明の進行状態
検出装置をシールド機10の進行方向検出用に用いた場
合を例にとり説明したが、本発明はこれに限らずこれ以
外に各種の移動体、例えば船や車両などの移動体に対す
る進行状態検出装置としても幅広く適用することができ
る。
Further, in the above embodiment, the case where the traveling state detecting device of the present invention is used for detecting the traveling direction of the shield machine 10 has been described as an example, but the present invention is not limited to this, and other various moving The present invention can be widely applied as a traveling state detecting device for a body, for example, a moving body such as a ship or a vehicle.

【0044】[0044]

【発明の効果】以上説明したように、本発明によれば、
シールド機およびその他の移動体の進行方向を移動体の
姿勢方向と実際の進行方向とのずれなどに影響されるこ
となく、ほぼリアルタイムでかつ正確に測定することが
できる。
As described above, according to the present invention,
The traveling directions of the shield machine and other moving bodies can be measured almost in real time and accurately without being affected by the deviation between the attitude direction of the moving bodies and the actual traveling direction.

【0045】特に、本発明の装置を、シールド機の進行
方向検出用に用いることにより、従来のようにシールド
機の姿勢方向と実際の進行方向との誤差補正を定期的に
行う必要がなくなるため、装置全体を簡単かつ安価なも
のとし、シールド機の自動連続制御が可能となる。.
In particular, by using the apparatus of the present invention for detecting the direction of travel of the shield machine, it is not necessary to periodically correct the error between the attitude direction of the shield machine and the actual travel direction as in the prior art. In addition, the entire apparatus can be made simple and inexpensive, and automatic continuous control of the shield machine can be performed. .

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明が適用されたシールド機の概略説明図で
ある。
FIG. 1 is a schematic explanatory view of a shield machine to which the present invention is applied.

【図2】実施例のシールド機に設けられた加速度センサ
の配置およびこれら加速度センサを用いて行われる進行
方向検出原理の説明図である。
FIG. 2 is an explanatory diagram of an arrangement of acceleration sensors provided in the shield machine of the embodiment and a principle of detecting a traveling direction performed by using the acceleration sensors.

【図3】実施例に用いられる加速度センサの概略説明図
である。
FIG. 3 is a schematic explanatory view of an acceleration sensor used in the embodiment.

【図4】実施例のシールド機に設けられた進行状況検出
回路のブロック図である。
FIG. 4 is a block diagram of a progress detection circuit provided in the shield machine of the embodiment.

【図5】シールド機の姿勢方向と実際の移動方向とが異
なる場合の概略説明図である。
FIG. 5 is a schematic explanatory diagram when the attitude direction of the shield machine is different from the actual movement direction.

【符号の説明】[Explanation of symbols]

10 シールド機 20 加速度センサ 22 加速度センサ 40 速度検出部 42 速度検出部 46 速度ベクトル演算部 48 距離演算部 50 距離演算部 54 移動距離演算部 56 進行状況演算部 100 姿勢方向 110 第1の方向 120 第2の方向 200 進行方向 Reference Signs List 10 shield machine 20 acceleration sensor 22 acceleration sensor 40 speed detection unit 42 speed detection unit 46 speed vector calculation unit 48 distance calculation unit 50 distance calculation unit 54 moving distance calculation unit 56 progress calculation unit 100 attitude direction 110 first direction 120 first 2 direction 200 direction of travel

───────────────────────────────────────────────────── フロントページの続き (72)発明者 高橋 昭二 東京都中央区京橋1丁目7番1号 戸田 建設株式会社内 (72)発明者 伊藤 耕一 東京都中央区京橋1丁目7番1号 戸田 建設株式会社内 (72)発明者 樋口 忠 東京都中央区京橋1丁目7番1号 戸田 建設株式会社内 (72)発明者 柳楽 毅 東京都中央区京橋1丁目7番1号 戸田 建設株式会社内 (56)参考文献 特開 平4−237637(JP,A) 特開 昭63−19397(JP,A) (58)調査した分野(Int.Cl.6,DB名) E21D 9/06 301────────────────────────────────────────────────── ─── Continuing on the front page (72) Shoji Takahashi 1-7-1, Kyobashi, Chuo-ku, Tokyo Toda Construction Co., Ltd. (72) Koichi Ito 1-7-1, Kyobashi, Chuo-ku, Tokyo Toda Construction Inside (72) Inventor Tadashi Higuchi 1-7-1, Kyobashi, Chuo-ku, Tokyo Toda Construction Co., Ltd. (72) Inventor Takeshi Yagura 1-7-1, Kyobashi, Chuo-ku, Tokyo Toda Construction ( 56) References JP-A-4-237637 (JP, A) JP-A-63-19397 (JP, A) (58) Fields investigated (Int. Cl. 6 , DB name) E21D 9/06 301

Claims (2)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 シールド機の姿勢方向を含む移動平面内
での加速度成分を、前記移動平面内において姿勢方向を
はさんだ両側の領域に向き、かつ互いに交叉する第1お
よび第2の方向の加速度成分として検出する第1および
第2の加速度センサと、 前記第1および第2の方向への加速度成分に基づき、前
記第1および第2の方向へのシールド機の速度成分を演
算する速度成分演算手段と、 前記姿勢方向に対する第1および第2の方向の交叉角
と、前記第1および第2の方向へのシールド機の速度成
分とに基づき、シールド機の進行方向を演算する進行方
向演算手段と、 を含み、前記第1および第2の加速度センサは、 その第1および第2の方向を、前記移動平面内で前記姿
勢方向と直交する加速度成分が検出可能な角度範囲内
で、前記姿勢方向に近い方向に向けて設定されたこと
特徴とする進行状態検出装置。
An acceleration in a first plane and a second direction intersecting with each other in an area on both sides of a posture plane in a movement plane including a posture direction of a shield machine. First and second acceleration sensors detected as components, and speed component calculation for calculating speed components of the shield machine in the first and second directions based on the acceleration components in the first and second directions. Means, an intersection angle of the first and second directions with respect to the attitude direction, and a speed component of the shield machine in the first and second directions.
And a traveling direction computing means for computing a traveling direction of the shield machine based on the movement of the shield machine. The first and second acceleration sensors determine the first and second directions in the movement plane within the movement plane.
Within the angle range where the acceleration component perpendicular to the force direction can be detected
, The traveling state detection device being set to a direction close to the posture direction .
【請求項2】 請求項1において 、 前記第1および第2の方向への速度成分に基づき、シー
ルド機の進行方向への移動距離を演算する移動距離演算
手段と、 検出進行方向および検出移動距離とに基づき、シールド
の進行位置を演算する進行位置演算手段と、 を含むことを特徴とする進行状態検出装置。
2. The method of claim 1, based on the velocity component to the first and second directions, Sea
Moving distance calculating means for calculating the moving distance of the machine in the traveling direction, and shielding based on the detected traveling direction and the detected traveling distance.
And a traveling position calculating means for calculating a traveling position of the machine.
JP4326137A 1992-11-11 1992-11-11 Moving state detection device Expired - Fee Related JP2763464B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP4326137A JP2763464B2 (en) 1992-11-11 1992-11-11 Moving state detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP4326137A JP2763464B2 (en) 1992-11-11 1992-11-11 Moving state detection device

Publications (2)

Publication Number Publication Date
JPH06146781A JPH06146781A (en) 1994-05-27
JP2763464B2 true JP2763464B2 (en) 1998-06-11

Family

ID=18184468

Family Applications (1)

Application Number Title Priority Date Filing Date
JP4326137A Expired - Fee Related JP2763464B2 (en) 1992-11-11 1992-11-11 Moving state detection device

Country Status (1)

Country Link
JP (1) JP2763464B2 (en)

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6319397A (en) * 1986-07-11 1988-01-27 三井建設株式会社 Shield excavator
JPH04237637A (en) * 1991-01-18 1992-08-26 Hitachi Ltd Vehicle motion estimation device, method and vehicle control system

Also Published As

Publication number Publication date
JPH06146781A (en) 1994-05-27

Similar Documents

Publication Publication Date Title
US8209055B2 (en) System for sensing state and position of robot
US4507737A (en) Heading reference and land navigation system
US4743913A (en) Hybrid navigation system for determining a relative position and direction of a vehicle and method therefor
CN103335647B (en) A kind of attitude of shield machine measuring system and measuring method thereof
US5317515A (en) Vehicle heading correction apparatus
US5235514A (en) Apparatus for estimating current heading using magnetic and angular velocity sensors
EP1315945B1 (en) Calibration of multi-axis accelerometer in vehicle navigation system using gps data
US8930138B2 (en) North finder
JPH01219610A (en) Running azimuth detector for vehicle
JPH04238216A (en) How to calculate the gyro scale factor
JPS5834483A (en) Mobile object current position display device
US7032450B2 (en) Method and apparatus for measuring speed of land vehicle using accelerometer
JPH04113218A (en) Relative bearing detection system
JP2763464B2 (en) Moving state detection device
CA1251563A (en) Doppler-inertial data loop for navigation system
RU2539131C1 (en) Strapdown integrated navigation system of average accuracy for mobile onshore objects
JP3338249B2 (en) Moving object traveling acceleration calculating device and moving object position / velocity calculating device using the device
EP1206683B1 (en) Integrated inertial/vms navigation system
JP2866078B2 (en) Excavation propulsion position detecting device and position detecting method
JP2023101310A (en) Calculation method of calibration value
JP3772806B2 (en) Magnetic orientation detection method and magnetic orientation detection method
JP3551663B2 (en) Navigation device
JPH03154820A (en) Vehicle position detection device
JP3045458B2 (en) Automatic surveying method of shield machine
US9785151B1 (en) Machine and navigation control strategy including velocity calculation

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 19980303

LAPS Cancellation because of no payment of annual fees