JPS6153506A - Method and apparatus for detecting position - Google Patents

Abstract

PURPOSE:To make it possible to simply and easily detect the two-dimensional positional deviation of an object as an absolute amount without requiring the processing of enormous information, by arbitrarily indicating the point of the object taken in from an image input system and displayed on a display picture on an image. CONSTITUTION:An object 6 is caught by an image input system 1 such as an ITV camera or optical fiber and the image thereof is displayed on monitor 5 while the distance from the leading end of the image input system 1 to the object 6 is measured by a distance measuring means 2 suc as an ultrasonic sensor to be applied to an operation means 4. If an operator allows a pen chip to press the point on the punctural coordinates input means 3 corresponding to the measuring point in a display picture in this state, the positional deviation from the point predetermined by an operation means or the reference point indicated by the punctual coordinates input means 3 can be easily and simply detected as an absolute amount.

Description

【発明の詳細な説明】 〔発明の利用分野〕 本発明は、対象物の二次元位置偏差を絶対量で検出する
だめの方法とその装Ｈ７Ｃ関するものである。DETAILED DESCRIPTION OF THE INVENTION [Field of Application of the Invention] The present invention relates to a method and an apparatus H7C for detecting two-dimensional positional deviation of an object in absolute quantities.

〔発明の背景〕[Background of the invention]

一般に画像認識等の技術を用いるこれまでの位置検出に
おいては、基準としてのものさしに対する比率といった
形で位置偏差が表現されていることから、相対的な比率
を絶対量に換算する必要がある。このため、得られた位
置偏差を制御量として装置本体を駆動する場合、計測点
までの距離を一定に保ち位置偏差の相対量を絶対量に換
算する必要がある。したがって、位置検出方式としては
自動的に位置検出を行なうべく画像をそっくり情報とし
て取シ込んでの膨大な情報処理を避は得ないでいるのが
実状である。取り込まれる画像自体にしても検出に適し
たものとして得るためには照明等の問題を克服しなけれ
ばならず、十分な条件が得られない場合は更に画像処理
によって検出に適した画像にしなければならないものと
なっている。これがために演算ユニットとしては複雑な
ものにならざるを得ないというものである。Generally, in conventional position detection using techniques such as image recognition, positional deviation is expressed in the form of a ratio to a standard ruler, so it is necessary to convert the relative ratio into an absolute amount. Therefore, when driving the apparatus main body using the obtained positional deviation as a control variable, it is necessary to keep the distance to the measurement point constant and convert the relative amount of the positional deviation into an absolute amount. Therefore, in order to automatically detect a position, the position detection method inevitably requires a huge amount of information processing by importing the entire image as information. In order to obtain the image itself suitable for detection, problems such as lighting must be overcome, and if sufficient conditions cannot be obtained, further image processing must be performed to make the image suitable for detection. It has become something that cannot be done. For this reason, the arithmetic unit has to be complicated.

一方、例えばＣＲＤ　（Ｃｏｎｔｒｏｌ　３ｏｄ、［）
ｒｉｖｅｍｅｃｈａｎｉｓｒｎ　　：制御棒駆動機構）
交換装置においては、ＣＲＤとＣＲＤを取シ外すだめの
着脱ヘッドとの位置決めをほぼ自動化し庭とはいえ、最
終的なインチングは目視確認に頼っているのが現状であ
り、作業者に対する放射線被曝の量が多いのみならず作
業工数も依然として他作業に比して多いものとなってい
る。これがために完全遠隔自動化を図ることが強く要望
されているのが実状である。この要望に厄えるべく完全
遠隔自動化の開発が進められ画像認識等の技術が取）入
れられているわけであるが、上記したように画像認識・
画像処理ては膨大な情報処理が要され装置として複雑な
ものになってしまうというもめである。On the other hand, for example, CRD (Control 3od, [)
rivemechanisrn: control rod drive mechanism)
In exchange equipment, the positioning of the CRD and the attachment/detachment head for removing the CRD is almost automated, but the final inching still relies on visual confirmation, which reduces radiation exposure to workers. Not only is there a large amount of work involved, but the number of man-hours required is still greater than other tasks. For this reason, there is a strong demand for complete remote automation. In order to meet this demand, development of complete remote automation is progressing and technologies such as image recognition are being incorporated.
The problem with image processing is that it requires a huge amount of information processing, making the device complex.

〔発明の目的〕[Purpose of the invention]

本発明の目的は、膨大な情報処理を要することなく簡単
容易に対象物の二次元位置偏差を絶対量で検出し得る位
置検出方法とその装置を供するにある。゛ 〔発明の概要〕 この目的のため本発明は、画像入力系の視野角が既知で
あればその画像入力系先端より対象物までの距離より視
野径が求められることに着目し、その距離と表示された
対象物の画像上における指定された点の座標とから予め
定められた点、あるいは指定された基準点からの位ｉ面
偏差を絶対量として求めるようにしたものである。また
、本発明は、対象物の画像を取シ込み画面上に表示する
画像入力表示手段と、画像入力系先端から対象物までの
距離を計測する距離計測手段と、対象物の画像が表示さ
れる画面上に取付され、外部操作によって指定された表
示画像上の点の座標を出力する点座標入力手段と、距離
計測手段、点座標入力手段それぞれからの距離情報、座
標情報にもとづいて位置偏差を求めるべく演算を行なう
演算手段とによって位置偏差が求められるべくなしたも
のである。SUMMARY OF THE INVENTION An object of the present invention is to provide a position detection method and apparatus that can easily and easily detect the two-dimensional position deviation of an object in absolute quantities without requiring extensive information processing. [Summary of the Invention] For this purpose, the present invention focuses on the fact that if the viewing angle of the image input system is known, the field of view diameter can be determined from the distance from the tip of the image input system to the object. The position i-plane deviation from a predetermined point or a designated reference point is determined as an absolute amount from the coordinates of a designated point on the displayed image of the object. The present invention also provides image input and display means for capturing an image of the object and displaying it on a screen, distance measuring means for measuring the distance from the tip of the image input system to the object, and a means for displaying the image of the object. A point coordinate input means is attached to the display screen and outputs the coordinates of a point on the display image specified by an external operation, and the position deviation is calculated based on the distance information and coordinate information from the distance measurement means and the point coordinate input means respectively. The positional deviation is determined by means of calculation means that performs calculations to determine the positional deviation.

