JPS60102580A - 走行ユニツト等の位置検出装置 - Google Patents

走行ユニツト等の位置検出装置

Info

Publication number
JPS60102580A
JPS60102580A JP58211279A JP21127983A JPS60102580A JP S60102580 A JPS60102580 A JP S60102580A JP 58211279 A JP58211279 A JP 58211279A JP 21127983 A JP21127983 A JP 21127983A JP S60102580 A JPS60102580 A JP S60102580A
Authority
JP
Japan
Prior art keywords
receiver
unit
distance
machine
base
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
JP58211279A
Other languages
English (en)
Inventor
Toshihiko Sasahara
利彦 笹原
Toshio Nakamura
寿夫 中村
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.)
IHI Corp
Original Assignee
Ishikawajima Harima Heavy Industries Co 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 Ishikawajima Harima Heavy Industries Co Ltd filed Critical Ishikawajima Harima Heavy Industries Co Ltd
Priority to JP58211279A priority Critical patent/JPS60102580A/ja
Publication of JPS60102580A publication Critical patent/JPS60102580A/ja
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/06—Systems determining the position data of a target
    • G01S15/08—Systems for measuring distance only

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Acoustics & Sound (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

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

Description

【発明の詳細な説明】 本発明は無軌道走行ユニットまでの距離および方位を音
波と光との組み合わせによって検出するようにした位置
検出装置に関するものである。
無軌道走行ユニットは、あらかじめ0定されたプログラ
ムあるrは無線銹導などにより、走行支持面に沿って任
意の各方向に走行自在なものとされており、また、走行
支持面が鋼板などであるとマグネツtなどを利用するこ
とにより、傾斜あるいは垂直方向にも走行可能となる。
したがって、原子炉運転開始後における諸機器1例えば
原子炉圧力容器などの点検作業のように、高レベルの残
留放射線のために作業員が近づくことが制限される環境
下で、作業用機器を目的とする位置まで運搬したり、あ
るいは自由に移動させたりする場合に有用である。また
、無軌道走行エニン)を自在にコントa−ルするために
は、その位置feえず正確に検出することが必要であり
、無軌道走行エニンFに適用し得る位置検出法の従来例
としては。
可逆式のオドメータ(歩度計)を利用して基準点からの
距離を知る方法や、オドメータに角度センサを組み合わ
せて距離と方位とを知る方法などがあるが、オドメータ
の場合、走行ユニットが非直線状に移動したり、スリッ
プが発生したりすると誤差が大きくなるなどの難点があ
る。
本発明はこのような背景に基づいてなされたもので1位
置検出精度を飛躍的に向上させることを可能とし、高速
度検出により走行エニツYの移動?容易にし、また、検
出範囲?大きくすることを目的としている。このような
目的の達成のため。
本発明は、基準点Vcf+)る親機と走行エニツFに塔
載する子機とに、音波および光線により距離および方位
を直接測定する極座標方式の各センサを設けた構成とな
っている。
以下1本発明の一実施例を図面に基づいて説明すると、
第1図は原子炉圧力容器1の外表面に無軌道走行エニツ
)2と本発明に係る位置検出装置3とを配設した外観の
概略を示すものである。
無軌道走行ユニット2は、その車輪の一部が磁石となっ
ていて1通常垂直となっている原子炉圧力容器lの外表
面に磁着した状態で任意の方向に移動し得る機能(移動
方向、起動停止などの各指令を受ける有線または無線受
信装置、駆動装置。
ステアリング装置など)f:備えているものが使用され
る。
また、位置検出装置3は、第1図ないし第3図例では原
子炉圧力容器1の外表面に垂直方向に沿って覗9つけら
れた基準軌道4と、この基泡軌道4の一点、すなわち基
準点に配設される親機5と、この親機5から離間した位
置で各種作業のための走行運転がなされる前記無軌道走
行ユニット2上に塔載されるとともに親機5との間で距
離および方位を合わせた位置検出を行なうための子機6
とからなる基本構成とされているう まず、前記基準軌道4について説明すると、基準軌道4
は、親機5を原子炉圧力容器lの外表面に沿って水平ま
たは垂直(鉛直)方向に案内し。
基準点を設定するものであり、第1図例では新機5を上
下に移動させるために親機5のビニオン(図示略)と噛
合するラックを備えており、また。
ピニオンの回転をエンコーダ等で検出して、基準軌道4
の任意の位置を基準点として設定し得るようになってい
る。
次いで、前記親機5は、基準軌道4に支持されて移動す
るベース7の上にターンテーブル8が回転自在に設けら
れるとともに、ベース7とターンテーブル8との間に、
ターンテーブル8を例えば2.5″/ 秒程度の角速度
で低速回転させるために駆動モータ9.ウオーム10.
ホイール11などからなる回転駆動機構と、ターンテー
ブル8の回転角を例えばO,Ql”の分解能で検出する
ためのa−夕II−エンコーダ12と、ターンテーブル
8の回転角?3606未溝1例えば270“とじてロー
タリーエンコーダ12の出力信号との比較により親機5
自身の向きを検出するためのリミットスイッチ13とが
設けられ、4−ンテーブル8の上に、基準軌道4上に停
止したときに任意の回転角を0°として(第1図例にお
けるI−:/テーブル8の一部を垂直方向に向けて)こ
のときのa −タリーエンコーダ】2の出力信号を基準
角とするために使用される垂直センサ14と、子機6の
方位を検出する方位センサの一部をm成する受光部15
と、子機61での距離などを検出する距離センサの−f
lSf構成しかつ例えば1メガH2の超音波などを発音
する音波発生器16と、この音波発生器16から一定距
離(例えば100鵡)離間した位置で音波を受信しその
到達時間を基準値とするための較正用受信機17とがそ
れぞれ設けられる。そして、受光器15の光学的基準中
心点と音波発生器16の発音中心点とは、望ましくは基
準点、つまりターンテーブル8の回転中心線上の所要高
さく例えば20011m)に設定され、基準点と位置ず
れがある場合は1機械的な位置すれとロータリーエンコ
ーダ12の角度検出信号とにより、ベース7あるいは外
部に設けられた制御部(中央処理装置など)により補正
されるものである。ただし、以下の説明では説明を簡略
化するため方位センサおよび距離センサとターンテーブ
ル8の回転中心とが第3図に示すように一致しているも
のとして説明する。
一方、前記子機6は、無軌道走行エニツ)2と一体に取
りつけられるベース18が設けられるとともに、このベ
ース18の上にターンテーブル19が回転自在に設けら
れ、これらベース18とターンテーブル19との間に、
ターンテーブル19を回転させるための駆動モータ20
.ウオーム21.ホイール22などからなる回転駆動機
構と、ターンテーブル19の回転位置を検出するととも
にその検出信号によりターンテーブル19の゛特定部分
を親機5に正対させるためのポテンショメータ23とが
設けられ%また。ターンテーブル19の上には、親機5
の受光器15とともに方位センサを構成するためのレー
ザービームなどを発生する発光器24と、この発光器2
4g回転自在に支持するための回転灯台25?ターンテ
ーブル19の回転中心線上で例えば3110 Or、p
、m 程度の高速回転させる九めの駆動モータ26.ベ
ルト27、ブーII 2 B 、 29などからなる高
速回転ffIk構と1発光器24の頂部に叡りっけられ
九tツブミラー30と、親機5の音波発生器16ととも
に距離センサを構成しかつ音波の到達時間により親機5
の基準点までの距離を算出するための音波受4m機31
とがそれぞれ設けられる。そして、発光器24の光学的
中心点と音波受信機31の受音中心点とは、望ましくは
ターンテーブル19の回転中心線上の所要高さく例えば
親機同様200111)に設定され、ずれのある場合は
前述の例の舶く補正される。以下の説明では第3図に示
すように中心線上にあるものとして説明する。
次いで、方位センサおよび距離センサの所要高さく例え
ば200mに設定した理由)について説明すると、第1
図に示すように原子炉圧力容器1は円筒状であるため、
その外e面にある親11*5で子機6を検出する場合、
その検出範囲が、透視で制限を受けることになる。すな
わち、原子炉圧力容器1の直径が6.5ta、*i5と
子機6との間隔を2.3Sとすると、 すなわち、約200錦の高さに各センナが配設されてい
る場合は、親機5と子Il!6との周方向の距離が2.
3騙以内に制限を受けることになる。なお、高さ方向に
は特に制限がない。
また、親機5と子t86との間隔分2.3隅以内と限定
した場合、距離および方位を例えば誤差1mm以下で検
出するとすれば、距離および方位センサに要求される分
解能は以下のとおりとなる。
「距離センサ」 音波は波形が明確で立上り特性の優れているものがよく
1例えば1メガヘルツ(111i)I7)の超音波が適
用され、音波受信機31がその第1波のどこD)を検出
し得る性能を有しているとすれば、その検出誤差はlX
10””秒1■に音波が伝達される距離となり、15℃
のときは、 340XIXlO−’=3.4X10−’FB=0.3
4騙となる。この場合、較正用受信機17については、
基準となる音波到達時間の検出を行なう部会上。
一実施例の場f、音波の第1波あるいは第2波のスレシ
ョルドレベルを越えた直後の零クロス点相互の検出を行
なうようにして正確化をしているが、これらは必要とさ
れる分解能により適宜選定されろ。なお、音波発生器1
6および較正用受信機17%音波発生器IGおよび音波
受信機31の音波伝達時間は、それぞれ2 o 5ii
i、およびIMHの計測用りaツクを・基準とし11t
測するなどにより、前記誤差範囲を満足することができ
るものである。
「方位センサ」 受光器15は、前述したようにその角度分解能が0.0
1’である場会、コリメータなどが使用されるが、距離
2300FJの位置であるとその振れは。
となって1u以下の誤差に押えることができる。
なお%受光器15はコリメータに限定するものではなく
1例えば、高性能を有する元し変換素子、の1次元哉半
導体装置検出器が適用可能であり。
この場合、直線的に移動する光スボツFの位1it1f
r連続した電気信号として出力させ、素子の両端の電価
と)tスポットの距離に応じて光電流が按分されてスポ
ットの位置を例えば34■の範囲に亘って検出し得るよ
うになる。
このような構成を有する走行ユニットの位置検出装置の
使用例について以下説明する。
「基漁点の設定」 ?&単軌道4を原子炉圧力容器1の外表面に第1図に示
すように配設し、基準軌道4と親機5との相対位置等に
より、原子炉圧力容器lの一点を基醜点とし、以下、子
機6の位置を検出する。
「ターンテーブルの設定」 親t(!5のターンテーブル8を回転させて垂直センナ
14が動作した位置を回転角の基意とし、以下、この回
転角の基準値に対する子機6の方位をロータリーエンコ
ーダ12によって検出することになる。
「子機の向きの設定」 親機5の音波発生器16から超音波を発信し。
子機6のターンテーブル19を回転させながら。
音波受信機31が音波発生機16に対向する位置を例え
ば音波の強弱で探し出す。このとき、音波受信機31の
マイクの性能が第2図に示すように有効範囲30°であ
れば、そのは!中心で最も感度の高い部分が検出される
ため、このときのターンテーブル190回転角をポテン
ショメータ23で読み取り、この回転角のときの音波受
信信号により距離の検出を実施する。あるいは、超音波
を検出できる範囲をポテンショメータ23で検出して、
その中心を算出しこの回転角のときに距離の検出を実施
し九り、あるいは、子機6のターンテーブル19を間欠
的に回転させて、親機5の方位を探し出すようにするこ
ともできる。
「距離の測定」 音波発生器16と較正用受信機17と音波受信機31と
をそれぞれ動作状態とすると、原子炉圧力容器1の表面
付近の任意の雰囲気条件における音波到達時間により、
親機5と子機6との対向距離を温度や空気密度等に影響
されることなく高い精度で検出できる。すなわち、較正
用受信機17までの音波伝達時間ftT、、子機6の音
波受信機31までの音波伝達時間をTI、較正用受信機
17までの距離をL8 とすれば、音波受信8!31ま
での距離、すなわち子機6までの距@L□は。
で単純にめることができる。なお、常温の空気中の音速
は、温度が1℃変化する毎に約0.6島増減するため、
0.181/’O程度の誤差を生じるが。
較正用受信機31を利用して周囲の影/#ヲ除去するこ
とによシ、その誤差の生じない距離検出を行なうことが
できる。
ま皮、音波発生器16の動作は、音波伝達時間の測定の
便を考lして間欠的に行なわれるが、その時間的な間隔
は無軌道走行ユニット2の走行速度によシ調整されるも
のである。
「方位の測定」 発光器24と受光器15とをそれぞれ運転状態としてお
いて11回転灯台25t3000rpm 程度の高速回
転することにより、毎秒50回程度の間隔でレーザービ
ームが受光器15を照射する。
このとき、低速回転させられているターンテーブル8上
の受光器15が、正確に発光器24の1ツブミラー30
に対向した瞬間の回転角をロータリーエンコーダ1zに
よって検出することにより。
子機6の方位をめることができる。なお、ロータリーエ
ンコーダ12は角度分解能0.01’のときは例えば2
0ビット程度のものが適用される。
「音波受信機の微V@整」 方位の測定がなされた瞬間のタイミングに合わせて、距
離の測定を実施することにより、走行エニッ)2の位置
の検出を瞬時に正確に行なうことができるものであるが
、走行ユニット2の移動にともなって子機6の音波受信
機31の向きが賃波発生器16から徐々に外れることも
予想される。
この場合、親機5のロータリーエンコーダ12による方
位測定が順次行なわれるから、音波受信機31の向きが
その有効範囲外とならないように。
方位の検出データに基ずいて補正信号をポテンショメー
タ23に伝達し、駆動モータ20などを間欠的に運転し
て、正しい向きに順次補正するととができる。
「親錯の駆動」 親+95のターンテーブル8は、例えば当初270の範
囲で一転方向を反転させる、つまり、揺動させるように
して、その揺動の途中で受光器15を発)を器24に正
確に対向させる(正対させる)瞬間を確実に作り出すよ
うにしているが、子e6の方位′f1度検出すると、そ
の検出データを使用し得るため、浮動範囲を小さくした
#)揺動周期を早めたりすることにより、距離検出の方
の時間的間隔分小さくしたり、あるいは音波受信機の受
信有効範囲で揺動させることにより連続検出ケ行なうこ
とができる。
なお、各センサの配置は一実施例に限定するものではな
く、親機5および子機6に塔載されている発光器24.
受光器15.音波発生器16.音波受信機31などはそ
の配置を逆にすることが可能である。
し1】)シて、本発明によれば以下のような効果を奏す
るものである。
■ 距離測定に音波を利用するとともに方位測定に光、
レーザービームなどを利用することにより、原子炉圧力
容器表面のように非平面上の走行ユニットの位置を例え
ば1間程度の誤差精度で検出することができる。
■ 受光器を回転させその途中で方位を測定することに
より、親機および子機の正対する瞬間を作り方位検出精
tin向上させるとともに1位置検出範囲を拡大させる
ことができる。
■ 方位センサによる間欠的な検出と距離センサとの検
出タイミングを一致させることにより。
瞬間的な位置検出を容易にし、また、移動状態の走行ユ
ニットの位置を間欠的に検出して追従することができる
。
【図面の簡単な説明】
図面は本発明の一実施例を示すもので、第1図は原子炉
圧力容器への適用例の一部切欠外観斜視図、第2図は親
機と子機との関係モデル図、第3図(A)、(B)は親
機5および子機の斜視図、第4図は方位センサおよび距
離センサの所要高さの説明図である。 1・・・・・・原子炉圧力容器、2・・・・・・無軌道
走行エニツF、3・・・・・・位置検出装置、4・・・
・・・基準軌道、5・・・・・・親機、6・・・・・・
子機、7・・・・・・ベース、8・・・・・・ターンテ
ーブル、9・・・・・・駆動モータ、12・・・・・・
ロータリーエンコーダ、15・・・・・・受光器、16
・・・・・・音波発生器、17・・・・・・較正用受信
機、1B・・・・・・ペース。 19・・・・・・ターンテーブル%20・・・・・・m
<動モータ。 23・・・・・・ポテンショメータ、24・・・・・・
発光器、25・・・・・・回転灯台、2G・・・・・・
Ml動−e−タ、30・・・・・・1ツブミラー、31
・・・・・・音波受信機。 出願人 石川島播磨重工業株式会社 代理人 弁理士 志 賀 正 慾 、゛)ゝ・、:L、
、、; 第3@ 23 第4図