〔開明の実施例〕[Example of enlightenment]

以下、本発明を第１図から第１７図によシ説明する。 The present invention will be explained below with reference to FIGS. 1 to 17.

先ず本発明を具体的に説明する前に第１図、第２図によ
りその概要を説明しておく。第１図は本発明による位置
検出装置の概要構成を示したものである。図示の如く対
象物６はＩＴＶカメラや光ファイバなどの画像入力系１
によって捉えられその画像はモニタ５に表示される一方
、画像入力系１先端から対象物６までの距離は超音波セ
ンサなどの距離計測手段２によって計測されたうえ演算
手段４に与えられるものとなっている。このような状態
でオペレータが表示画面内の計測点に対応する点座標入
力手段３上の点をペン先などで押すようにすれば、その
点のＸＹ座標が演算手段４に与えられるところとなるが
、これによシ演算手段４では予の点の予め定められた点
、あるいは点座標入力手段３上より指定された基準点か
らの位置偏差が求められるものである。なお、点座標入
力手段は具体的には透視を指タツチ入力装置と称されて
いるものを用い得る。First, before specifically explaining the present invention, an outline thereof will be explained with reference to FIGS. 1 and 2. FIG. 1 shows a schematic configuration of a position detection device according to the present invention. As shown in the figure, the object 6 is an image input system 1 such as an ITV camera or an optical fiber.
While the image is captured by and displayed on the monitor 5, the distance from the tip of the image input system 1 to the object 6 is measured by distance measuring means 2 such as an ultrasonic sensor and is then provided to calculation means 4. ing. In this state, if the operator presses a point on the point coordinate input means 3 corresponding to a measurement point on the display screen with a pen tip, the XY coordinates of that point will be given to the calculation means 4. However, the calculation means 4 calculates the positional deviation from a predetermined point or a reference point designated from the point coordinate input means 3. In addition, as the point coordinate input means, specifically, what is called a perspective finger touch input device may be used.

ここで相対比率として求められた位置偏差の絶対量への
換算について説明すれば、第２図に示すように画像入力
系１の視野角θが既知である場合、距離計測手段２より
得られる対象物６ま−での距離ｔよ多視野径ｒが求めら
れるものとなっている。Here, to explain the conversion of the positional deviation found as a relative ratio into an absolute amount, if the viewing angle θ of the image input system 1 is known as shown in FIG. The distance t to the object 6 and the multi-field diameter r are determined.

点座標入力手段からのＸＹ座標より得られる位置偏差の
相対比率は視野径ｒを用い絶対量に換算され得るもので
ある。The relative ratio of the positional deviation obtained from the XY coordinates from the point coordinate input means can be converted into an absolute amount using the visual field diameter r.

さて、本発明をＣＲＤ交換の際での位置決め；■制御に
その例を採って詳細、且つ具体的に説明すれば以下のよ
うである。Now, the present invention will be explained in detail and concretely as follows, taking as an example the positioning during CRD replacement; (1) control.

既ち、第３図はＣ几り交換装置の全体的な構成をＣＲＤ
とともに示したものであり、Ｃｌ１（Ｄ交換装置は着脱
ヘッド８を具備してなる着脱装置９やプラットホーム１
０などより構成され原子力発電所の定期検査の際にＣＲ
Ｄ７を交換する作業に用いられるものとなっている。Ｃ
ＲＤ７の交換はプラットホーム１０の旋回レール１１に
沿った水平面内での回転と、着脱装置９の前後進と、着
脱ヘッド８の上下動および回転とによって着脱ヘッド８
をＣＲＤ７に位置決めしＣＲＤ７を取シ外すことによっ
て行なわれるようになっている。第３図には併せて制御
室１５内に設置されるモニタ５や制御盤１２も図示され
ているが、これらについては特に説明は要しない。なお
、符号１３はペデスタルを示す。Already, Figure 3 shows the overall configuration of the C-type exchanger as CRD.
Cl1 (D)
CR consists of 0, etc. during periodic inspections of nuclear power plants.
It is used for replacing the D7. C
The RD 7 is replaced by the rotation of the platform 10 in a horizontal plane along the turning rail 11, the forward and backward movement of the attachment/detachment device 9, and the vertical movement and rotation of the attachment/detachment head 8.
This is done by positioning the CRD 7 on the CRD 7 and removing the CRD 7. Although the monitor 5 and control panel 12 installed in the control room 15 are also shown in FIG. 3, no particular explanation is required for these. In addition, the code|symbol 13 shows a pedestal.

第４図、第５図は本発明に係る全体としてのシステム構
成を示したものである。本例では画像入力系１は光フア
イバスコープ１９、レンズ系２３およびＩＴＶカメラ２
０より構成され、また、距離計測手段２としてはシンク
ロ位置検出器２１が用いられるようになっている。シン
クロ位置検出器２′は着脱ヘッド８の上下動位置検出用
に設けられたものであるが、これを距離計測手段２とし
て用いたのは着脱ヘッド８上に距離計を設置する余裕が
ないからである。更に本例では演算手段４はインダクシ
ョンモータ２２ａ、２２ｂ、２２ｃ。FIGS. 4 and 5 show the overall system configuration according to the present invention. In this example, the image input system 1 includes an optical fiber scope 19, a lens system 23, and an ITV camera 2.
0, and a synchro position detector 21 is used as the distance measuring means 2. The synchro position detector 2' is provided to detect the vertical position of the detachable head 8, but this was used as the distance measuring means 2 because there was no room to install a distance meter on the detachable head 8. It is. Furthermore, in this example, the calculation means 4 are induction motors 22a, 22b, and 22c.

２２ｄを制御する制御装置４′に相当するものとなって
いる。イ／ダクションモータ２２ａ、２２ｂばそれぞれ
プラットホーム旋回用１着脱装置走行用に設けられたも
のであシ、それらの位置はシンクロ受発信器２１ａ、２
１ｂによって検出されるようになっている。まだ、イン
ダクションモータ２２Ｃ，２２ｄはそれぞれ着脱ヘッド
８の回転用。This corresponds to a control device 4' that controls the controller 22d. A/Daction motors 22a and 22b are provided for running the platform turning device 1, respectively, and their positions are as follows:
1b. The induction motors 22C and 22d are still used to rotate the detachable head 8.

上下動用のもので、その回転位置、上下方向位置はシン
クロ受発信器２１Ｇ、シンクロ位置検出器２′によって
検出されるものとなっている。但し、第３図においては
インダクションモータ２２ｄは図示省略されている。It is for vertical movement, and its rotational position and vertical position are detected by a synchro receiver/transmitter 21G and a synchro position detector 2'. However, the induction motor 22d is not shown in FIG. 3.

ところで、ＣＲＤ７には十字ターゲット６′が貼付され
ており、この像が光フアイバスコープ１９で捉えられた
うえレンズ系２３、■ＴＶカメラ２０を介しモニタ５に
映し出されるものとなっている。十字ターゲット６′は
第６図（ａ）、　（ｂ）にＣ）ＩＤ７の下部正面、底面
を概略的に示すが、マウンティングボルト２４間に貼付
されるようにな　　　　　　ｊつている。一方、ファイ
バスコープ１９は第６図（Ｃ）に着脱ヘッド８の概略的
な斜視状態を示すが、トルクレンチ２５間に固定される
ものとなっている。トルクレンチ２５はマウンティング
ボルト２４に対応して設けられているものである。なお
、ファイバスコープ１９に近接してライトガイド２６が
設けられているが、これは十字ターゲット６′の画像が
モニタ５に十分に表示されるべくその照度を確保するた
めのものである。Incidentally, a cross target 6' is attached to the CRD 7, and its image is captured by an optical fiber scope 19 and projected onto the monitor 5 via a lens system 23 and a TV camera 20. The cross target 6', which is schematically shown in FIGS. 6(a) and 6(b) from the lower front and bottom of the ID7, is attached between the mounting bolts 24. On the other hand, the fiber scope 19 is fixed between the torque wrenches 25, although FIG. 6(C) shows a schematic perspective view of the detachable head 8. The torque wrench 25 is provided corresponding to the mounting bolt 24. Note that a light guide 26 is provided close to the fiber scope 19, and this is provided to ensure illuminance so that the image of the cross-shaped target 6' can be sufficiently displayed on the monitor 5.

第７図は自動位置決めの制御アルゴリズムのジェネラル
フローチャートを示すが、これにより着脱ヘッド８上の
トルクレンチ２５とＣＲＤ７上のマウンティングボルト
２４とが如何に位置決めされたうえ嵌合されるかについ
て説明すれば以下のようである。FIG. 7 shows a general flowchart of the automatic positioning control algorithm, and how the torque wrench 25 on the detachable head 8 and the mounting bolt 24 on the CRD 7 are positioned and fitted together will be explained below. It is as follows.

即ち、先ず交換装置の各部がどのような位置状態にある
かがシンクロ受発信器２１ａ〜２１ｃによって検出され
たうえＣＲＤ７据付時の位置へ着脱ヘッド８が移動する
ようにされる。これによシこれまでの粗位置決め制御が
行なわれたわけであるが、ＣＲ，Ｄ７は据付時から後発
的にずれておシ、また、制御系の誤差や機械系のガタに
よって一般にマウンティングボルト２４とトルクレンチ
２５とは完全に嵌合しないものとなっている。粗位置決
めは±５胴以内の精度で行なわれるが、そこで本発明に
よってそのずれに対処しようというものである。ファイ
バスコープ１９などにより十字ターケラト６′をモニタ
５上に映し、ファイバスコープ１９中心Ｏと十字ターゲ
ット６′の中心０′との間での相対的な位！（Ｑ差と角
度偏差を求めることによってずれに対処せんとするもの
である。That is, first, the position of each part of the exchange device is detected by the synchro receiver/transmitter 21a to 21c, and then the attachment/detachment head 8 is moved to the position when the CRD 7 is installed. Conventional coarse positioning control has been performed in this way, but CR and D7 tend to shift later on from the time of installation, and generally the mounting bolts 24 and It does not fit completely with the torque wrench 25. Rough positioning is performed with an accuracy of within ±5 cylinders, and the present invention attempts to deal with this deviation. Project the cross Terkerat 6' on the monitor 5 using a fiberscope 19, etc., and determine the relative position between the center O of the fiberscope 19 and the center 0' of the cross target 6'. (The purpose is to deal with the deviation by finding the Q difference and angular deviation.