Claims (1)

    【特許請求の範囲】
  1. 基醜点上に位置させられる親機と、該親機と離間した位
    置で移動させられる走行エニンを等に塔載される子機と
    を備え、これら親機および子機の一方に音波発生器、他
    方に該音波発生器からの音波伝達時間全検出して離間距
    離を算出するための音波受信機を設けるとともに、前記
    親機および子機のいずれか一方に発光器、他方に該発光
    器からの到達光により方位を算出するだめの受光器を配
    設したことを特徴とする走行ユニット等の位置検出装装
    置。
JP58211279A 1983-11-10 1983-11-10 走行ユニツト等の位置検出装置 Pending JPS60102580A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP58211279A JPS60102580A (ja) 1983-11-10 1983-11-10 走行ユニツト等の位置検出装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP58211279A JPS60102580A (ja) 1983-11-10 1983-11-10 走行ユニツト等の位置検出装置

Publications (1)

Publication Number Publication Date
JPS60102580A true JPS60102580A (ja) 1985-06-06

Family

ID=16603290

Family Applications (1)

Application Number Title Priority Date Filing Date
JP58211279A Pending JPS60102580A (ja) 1983-11-10 1983-11-10 走行ユニツト等の位置検出装置

Country Status (1)

Country Link
JP (1) JPS60102580A (ja)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63187111A (ja) * 1987-01-30 1988-08-02 Jgc Corp 移動ロボツトの位置測定装置
JPS63297178A (ja) * 1987-05-27 1988-12-05 Tokyo Keiki Co Ltd 壁面走行車の方向検出装置
JPS6416909A (en) * 1987-07-13 1989-01-20 Kumagai Gumi Co Ltd Method and device for detecting installation position of section measuring instrument
DE4022152A1 (de) * 1989-07-14 1991-01-24 Hitachi Ltd Vorrichtung und verfahren zur entfernungsmessung
JP2005055398A (ja) * 2003-08-07 2005-03-03 Toshiba Corp 原子炉内位置測定装置
JP2005300266A (ja) * 2004-04-08 2005-10-27 Toshiba Corp 原子炉検査・補修ロボットの位置決め装置
US7286902B2 (en) 2003-07-23 2007-10-23 Lg Electronics Inc. Method and apparatus for detecting position of mobile robot
JP2018535410A (ja) * 2015-12-23 2018-11-29 ノロ カンパニー リミテッド 3次元空間検出システム、測位方法及びシステム

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58155377A (ja) * 1982-03-10 1983-09-16 Akai Electric Co Ltd 位置検出装置

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58155377A (ja) * 1982-03-10 1983-09-16 Akai Electric Co Ltd 位置検出装置

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63187111A (ja) * 1987-01-30 1988-08-02 Jgc Corp 移動ロボツトの位置測定装置
JPS63297178A (ja) * 1987-05-27 1988-12-05 Tokyo Keiki Co Ltd 壁面走行車の方向検出装置
JPS6416909A (en) * 1987-07-13 1989-01-20 Kumagai Gumi Co Ltd Method and device for detecting installation position of section measuring instrument
DE4022152A1 (de) * 1989-07-14 1991-01-24 Hitachi Ltd Vorrichtung und verfahren zur entfernungsmessung
US5122991A (en) * 1989-07-14 1992-06-16 Hitachi, Ltd. Distance measuring apparatus and method
US7286902B2 (en) 2003-07-23 2007-10-23 Lg Electronics Inc. Method and apparatus for detecting position of mobile robot
JP2005055398A (ja) * 2003-08-07 2005-03-03 Toshiba Corp 原子炉内位置測定装置
JP2005300266A (ja) * 2004-04-08 2005-10-27 Toshiba Corp 原子炉検査・補修ロボットの位置決め装置
JP2018535410A (ja) * 2015-12-23 2018-11-29 ノロ カンパニー リミテッド 3次元空間検出システム、測位方法及びシステム