第８図（、）はモニタに映し出された十字ターゲットの
一例での画像を示したものである。その画像は十字マー
ク２７の如くに映し出されるが、モニタ５上には予め座
標軸が図示の如くに描かれておりその原点（７アイパス
コープ中心）０が基準点として見做されるようになって
いる。モニタ５上に映し出された十字マーク２７は点座
標入力手段３を介しては第８図（ｂ）に示す如く十字マ
ーク２７′のように観察され得るが、このような状態で
オペレータによって十字マーク２７′上の点Ａ−Ｄが指
定されるものである。点Ａ〜Ｄの指定は点Ａ〜Ｄに対応
する点座標入力手段３上での点をペン先などによって押
すことによプ行なわれるが、点Ａ〜Ｄは十字マーク２７
′の線幅を２等分するようにして指定されるものとなっ
ている。オペレータが点Ａ−Ｄを指定することによって
点Ａ−Ｄ対応のＸＹ座標は点座標入力手段３より制御装
置４′に与えられるが、これにより第９図に示すように
点Ａ−ＤのＸＹ座標より基準点Ｏからの位置偏差（ｘ、
ｙ）と十字マーク２７′の角度偏差θが求められるもの
である。FIG. 8(,) shows an example of an image of a cross target displayed on a monitor. The image is displayed as a cross mark 27, but the coordinate axes are drawn on the monitor 5 in advance as shown in the figure, and the origin (center of the 7 eye path scope) 0 is regarded as the reference point. There is. The cross mark 27 projected on the monitor 5 can be observed through the point coordinate input means 3 as a cross mark 27' as shown in FIG. Points A-D on 27' are designated. Points A to D are designated by pressing the points on the point coordinate input means 3 corresponding to points A to D with the tip of a pen, etc.;
' is specified by dividing the line width into two equal parts. When the operator specifies the point A-D, the XY coordinates corresponding to the point A-D are given to the control device 4' from the point coordinate input means 3. The position deviation from the reference point O from the coordinates (x,
y) and the angular deviation θ between the cross mark 27'.

一方、ファイバスコープ１９と十字ターゲット６′との
間の距離は、第１０図（ａ）に示すようにシンクロ位置
検出器２′がある基準のシンクロ値をとるときでのファ
イバスコープ１９と十字ターゲット６′との間の距離Ｌ
１を予め計測しておくことによって求められる。第１０
図（ｂ）に示すように基準のシンクロ値からの変位より
距離の変位Ｌ２、したがって距離Ｌ＋および変位Ｌ２よ
シフアイバスコープ１９と十字ターゲット６′との間の
距離は容易に求められるものである。この距離はシンク
ロ位置検出器２′からのシンクロ値がＳ／Ｄ変換器１７
によってディジタル処理に適したディジタル値に変換さ
れたうえ制御装置４′で演算処理されることによシ求め
られるものとなっている。On the other hand, the distance between the fiberscope 19 and the crosshair target 6' is as shown in FIG. Distance L between 6'
It can be obtained by measuring 1 in advance. 10th
As shown in Figure (b), the distance L2 from the reference synchronization value, and therefore the distance L+ and the distance L2 between the shifter scope 19 and the crosshair target 6' can be easily determined. . This distance is determined by the synchronization value from the synchronization position detector 2' being sent to the S/D converter 17.
The value is converted into a digital value suitable for digital processing, and then subjected to arithmetic processing in the control device 4'.

したがって、ファイバスコープ１９の視野角が既知であ
るとして上記距離が知れれば、位置偏差（ｘ、ｙ）は既
述した如くに絶対量に換算され得るものである。Therefore, if the viewing angle of the fiber scope 19 is known and the distance is known, the positional deviation (x, y) can be converted into an absolute amount as described above.

以上のようにしてファイバスコープ１９の中心０と十字
マーク２７′の中心Ｏ′との間の位置偏差（ｘ、ｙ）は
絶対的な大きさに変換されたわけであるが、次にこれに
もとづき装置各部の移動量が計算されるようになってい
る。As described above, the positional deviation (x, y) between the center 0 of the fiber scope 19 and the center O' of the cross mark 27' has been converted into an absolute size. Next, based on this, The amount of movement of each part of the device is calculated.

ところで、プラットホーム１ｏの中心Ｏｐから見た場合
に着脱ヘッド８およびＣＲＤ７が第１１図に示す如くに
あるとすれば、着脱ヘッド８の中心Ｏｎはプラットホー
ム１ｏをθＰだけ旋回させてから着脱装＠９を几Ｃ１だ
け移動せしめるようにすればＣ凡Ｄ７の中心Ｏｃに一致
することが判る。By the way, if the attachment/detachment head 8 and CRD 7 are as shown in FIG. 11 when viewed from the center Op of the platform 1o, the center On of the attachment/detachment head 8 will be the same as the attachment/detachment @9 after rotating the platform 1o by θP. It can be seen that if C is moved by C1, C will coincide with the center Oc of D7.

更に着脱ヘッド８を００Ｍだけ回転せしめるようにすれ
ば、十字マーク２７′の中心Ｏ′とファイバスコープ１
９の中心Ｏとが一致するものであることが判る。If the attachment/detachment head 8 is further rotated by 00M, the center O' of the cross mark 27' and the fiber scope 1 will be aligned.
It can be seen that the center O of 9 coincides with the center O.

さて、粗位置決めが終了した時点では着脱ヘッド８とＣ
ＲＤ７とは第１２図に示す如くの位置関係にある。ファ
イバスコープ１９の中心Ｏと十字ターゲット６′の中心
Ｏ′との位置関係も第１２図に示す如くでありモニタ５
上では第８図（ａ）に示すが如くになる。なお、ψ■は
中心Ｏｐ　、Ｏｎを結ぶ線と中心Ｏト、０を結ぶ線との
なす角度である。Now, when the rough positioning is completed, the detachable head 8 and C
It has a positional relationship with RD7 as shown in FIG. The positional relationship between the center O of the fiber scope 19 and the center O' of the cross target 6' is also as shown in FIG.
The above is as shown in FIG. 8(a). Note that ψ■ is the angle formed by the line connecting the centers Op and On and the line connecting the centers Ot and 0.

位置偏差（ｘ、ｙ）と角度偏差θが求められた後モニタ
５上の座標系はＣＲ，Ｄ７の中心Ｏｃを原点とした座標
系に変換されるが、第１３図はＣＲＤ７の中心Ｏｃを原
点とした座標系における装置各部の動き方を示したもの
である。After the positional deviation (x, y) and angular deviation θ are determined, the coordinate system on the monitor 5 is converted to a coordinate system with the center Oc of CR, D7 as the origin. This shows how each part of the device moves in a coordinate system with the origin as the origin.

さて、第１４図に示すように座標変換後の着脱ヘッド８
の中心ＯＨの座標を（ａ、ｂ）とし、また、図示の如く
位置にプラットホーム１０の中心ＯＰとファイバスコー
プ１９の中心Ｏがあるものとすれば、中心０４はプラッ
トホーム１０の旋回によって点０／ｉにこなければなら
ない。点Ｏ′にはＯｐ　Ｏａに垂直で中心Ｏ■を通る直
線と、ＯｐＯ＋ｔに平行で中心Ｏｃを通る直線との交点
である。プラットホーム１０の旋回量は粗位置決めによ
シ倣小であることから、０ＰＯＩＩとＯｃＯ＋＋とは平
行として近似しているものである。この場合プラットホ
ーム１０の旋回による着脱ヘッド８の中心０璽区の移動
量Ｒｐは以下のようになる。Now, as shown in FIG. 14, the detachable head 8 after the coordinate transformation
Let the coordinates of the center OH of I have to come to i. Point O' is the intersection of a straight line that is perpendicular to Op Oa and passes through the center O2, and a straight line that is parallel to OpO+t and passes through the center Oc. Since the amount of rotation of the platform 10 is small due to rough positioning, 0POII and OcO++ are approximated as being parallel. In this case, the amount of movement Rp of the center point of the detachable head 8 due to the rotation of the platform 10 is as follows.

几、　＝　ｂｃｏｓα＋　ａｓｉｎα−・山・・・べ１
）但し、α＝９１十〇である。几、=bcosα+asinα−・mountain・be1
) However, α=9100.

したがって、第１１図に示す中心Ｏｐ　、Ｏｕ間距離ｔ
ｐ’に用いプラットホーム１０の旋回量θＰは以下のよ
うに求められる。Therefore, the distance t between the center Op and Ou shown in FIG.
The amount of rotation θP of the platform 10 used for p' is determined as follows.