Similar Documents

Publication Publication Date Title
US5745225A (en) Apparatus for measuring a shape of road surface
JP2542653B2 (ja) 非接触倣い方法
JPH11183234A (ja) 超音波式液面測定装置
JP2738751B2 (ja) 走行制御装置
JPS6344122A (ja) 自走作業台車位置計測方法
JPH0244166Y2 (ja)
JP2552201Y2 (ja) スクリーンの視野角測定装置
JPH09184720A (ja) 測地測量方法及び測地測量装置
JPS60138458A (ja) 潜水設備
JPH0651050A (ja) 移動体の姿勢及び3次元位置測定装置
JPH11325892A (ja) 路面形状測定装置
JPH0439710A (ja) 自動墨出し装置
JPS5927841B2 (ja) 変位姿勢測定装置
JPS60178373A (ja) 移動体における障害物等検出方法
JPH05172516A (ja) 移動体の位置・姿勢自動計測装置および自動計測方法
JP2784480B2 (ja) 移動物体の2次元位置および方向計測装置
JPS62287107A (ja) 中心位置測定装置
JPS60102514A (ja) 走行ユニツト等の位置検出装置
JPS60178374A (ja) 物体検出装置
JPS60233710A (ja) 移動機械の誘導装置
JPS63187111A (ja) 移動ロボツトの位置測定装置
JP2800922B2 (ja) 移動体の測距装置
SU1240838A1 (ru) Устройство контрол заданного курса движени дорожно-строительной машины
JPH06147911A (ja) 移動ロボットの方向補正装置
JPS58198779A (ja) 超音波センサ−装置