θｐ＝１（、ｐ／Ｌｐ　　　　　　・・・・・・・・・
・・・・・・（２）。θp=1(, p/Lp ・・・・・・・・・
・・・・・・(2).

この旋回量θＰは具体的には第４図、第５図に示した制
御装置４′で求められるが、これにもとづきプラットホ
ーム旋回用のインダクションモータ２２ａがソリッドス
テートリレー１８を介し駆動されることによって、プラ
ットホーム１０はθＰ分腕旋回れるところとなるもので
ある。This turning amount θP is specifically determined by the control device 4' shown in FIGS. 4 and 5, and based on this, the induction motor 22a for platform turning is driven via the solid state relay 18. , the platform 10 is a place where the arm can rotate by θP.

このような処理は着脱装置９、着脱ヘッド８についても
以下順次行なわれるようになっている。Such processing is sequentially performed for the attachment/detachment device 9 and the attachment/detachment head 8 as well.

先ず着脱装置９の走行量について説明すれば、プラット
ホーム１０を精密位置に移動させた後の着脱ヘッド８の
中心は点ｏＩｔとなるが、着脱装置９の走行方向は点Ｏ
ｕと中心Ｏｃとを結ぶ直線の方向であるから、点Ｏｆｆ
と中心Ｏｃとの間の位置偏差より着脱装置９０走行量几
ｃｗは求められることになる。First, to explain the traveling distance of the attachment/detachment device 9, the center of the attachment/detachment head 8 after the platform 10 is moved to a precise position is the point oIt, but the traveling direction of the attachment/detachment device 9 is the point O.
Since it is the direction of the straight line connecting u and the center Oc, the point Off
The distance cw of the attachment/detachment device 90 can be determined from the positional deviation between the center Oc and the center Oc.

即ち、第１５図に示すように点０６の座標を（ａｔ　ｌ
　ｂｘ　　）とすれば、点０４を中心Ｏｃに一致させる
ための着脱装置９の走行量Ｒｃ■は以下のように求めら
れる。That is, as shown in FIG. 15, the coordinates of point 06 are (at l
bx), the traveling distance Rc■ of the attachment/detachment device 9 to align the point 04 with the center Oc can be obtained as follows.

ＲａＨ＝　　　ａ　Ｈ＋　ｂ　１”　　　　・・・・・
・・・・・旧・・（３）この走行量几Ｃ■も制御装置４
′で求められるが、これにもとづき着脱装置走行用のイ
ングクションモータ２２ｂがソリッドステートリレー１
８を介し駆動制御されることによって、着脱装置９はＲ
ＣＨ分走行するところとなるものである。これにより第
１６図に示すように着脱ヘッド８の中心は点０　＋ｔと
なって中心Ｏｃに一致するが、この後は着脱ヘッド８を
回転させることで角度偏差を商工するようになっている
。第１６図に示す如く中心０．０７間の位’１４Ｍ偏差
を（Ｘｔ、ｙ＋）とすれば、着脱ヘッド８０回転量θｃ
ｎは以下のように求められる。RaH= a H+ b 1”...
...Old... (3) This travel distance C■ is also controlled by the control device 4.
Based on this, the injection motor 22b for running the detachable device is connected to the solid state relay 1.
8, the attachment/detachment device 9 is
This is where the train travels for CH. As a result, as shown in FIG. 16, the center of the detachable head 8 becomes a point 0+t, which coincides with the center Oc, but after this, the angular deviation is compensated for by rotating the detachable head 8. As shown in FIG. 16, if the 14M deviation between the centers of 0.07 and 0.07 is (Xt, y+), the amount of rotation of the detachable head 80 θc
n is determined as follows.

θｃｕ＝ｊａｎ−１１ｙｌ／（１００Ｘｔ）ｌ　　　−
・・−（４）但し、式（４）中の１００（咽）の値は中
心Ｏｃ。θcu=jan-11yl/(100Xt)l-
...-(4) However, the value of 100 (throat) in equation (4) is the center Oc.

０７間の距離である。07.

この回転量θｃｈｉにもとづきソリッドステートリレー
１８を介し着脱ヘッド回転用のインダク／ヨンモータ２
２Ｃが回転駆動されることによって、Ｃ几Ｄ７と着脱ヘ
ッド８との位置決めは終了されるものである。なお、以
上の例では位置偏差および角度偏差の取込は対象を移動
させる度に行なっているが、理論的には１回でもθＰ、
几ｃＨおよび、。１．□ゎ、６．７１．ヶ９８６１、工
ゆえよヵ　　　　ｊ・象を移動させる度に移動誤差が累
積されることから、対象を移動させる度に点座標入力手
段より必要な点の座標が取り込まれるようになっている
ものである。Based on this rotation amount θchi, the induction/yeon motor 2 for rotating the detachable head is connected via the solid state relay 18.
By rotationally driving 2C, positioning between the C box D7 and the detachable head 8 is completed. Note that in the above example, the positional deviation and angular deviation are captured every time the object is moved, but theoretically even once θP,
几CH and. 1. □ゎ, 6.71. 9861, Worker's Guide J-Since the movement error is accumulated each time the elephant is moved, the coordinates of the necessary points are imported from the point coordinate input means each time the object is moved. be.

このように本発明によってＣ几り交換作業を行なう場合
は位置決め操作は完全に遠隔操作化され、作業者の放射
線被曝量低減に大きな効果を挙げ得る。また、これまで
は最終的なインチングを原子炉圧力容器直下のペデスタ
ル室内で目視確認しつつ手動で装置を動かしていたもの
が、オペレータがモニタ上に表示された十字マーク上の
４点を押すだけで操作は自動化されることから、オペレ
ータとっては操作は容易であシ本発明がマンマシンイン
タフェースとして有用なものであることが判る。更にこ
れまでは自動化に伴う膨大な情報処理や高度な画像処理
技術を要していたが、本発明による場合は非常に簡単な
演算処理で済まされ処理時間が短縮されるばかりか、（
Ａ算装置としても簡単な構成のもので済まされることに
なる。As described above, when performing the C-box replacement work according to the present invention, the positioning operation can be completely controlled remotely, which can have a great effect on reducing the amount of radiation exposure of the worker. In addition, previously the operator had to manually operate the equipment while visually checking the final inching in the pedestal room directly below the reactor pressure vessel, but now the operator can simply press four points on the cross mark displayed on the monitor. Since the operation is automated, the operation is easy for the operator, and it can be seen that the present invention is useful as a man-machine interface. Furthermore, up until now, automation required a huge amount of information processing and advanced image processing technology, but with the present invention, it can be done with extremely simple arithmetic processing, which not only shortens processing time, but also
The A calculation device can also be of a simple configuration.

ところで、人間による操作が介入する場合、とかく信頼
性が問題とされるが、押圧された点をモニタ上に表示す
ることによってその位置を確認してから制御を自動的に
行なうようにすれば、操作ミスは操作そのものが簡単で
もあることから相当抑えられることになる。また、精度
が問題となる場合は画像の倍率を高めることで誤差を少
なくし得る。人間は２等分することにかけては相当の能
力を持ち、しか・も十字マークの特徴を直ちに認識し得
ることから、画像認識能力は如何なる装置よりも格段に
上であり、この点では機械装置よ）も高い精度が期待し
得る。なお、精度を高める一方法として、数回操作を繰
り返し行ないその平均をとることが考えられる。By the way, reliability is often an issue when human operations intervene, but if the pressed point is displayed on the monitor to confirm its position and then the control is performed automatically, Since the operation itself is simple, operational errors can be considerably reduced. Furthermore, if accuracy is a problem, the error can be reduced by increasing the magnification of the image. Humans have a considerable ability to divide into two equal parts, and they can immediately recognize the characteristics of a cross mark, so their image recognition ability is far superior to any other device, and in this respect, it is far superior to mechanical devices. ) can also be expected to have high accuracy. Note that one possible way to improve accuracy is to repeat the operation several times and take the average.

最後に点座標入力手段について簡単に説明すれば、この
種のものは現在数種類市販されているのが実状である。Finally, to briefly explain point coordinate input means, there are currently several types of this type on the market.

第１７図（ａ）、　（ｂ）はその−例での構成を示した
ものである。その要部はその一部断面を示す第１７図（
ａ）からも判るように透明電極２９が蒸着されたアクリ
ル基材２８と、透明抵抗体３１が蒸着されたアクリル基
材３２とをその間にスペーサ３０を介在させるようにし
て対向配置した・ものである。第１７図（ｂ）からも判
るようにアクリル基材２８上の任意の１点を押圧すれば
、その点を介し透明電極２９と透明抵抗体３１とが電気
的１機械的に接触することになり、しかして、その点と
信号取出電極３３Ａ、３３Ｂ各々との間の抵抗値も一義
的に定まるというものである。抵抗３４．３５には電池
３６によって上記抵抗値が大なる程に小なる降下電圧が
生じるが、これら降下延圧ばその点に対応したＸ座標信
号、Ｙ座標信号としてインタフェース１６でＡ／Ｄ変換
されたうえ制御装置４′に送られることになるものであ
る。FIGS. 17(a) and 17(b) show the configuration of this example. The main part is shown in Fig. 17, which shows a partial cross section (
As can be seen from a), an acrylic base material 28 on which a transparent electrode 29 is vapor-deposited and an acrylic base material 32 on which a transparent resistor 31 is vapor-deposited are placed facing each other with a spacer 30 interposed therebetween. be. As can be seen from FIG. 17(b), pressing any one point on the acrylic base material 28 brings the transparent electrode 29 and the transparent resistor 31 into electrical and mechanical contact through that point. Therefore, the resistance value between that point and each of the signal extraction electrodes 33A and 33B is also uniquely determined. The battery 36 causes a voltage drop in the resistors 34 and 35 to become smaller as the resistance value increases, but when these drops are rolled, the interface 16 converts the voltage into an X coordinate signal and a Y coordinate signal corresponding to that point. It is then sent to the control device 4'.

さて、この場合での点座標入力手段の精度を仮に±０．
３　ｍとしてモニタ上での画像の倍率を１０倍とすれば
、実質的に点座標入力手段の精度は±０．０３ｍとなる
。ＣＲ，Ｄ交換作業での位置決め許容誤差が±１ｍとし
てＣＲＤ交換装置自体の誤差を考慮すれば、中心Ｏ′の
位Ｏｔ偏差の誤差はほぼ±０．１〜０．２　ｒｒｔｒｓ
位になると考えられこれは位置決め精度上十分なもので
ある。Now, suppose the accuracy of the point coordinate input means in this case is ±0.
3 m, and if the magnification of the image on the monitor is 10 times, then the accuracy of the point coordinate input means will essentially be ±0.03 m. Assuming that the positioning tolerance in CR and D replacement work is ±1m and considering the error of the CRD replacement device itself, the error in the Ot deviation of the center O' is approximately ±0.1 to 0.2 rrtrs.
This is considered to be sufficient for positioning accuracy.

なお、点座標入力手段としては以上の他に超音波を利用
したものなどがあるが、精度や経済性などを考１ばして
適当なものを選択すればよい。In addition to the point coordinate input means mentioned above, there are methods using ultrasonic waves, but an appropriate method may be selected in consideration of accuracy, economy, etc.

本発明は以上のようなものであるが、本発明によれば対
象物の長さや面積、移動物体の変位などをも簡単容易に
絶対量として計測可能となる。また、ＣＲり交換の際で
の位置決め制御にその例を採って本発明を説明したが、
これに限定されることなく多方面に適用、応用可となっ
ている。The present invention is as described above, but according to the present invention, the length and area of a target object, the displacement of a moving object, etc. can be easily and easily measured as absolute quantities. In addition, the present invention has been explained using an example of positioning control during CR replacement.
It is not limited to this and can be applied in many fields.

〔発明の効果〕〔Effect of the invention〕

以上説明したように本発明による場合は、視野角が既知
であれば、対象物の２次元位置偏差が簡単な処理で他対
敵として得られるという効果がある。As explained above, in the case of the present invention, if the viewing angle is known, the two-dimensional positional deviation of the object can be obtained by simple processing.

【図面の簡単な説明】[Brief explanation of the drawing]

第１図は、本発明による位置検出装置の概要構成を示す
図、第２図は、相対比率として求められた位置偏差の絶
対量への換算を説明するだめの図、第３図は、ＣＲ，Ｄ
交換装置の全体的構成をＣ１ｌ、Ｄとともに示す図、第
４図、第５図は、本発明に係る位置検出システムの構成
を示す図、第６図（ａ）〜（Ｃ）は、ＣＲりの下部正面
とその底面および着脱ヘッドの概略的な斜視状態を示す
図、第７図は、ＣＲＤと着脱ヘッドとの自動位置決めの
だめの制御アルゴリズムのフローを示す図、第８図（ａ
）、　（ｂ）は、モニタに映し出された十字ターゲット
の像とその像の点座標入力手段を介しての像の一例を示
す図、第９図は、位置偏差と角度偏差の求め方を説明す
るための図、第１０図（ａ）、　（ｂ）は、ファイバス
コープと十字ターゲットとの間の距離の求め方全説明す
るための図、第１１図は、ＣＲりと着脱ヘッドとの位置
決めの概略を説明するための図、第１２図は、粗位置決
めが終了した状態でのＣＩ（、Ｄと着脱ヘッドとの位置
関係を示す図、第１３図は、ＣＲり中心を原点とした座
標系における装置各部の移動方向を説明するための図、
第１４図は、ブラッドホームの旋回量の求め方を説明す
るための図、第１５図は、同じく着脱装置の走行量の求
め方を説明するための図、第１６図は、着脱ヘッドの回
転量の求め方を説明するだめの図、第１７図（ａ）、　
（ｂ）は、点座標入力手段の一例での構成を示す図であ
る。 ■・・・画像入力系、２・・・距離計測手段、３・・・
点座標入力手段、４・・・演算手段、５・・・モニタ、
６・・・対象物。FIG. 1 is a diagram showing the general configuration of the position detection device according to the present invention, FIG. 2 is a diagram illustrating the conversion of a positional deviation determined as a relative ratio into an absolute amount, and FIG. 3 is a diagram showing the CR ,D
A diagram showing the overall configuration of the exchange device together with C1l and D, FIGS. 4 and 5 are diagrams showing the configuration of the position detection system according to the present invention, and FIGS. FIG. 7 is a diagram showing a schematic perspective view of the front lower part of the CRD, its bottom surface, and the detachable head, and FIG.
), (b) is a diagram showing an example of the image of the cross target displayed on the monitor and the image obtained through the point coordinate input means, and FIG. 9 explains how to obtain the positional deviation and angular deviation. Figures 10(a) and 10(b) are diagrams for fully explaining how to determine the distance between the fiberscope and the crosshair target. Figure 11 is for positioning the CR and detachable head. 12 is a diagram showing the positional relationship between the CI (D) and the detachable head after rough positioning has been completed. A diagram for explaining the moving direction of each part of the device in the system,
FIG. 14 is a diagram for explaining how to determine the amount of rotation of the brad platform, FIG. 15 is a diagram for explaining how to determine the amount of travel of the attachment/detachment device, and FIG. 16 is a diagram for explaining how to determine the amount of travel of the attachment/detachment head. A diagram explaining how to determine the quantity, Figure 17 (a),
(b) is a diagram showing the configuration of an example of point coordinate input means. ■...Image input system, 2...Distance measurement means, 3...
Point coordinate input means, 4... calculation means, 5... monitor,
6...Object.

Claims (1)

【特許請求の範囲】 １、画像入力系の視野角が既知であるとして、該入力系
先端より対象物までの距離を求める一方、上記画像入力
系より取込され表示画面に表示された上記対象物の画像
上の点を任意に指定することによつて、対象物までの距
離と指定された点の座標とから該点の予め定められた点
あるいは基準点からの位置偏差を絶対量として求めるこ
とを特徴とする位置検出方法。 ２、対象物の画像を取り込み画面上に表示する画像入力
表示手段と、画像入力系先端から対象物までの距離を計
測する距離計測手段と、対象物の画像が表示される画面
上に取付され、外部操作によつて指定された表示画像上
の点の座標を出力する点座標入力手段と、上記距離計測
手段および点座標入力手段各々からの距離情報、座標情
報にもとづいて位置偏差を絶対量として求めるべく演算
を行なう演算手段とからなる構成を特徴とする位置検出
装置。[Claims] 1. Assuming that the viewing angle of the image input system is known, the distance from the tip of the input system to the object is determined, and the distance between the object captured by the image input system and displayed on the display screen is By arbitrarily specifying a point on the image of an object, the positional deviation of that point from a predetermined point or reference point is determined as an absolute amount from the distance to the object and the coordinates of the specified point. A position detection method characterized by: 2. An image input/display means for capturing an image of the object and displaying it on the screen; a distance measuring means for measuring the distance from the tip of the image input system to the object; , a point coordinate input means for outputting the coordinates of a point on a display image specified by an external operation, and a positional deviation determined by an absolute amount based on distance information and coordinate information from each of the distance measuring means and point coordinate input means. What is claimed is: 1. A position detection device characterized by a configuration comprising a calculation means for performing calculations to obtain .