JP2024086016A - Construction machinery with motion capture targets - Google Patents
Construction machinery with motion capture targets Download PDFInfo
- Publication number
- JP2024086016A JP2024086016A JP2022200863A JP2022200863A JP2024086016A JP 2024086016 A JP2024086016 A JP 2024086016A JP 2022200863 A JP2022200863 A JP 2022200863A JP 2022200863 A JP2022200863 A JP 2022200863A JP 2024086016 A JP2024086016 A JP 2024086016A
- Authority
- JP
- Japan
- Prior art keywords
- construction machine
- motion capture
- leds
- tip
- capture target
- 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
- 230000033001 locomotion Effects 0.000 title claims abstract description 77
- 238000010276 construction Methods 0.000 title claims abstract description 65
- 239000007921 spray Substances 0.000 claims description 61
- 238000005507 spraying Methods 0.000 claims description 17
- 239000004567 concrete Substances 0.000 claims description 16
- 238000000034 method Methods 0.000 claims description 7
- 239000003550 marker Substances 0.000 description 23
- 238000010586 diagram Methods 0.000 description 11
- 238000005516 engineering process Methods 0.000 description 8
- 239000000758 substrate Substances 0.000 description 6
- 239000000428 dust Substances 0.000 description 5
- 239000000463 material Substances 0.000 description 5
- 230000003287 optical effect Effects 0.000 description 4
- 229910000831 Steel Inorganic materials 0.000 description 3
- 239000010959 steel Substances 0.000 description 3
- 238000009412 basement excavation Methods 0.000 description 2
- 230000000903 blocking effect Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000001678 irradiating effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 239000011378 shotcrete Substances 0.000 description 1
Images
Abstract
【課題】建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを適確に捉えて、所要の動作を実行させることができる。
【解決手段】建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを捕捉するために、前記アーム部の先端部に取り付けられるモーションキャプチャターゲット100を含み、前記ターゲット100は、自発光する少なくとも3個のLEDであり、その少なくとも3個のLEDの配置が、その3個のLEDの配置基準面の中心位置を定める関係にある。
【選択図】図15
When performing construction work while moving the arm portion of a construction machine and an element attached to the tip of the arm portion, the position and movement of the element can be accurately captured to perform the required operation.
[Solution] The invention includes a motion capture target 100 attached to the tip of the arm section in order to capture the position and movement of an element attached to the tip of the arm section of a construction machine when construction work is performed while moving the arm section and the element, the target 100 being at least three self-illuminating LEDs, the arrangement of the at least three LEDs being in a relationship that determines the central position of a reference plane for the arrangement of the three LEDs.
[Selection] Figure 15
Description
本発明は、モーションキャプチャターゲットを備えた建設機械に関する。 The present invention relates to a construction machine equipped with a motion capture target.
建設機械は、その建設作業のための各種のアーム(伸縮するブームであることもある。)を備え、そのアームの先端部に取り付けたアームなどの動作部を介して、作業するものが代表的である。 Construction machinery is typically equipped with various arms (which can be telescopic booms) for construction work, and works are performed via moving parts such as arms attached to the ends of the arms.
(山岳)トンネル内に搬入する建設機械としては、切羽面の削孔などを行ういわゆるトンネルジャンボ、吹付機、鋼製支保工の建込み装置などがある。 Construction machinery that can be brought into (mountain) tunnels includes so-called tunnel jumbos, which are used to drill holes in the tunnel face, spraying machines, and equipment for erecting steel supports.
吹付機による吹付コンクリートは、リアルタイムに出来形を測定する方法がなく、作業員が目分量で吹き付けているのが実情である。リアルタイムに出来形を測定しながら、吹付を自動で行う技術が求められている。 When spraying concrete using a sprayer, there is no way to measure the finished shape in real time, so workers spray the concrete by eye. There is a demand for technology that can automatically spray the concrete while measuring the finished shape in real time.
関連ある技術を調査した。
特許文献1は、支保工の建て込み方法及び建て込みシステムに関し、支保工の位置をリアルタイムに把握することのできる技術に関し、複数のモーションキャプチャ用カメラによって鋼製支保工の予め定められた複数の定点に設置されたモーションキャプチャ用マーカを撮影し、各モーションキャプチャ用カメラによって取得した撮影画像及び各モーションキャプチャ用カメラの3次元座標に基づいて各モーションキャプチャ用マーカの3次元座標を取得し、取得した各モーションキャプチャ用マーカの3次元座標に基づいて鋼製支保工を設計位置に建て込むものである。
ここに、光照射装置からマーカに対して赤外線を照射し、マーカは照射された赤外線を反射する素材を表面に有する、例えば球体形状を有するものである。
Related technologies were investigated.
Here, infrared rays are irradiated from a light irradiating device onto the marker, and the marker has a surface made of a material that reflects the irradiated infrared rays, and has, for example, a spherical shape.
この特許文献1のように、モーションキャプチャ技術を用いることによりリアルタイムに位置の算出ができる。モーションキャプチャ技術とは、動く対象物に取り付けた反射体を、並べて配置した複数のモーションキャプチャカメラで連続撮影し、得られた連続画像情報を画像分析することにより、対象物の位置及び動きをリアルタイムに算出するものである。
As in
このようなモーションキャプチャ用カメラを含むモーションキャプチャ技術の有用性については、本発明者らは十分認識している。
かかる背景技術に基づき、本発明者らは、吹付工において、リアルタイムに出来形を測定しながら、吹付を自動で行う技術を求めて、種々の開発を試みた。
すなわち、吹付コンクリートのノズルやブームの近傍に反射体を取り付け、それをモーションキャプチャカメラで連続撮影し、画像分析することにより、吹付ノズルの位置及び動きをリアルタイムに算出できるのではないかと考え、実証実験を試みてきた。
The inventors of the present invention are fully aware of the usefulness of motion capture technology including such motion capture cameras.
Based on this background technology, the present inventors have attempted various developments in search of a technology for automatically performing spraying while measuring the finished shape in real time in spraying work.
In other words, we have attempted a demonstration experiment, thinking that by attaching a reflector near the sprayed concrete nozzle or boom and continuously photographing it with a motion capture camera and analyzing the images, it may be possible to calculate the position and movement of the spray nozzle in real time.
しかし、例えば、暗く、粉塵の舞うトンネル内の切羽近傍での吹付作業において、モーションキャプチャカメラでマーカを適確に捉えることは難しいことが判明した。 However, it proved difficult to accurately capture the markers with a motion capture camera, for example, when performing spraying work near the tunnel face inside a dark, dusty tunnel.
また、建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを適確に捉えることが困難である。
例えば、機素として吹付ノズルを考えると、吹付ノズルの先端位置を把握することは、マーカからの既知位置関係を考慮することで、ある程度の精度をもって可能と考えられる。
Furthermore, when performing construction work while moving the arm of a construction machine and an element attached to the tip of the arm, it is difficult to accurately grasp the position and movement of the element.
For example, when considering a spray nozzle as an element, it is considered possible to grasp the tip position of the spray nozzle with a certain degree of accuracy by taking into account the known positional relationship from the marker.
しかし、施工のある時点において、吹付ノズルの先端位置が吹付ノズル本体軸とどのような関係にあるのか不明である場合、吹付ノズル本体軸に沿う吹付材料の吐出方向が不明となり、目的位置に対する吹付材料の吹付が困難となる、又は精度の悪いものとなる。
かかる観点からすると、施工のある時点における、アーム部の軸のロール(角)などの捕捉が重要であると考えられる。
However, if at a certain point during construction it is unclear what relationship the tip position of the spray nozzle has to the main axis of the spray nozzle, the ejection direction of the spray material along the main axis of the spray nozzle will be unclear, making it difficult to spray the spray material at the desired position or resulting in poor accuracy.
From this perspective, it is considered important to capture the roll (angle) of the axis of the arm part at a certain point during construction.
したがって、本発明の主たる課題は、建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを適確に捉えて、所要の動作を実行できるようにした建設機械を提供することにある。
特にトンネル内などの暗い雰囲気下でも、アーム及びその先端部に取り付けた機素の動きを適確に捉えることができるようにしたものである。
Therefore, the main object of the present invention is to provide a construction machine that, when performing construction work while moving the arm portion of the construction machine and an element attached to the tip of the arm portion, can accurately capture the position and movement of the element and perform the required operation.
In particular, it is possible to accurately capture the movement of the arm and the element attached to its tip even in a dark environment such as inside a tunnel.
上記課題を解決するための手段の第1の態様は次のとおりである。
建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを捕捉するために、前記アーム部の先端部に取り付けられるモーションキャプチャターゲットを含み、
前記ターゲットは、自発光する少なくとも3個のLEDであり、
その少なくとも3個のLEDの配置が、その3個のLEDの配置基準面の中心位置を定める関係にある、
ことを特徴とするモーションキャプチャターゲットを備えた建設機械。
A first aspect of the means for solving the above problems is as follows.
A motion capture target is attached to the tip of the arm unit in order to capture the position and movement of the element when performing construction work while moving the arm unit of the construction machine and the element attached to the tip of the arm unit,
the target is at least three self-illuminating LEDs;
The arrangement of the at least three LEDs is in a relationship that determines a center position of a reference plane for the arrangement of the three LEDs.
A construction machine equipped with a motion capture target.
第2の態様は次のとおりである。
建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを捕捉するために、前記アーム部の先端部に取り付けられるモーションキャプチャターゲットを含み、
前記ターゲットは、自発光する少なくとも4個のLEDであり、そのうちの少なくとも3個のLEDの配置が、その3個のLEDの配置基準面の中心位置を定める関係にある、
ことを特徴とするモーションキャプチャターゲットを備えた建設機械。
The second aspect is as follows.
A motion capture target is attached to the tip of the arm unit in order to capture the position and movement of the element when performing construction work while moving the arm unit of the construction machine and the element attached to the tip of the arm unit,
The target is at least four self-emitting LEDs, and the arrangement of at least three of the LEDs is in a relationship that determines the center position of an arrangement reference plane for the three LEDs.
A construction machine equipped with a motion capture target.
以上に説明したように、本発明によれば、建設機械のアーム部及び前記アーム部の先端部に取り付けた機素を動かしながら建設作業する際に、前記機素の位置及び動きを適確に捉えて、所要の動作を実行させることができる。 As described above, according to the present invention, when performing construction work while moving the arm of a construction machine and the element attached to the tip of the arm, the position and movement of the element can be accurately captured and the required operation can be performed.
以下、本発明の実施形態について説明する。 The following describes an embodiment of the present invention.
実施の形態の概要が図1に示されている。
すなわち、トンネルT内に位置する機械本体10と、この機械本体10に設けられ、施工のために機素が対偶をなして運動する可動部を有する運動部20と、を有する建設機械に関するものである。
運動部20に、参考例としての、複数のマーカ21,21…が固定され、少なくとも一つのマーカは可動部に固定され(図2、図3、図6、図8参照)、機械本体10に少なくとも2台、好適には3台以上のカメラ11(図10参照)が光軸角度を異ならせて固定される。ここで、光軸角度を異ならせるのは少なくともマーカ21の捕捉時であり、他の時点において光軸角度を異ならせることを要求されるものではない。
An outline of the embodiment is shown in FIG.
That is, the present invention relates to a construction machine having a
As a reference example, a plurality of
さらに、図12が参照されるように、建設機械の機械本体10のトンネルT内における現位置情報を得る手段30と、複数のカメラ11により得られた撮影情報より、マーカ21の動きを三角測量の原理で計測し、3次元のデータを生成して得た3次元データ取得手段40と、を備えている。
3次元データ取得手段40により得られた3次元のデータに基づき、可動部の位置データを得て、施工対象位置と可動部の位置との関係に基づき、運動部10を動作させる制御部50を備える。
Furthermore, as shown in Figure 12, the construction machine is equipped with a means 30 for obtaining information on the current position of the
The
これらについて、詳しい例示をすると次のとおりである。
トンネルT内に位置する機械本体10は、例えばNATM工法に用いるトンネル内空面に対してコンクリートを吹き付ける吹付装置である。
図示の建設機械としての吹付装置(10)は、アームとしての、中央に吹付用ブーム22(図1~図3、図6~図8において、ブーム22の符合はカバーを指示している)を有し、両側に支保工の建込み用アーム12及び作業用バケットアーム13を備えており、下部にクローラ14(又はタイヤ)を有し、トンネルT内をトンネル掘削の進行に伴って移動可能となっている。
Detailed examples of these are as follows:
The
The spraying device (10) as a construction machine shown in the figure has a
図示する実施の形態の吹付装置(10)は、その吹付用ブーム22が、機械本体10の前端部に縦軸15を中心として水平方向に旋回する支持体16に取付られ、起伏シリンダ17により上下方向に揺動するようになっている。
また、縦軸15を中心として吹付用ブーム22を水平方向に旋回するために、図4及び図5に示されている旋回シリンダ18が設けられている。
The spraying device (10) of the illustrated embodiment has a
A
さらに、吹付用ブーム22は、伸縮シリンダ23により、前後方向に伸縮するように、適宜の段数をもってテレスコピックになっている。
吹付用ブーム22の先端の先端軸部22Aには、支持ブラケット24Aが、先端軸部22Aの軸芯O1回りに旋回可能に連結されている(図7参照)。
支持ブラケット24Aには、アーム24が、(吹付用ブーム22の軸線と直交する)軸芯O2回りに垂直面に沿って回動可能に設けられ、そのアーム24先端部に、アーム24の軸芯O3回りに回転可能に支持体25が連結されている。
Furthermore, the
A
An
支持体25には、吹付ノズル26が保持されている。また、支持体25には、必要により(好ましくは配置される)レーダ距離計27が固定されている。
図6が参照されるように、吹付ノズル26はアーム24とともにトンネルTの周方向及び起伏可能となっている。
A
As shown in FIG. 6, the
上記例において、吹付ノズル26及び吹付用ブーム22、並びに説明した各運動要素は、機構学的にみれば、機械本体10に設けられ、施工のための機素を構成し、連結部は対偶をなして運動する可動部に属し、運動部20の構成要素となっている。
In the above example, the
そして、運動部20に複数のマーカ21が固定され、少なくとも一つのマーカ21は可動部に固定されている。マーカ21の設置部位の例は図3、図6、図8に示されている。吹付ノズル26の支持体25(この実施の形態における支持体25は、図6に示されているように保持枠のほか、レーダ距離計27の支持座板を含み、吹付ノズル26に連通する吹付材料の通路を保持している。なお、実施工施時に吹付材料の通路に連結されるホースは図示されていない。)についてもマーカ21が設置されている。
A number of
マーカ21を睨んでカメラ11が機械本体10に少なくとも2台、実施の形態では図11が参照されるように例えば6台のカメラ11が光軸角度を異ならせて固定され、カメラ群体11Gが構成されている。
カメラ群体11Gは、図2が参照されるように、機械本体10の前方部位に固定され、前方のマーカ21を睨むように設置されている。
At least two
As shown in FIG. 2, the
マーカ21はその移動がカメラ11によって捉えることができるものであれば限定されないが、運動位置変動に影響されることなく良好に視野Vi内で捉えることができるように、例えば半円球体の表面部にLED自発光が分散して設けられたものを好適に使用できる。
The
カメラ11の例は図10に示され、カメラ11は広角レンズを備えるものが好ましく、トンネルT内における粉塵環境であることに鑑み、マーカ21を明確に捉えることができるように、カメラ11周囲部にLED発光体11Aを複数設け、これらを粉塵対策フード11Bで覆ったものを好適に使用できる。
An example of the
上記の構成の建設機械は、例えば主に図1及び図12を参照される運転例に基づき次のように運転できる。
トンネルTの掘削計画に基づくトンネル計画情報部60からの情報が、建設機械本体10の制御部50に与えられる。
トンネル計画情報部60からの情報としては、トンネル線形に基づく各位置におけるトンネル断面情報、計画厚さ、吹付厚さ、トンネル幅値、これに対応した吹付厚に関する計画情報などである。
The construction machine having the above-mentioned configuration can be operated as follows, based on the operation example mainly shown in FIG. 1 and FIG.
Information from a tunnel plan information unit 60 based on the excavation plan for the tunnel T is provided to the
The information from the tunnel planning information unit 60 includes tunnel cross-sectional information at each position based on the tunnel alignment, planned thickness, sprayed thickness, tunnel width value, and corresponding planning information regarding the sprayed thickness.
建設機械の機械本体10のトンネル内における現位置情報も、制御部50に与えられる。
このための現位置情報取得手段30としては、図12のほか図1にも示されている、トンネル抗外からの測量により位置が既知である、例えばトンネルT内に設置されるトータルステーションTSを用いることができる。
位置が既知であるトータルステーションTSにより、機械本体10の適宜の位置に設けた、例えば汎用のプリズムターゲット19をそれぞれ捉えることにより、ターゲット19の位置を測量に基づき得て、同時にターゲット19の位置と関係づけることができる機械本体10のトンネル内の位置を設定できる。
図1及び図3には、北Nを示す磁針Mnを例示してある。
また、図1には3つのターゲット19の全てを機械本体10の後部に設けた例を示してあるが、例えば一つのターゲット19を機械本体10の後部に、他の二つを、機械本体10前部における、カメラ群体11Gを支持するフレームの上部両側に設けることなどでもよい(この形態は図21に略図で示してある。)。
Information on the current position of the
As the current position information acquisition means 30 for this purpose, a total station TS, the position of which is known by surveying from outside the tunnel T as shown in FIG. 1 as well as FIG. 12, installed within the tunnel T, for example, can be used.
By capturing, for example, a general-
1 and 3 show an example of a magnetic needle Mn indicating north N.
In addition, while FIG. 1 shows an example in which all three
機械本体10のトンネル内の位置に基づき、吹付ノズル26の位置は、運動部20に設けられた伸縮距離検知器、回転各度検出器など(当業者は当然に理解するであろうから図示を省略してある。)からの現位置及び角度などの運動データにより把握できる。
また、支持体25に固定された図5が参照されるレーダ距離計27からの信号より、トンネルTの内空面までの現離間距離(コンクリート吹付がなされているのであればコンクリート表面までの現離間距離)データを得ることができる。
Based on the position of the
In addition, data on the current distance to the inner surface of the tunnel T (the current distance to the concrete surface if concrete has been sprayed) can be obtained from a signal from a radar range finder 27 (see Figure 5) fixed to the
適切な吹付厚の制御は、上記の情報のみではでき難い。すなわち、吹付ノズル26の位置及びトンネルTの内空面に対する対向角度について複雑な動きを伴う。これは既述のように、ブーム22が起伏、旋回、伸縮し、アーム24が起伏し、支持体25が旋回することに主に原因がある。
It is difficult to control the appropriate spray thickness using only the above information. In other words, complex movements are required regarding the position of the
そこで、複数の(角度の異なる)カメラ11により得られた撮影情報より各マーカ21、21…の動きを三角測量の原理で計測し、3次元のデータを生成して得た3次元データ取得手段40が設けられる。
特開2014-211404号公報などに記載された、いわゆる「モーションキャプチャ(法)」により、運動部20の可動部の対象位置データを得る。
この3次元位置データは、制御部50に取り込まれ、レーダ距離計27からの現離間距離データに基づき、コンクリートの吹付厚(吹付時間)の制御を行う運転を行う。
Therefore, a three-dimensional data acquisition means 40 is provided that measures the movement of each
Target position data of the movable parts of the
This three-dimensional position data is input to the
ここで補足説明を行うと、カメラ11により得られた撮影情報より各マーカ21、21…の動きを、3次元(X軸、Y軸、Z軸)で捉え(三角測量の原理で計測し)、他方で、トータルステーションTSにより捉えた機械本体10の位置及び絶対方位に対する偏位角度を基礎として、各マーカ21、21…の現位置・方位及び吹付ノズル26の現位置・方位を把握できる。
このようにして、光学的に、機械本体10の3次元前方視野Vi(例えば図1のトンネル左右方向範囲、図2のトンネル上下方向範囲の視野Vi)の運動部(例えば吹付ノズル26)のモーションを捉えながら、当該運動部に目標の運動を行わせることができる。
To provide a supplementary explanation, the movement of each
In this way, it is possible to optically capture the motion of a moving part (e.g., the spray nozzle 26) in a three-dimensional forward field of view Vi of the machine body 10 (e.g., the field of view Vi of the left-right range of the tunnel in Figure 1 and the up-down range of the tunnel in Figure 2), while causing the moving part to perform a target movement.
前記例は、建設機械10がコンクリート吹付機であり、吹付ノズル26及びこれを支持体25が施工のための機素を構成しており、前記支持体25にレーダ距離検出器(レーダ距離計)27が設けられ、その距離検出器からの信号に基づき、コンクリート吹付厚の制御を行うトンネル内建設機械の運転方法である。
In the above example, the
レーダ距離計27からの現離間距離データは次のようにして得る。すなわち、ミリ波レーダ及びシンセサイザからの変調波(送信波)を生成し、これをTxアンテナを介して送信し、変調波が物体(物標)にあたり反射するのを、Rxアンテナにて物標からの反射波を受信し、ミキサにて送信波と受信波を混合し、IF(中間周波数)信号を生成し、IF信号をADCにかけて得られたデータを基に、各種信号処理を実施して位置・速度情報等を取得する。
The current distance data from the
吹付ノズル26の3次元位置及び指向方向は、種々の要素及び対偶を介して変化するように構成され、これをカメラ11により捕捉するものである。その要点について補足的に説明する。図2、図3の状態では、ブーム22が起き上がり、吹付ノズル26をその吐出口に向かって斜め後方に指向している。
図8の状態は、吹付ノズル26はトンネル天面に向かって上向きである。
図9には、縦軸15を中心として吹付用ブーム22が水平方向に旋回する結果、ブーム22と共に吹付ノズル26がトンネル左右に振れる状態が示されている。このとき、吹付ノズル26は吹付用ブーム22と軸線を同じくしている。
前述する構造によって、すなわち、アーム24に軸芯O3回りに回転可能に支持体25が連結されている結果、吹付ノズル26は、吹付用ブーム22の軸線に対して横振れも可能である。
The three-dimensional position and direction of the
In the state shown in FIG. 8, the
9 shows the state in which the
Due to the above-described structure, that is, because the
かくして、吹付ノズル26は、吹付用ブーム22の起伏、横旋回のほか、回転軸芯O1、回転軸芯O2及び回転軸芯O3を介して取付けられているために、吹付ノズル26の3次元位置及び指向方向は、3次元で移動可能である。そしてその吹付ノズル26の位置及びブーム22を含めた運動部20の動きを適確に捉えて、吹付ノズル26の3次元位置及び指向方向を制御できる。
Thus, since the
(モーションキャプチャターゲットについて)
さて、上記例においては、機械本体10が常時水平であり、この機械本体10に対して、吹付ノズル26の位置及びブーム22を含めた運動部20が確実に3次元座標に沿って運動することを理想とするものである。
(About motion capture targets)
Now, in the above example, it is ideal that the
しかし、機械本体10が常時水平でない場合があること、また、特にブーム22が長いこと、伸縮シリンダ23により、前後方向に伸縮するように、適宜の段数をもってテレスコピックになっていることなどが影響していると考えられる要因によって、ブーム22の先端位置において、その軸周りに捩れる(回転する)現象を招くことに本発明者らは直面した。
However, the inventors have come across a phenomenon in which the
かかるブーム22の捩れに伴うブーム22軸のロールのほか、ヨーやピッチが生じる可能性がある。
例えば、概念的に、図13に示すように、ブーム22の軸を、XM軸とすると、捩れによってXM軸回りのロールRoが、YM軸回りのピッチPiが、ZM軸回りのヨーYaが生じる可能性がある。
Such twisting of the
For example, conceptually, as shown in FIG. 13, if the axis of the
これらの回転が生じると、機械本体10に対して、運動部20が3次元に運動することを前提とした理想運動系からはずれ、例えば吹付ノズル26先端の位置が仮に同一であるとしても、吹付ノズル26先端の開口が向いている方向が目的の方向に対してずれてしまい、目的の壁面位置に対する目的の吹付厚での吹付が困難となる。
When these rotations occur, the moving
そこで、先に示した図6のマーカ21に換えて、すなわち、当該位置において1点のマーカ21に換えて、図14~図18に示す一例としての、少なくとも3点の自発光部を有するモーションキャプチャターゲット100を設け、ブーム22のロール(Roll)Ro、ピッチ(Pitch)Pi及びヨー(Yaw)Yaを分かるようにした。
1点のマーカ21のXYZ座標を求めるだけではロールRo、ピッチPi及びヨーYaは不明である。
Therefore, instead of the
By simply determining the XYZ coordinates of one
実施の形態のトンネル用モーションキャプチャターゲット100は、コンクリート吹付機の機械本体10と、例えば前述のように連結され、伸長した吹付用ブーム22の先端部に設けられている。
このモーションキャプチャターゲット100は、ブーム22に対して連結された吹付ノズル26を動かしながら吹付ノズル26からトンネル内壁面Tにコンクリート吹付する際に、吹付ノズル26の位置及び動きを捕捉するために設けられるものである。
The tunnel
This
実施の形態のモーションキャプチャターゲット100は、ブーム22に対する取付部111と、取付部111に接合された板状の基板部110と、基板部110の一面に取り付けられた少なくとも4個のLED部121、122、123、124とを有する。取付部111に対して基板部110は直交する又はやや上方が先端方向に傾いた、例えば90度を超え80度以下の角度範囲で傾けて一体化させてもよい。
The
前記LED部121~124は、自発光するLEDと、LEDの発光を等方的に放射する球状のカバー体とを有する。LEDは近赤外光(例えばピーク波長850nm)を用いることが好ましい。
The
LED部の直径が5~20mmであることが好ましい。この範囲とすることにより、捕捉が確実となり、もって中心点Oの位置の精度を高めることができる。直径が5mmより小さいと、粉塵により消失する確率が高くなり、3つのLED部をとらえられない場合が生じる。直径が20mmより大きい場合には、LED部の中心の位置の精度が悪くなり、中心点Oの位置の精度も悪化する。 It is preferable that the diameter of the LED section is 5 to 20 mm. This range ensures reliable capture, thereby improving the accuracy of the position of the center point O. If the diameter is smaller than 5 mm, there is a high probability that the LED sections will be lost due to dust, and there are cases where the three LED sections cannot be captured. If the diameter is larger than 20 mm, the accuracy of the position of the center of the LED section will deteriorate, and the accuracy of the position of the center point O will also deteriorate.
4個のLED部121~124はいずれも基板部110面の中心点Oから等距離R(図12参照)に配置されているのが望ましい。距離Rは60~80mmであることが好ましい。この範囲とすることにより、中心点Oの位置の精度を高めることができる。距離が60mmより小さい場合、及び、距離が80mmより大きい場合には、算出する中心点Oの位置の精度が悪化する。
LED部の直径が5~20mm、かつ、距離Rは60~80mmとすることにより、ノズルの位置を、10mm以下の精度で算出することができる。
It is desirable that all four
By setting the diameter of the LED portion to 5 to 20 mm and the distance R to 60 to 80 mm, the nozzle position can be calculated with an accuracy of 10 mm or less.
隣接するLED部121~124の間の角度α、β、γ、δが異なるように配置されるのが望ましい。
例えば、基板部110上の面における、隣接するLED部の間の角度α、β、γ、δが90度、50度、72度、148度とされている。
これらの角度とすることにより、中心点Oをリアルタイムに高精度で算出する確率を向上させることができることを確認している。
It is desirable to arrange the
For example, the angles α, β, γ, and δ between adjacent LED units on the surface of the
It has been confirmed that using these angles can improve the probability of calculating the center point O in real time with high accuracy.
LED部の数は、3個以上であれば中心点Oの画定が可能である。しかし、トンネル内での粉塵の影響に一部のLED部を検知できない、あるいは一部のLED部が発光しなくなったなどの場合にも中心点Oの画定を可能とするために4個以上であるのが望ましい。 If the number of LED units is three or more, it is possible to define the center point O. However, it is preferable that the number is four or more so that it is possible to define the center point O even in cases where some of the LED units cannot be detected due to the influence of dust inside the tunnel, or some of the LED units have stopped emitting light.
LED部の配置位置も重要である。例えば、対比例として図19に示すように、4個のLED部のうちのいずれかのLED部が、中心点Oに対し他のLED部の点対称である位置に配置された場合において、点対称に位置する1個のLED部を検知できないときを想定してみると、他方の点対称に位置するLED部と、残るLED部とで中心点Oの画定を行う必要があるが、検知できなくなったLED部がどちらであるか不明となるために、中心点Oの画定を行うことができない又は画定ミスを生じる。
したがって、中心点Oに対し他のLED部の点対称配置、あるいは点対称配置に近似する配置は避けるべきである。
The position of the LED units is also important. For example, as shown in Fig. 19 for comparison, if one of the four LED units is arranged at a position that is point-symmetrical to the other LED units with respect to the center point O, and one LED unit located at the point symmetry cannot be detected, it is necessary to define the center point O between the other LED unit located at the point symmetry and the remaining LED unit, but since it is unclear which LED unit is the one that cannot be detected, it is impossible to define the center point O or a definition error occurs.
Therefore, a point-symmetric arrangement with respect to the center point O or an arrangement close to a point-symmetric arrangement with other LED parts should be avoided.
単純に反射体をLEDに置き換えただけでは、LEDの発光に指向性があるので、アームの動きに従い、カメラでとらえる発光の強さが変化し、カメラで撮影した連続画像においてLEDの輪郭がぶれ、LEDの中心位置の精細度に欠ける場合が生じる。
粉塵の舞う作業環境下なので、粉塵に遮られ、LEDの発光を撮影できない瞬間が生じる場合があったが、4個のLED部を上記配置にすることにより、1個のLED部がある瞬間、粉塵で捕らえられなくとも、残りの3つのLED部で中心点Oをリアルタイムに高精度で算出することができる。この意味で、LED部の数は4個を超える数であってもよい。
If the reflector were simply replaced with an LED, the LED's light emission would be directional, so the intensity of the light captured by the camera would change according to the movement of the arm, causing the outline of the LED to blur in successive images taken by the camera and resulting in a lack of precision in the center position of the LED.
Since the work environment is dusty, there are cases where the LED light emission cannot be photographed due to the dust blocking it, but by arranging the four LED units as described above, even if one LED unit is blocked by dust at a certain moment, the remaining three LED units can calculate the center point O in real time with high accuracy. In this sense, the number of LED units may be more than four.
上記LED部121、122、123、124は、基板部110における位置が既知され、区別のためにナンバリングされた状態でモーションキャプチャソフトに予め記憶される。
The positions of the
このうえで、カメラ側から見た、ステレオ連続画像を画像分析して、LED部の中心点OのX座標、Y座標及びZ座標、回転(ヨー、ピッチ、ロール)を算出する。
中心点Oの3次元座標は、3個のLED部の各3次元座標に基づき算出する。
Then, the continuous stereo images seen from the camera side are analyzed to calculate the X, Y and Z coordinates and rotation (yaw, pitch and roll) of the center point O of the LED unit.
The three-dimensional coordinates of the center point O are calculated based on the three-dimensional coordinates of each of the three LED units.
建設機械に取り付けた3つのプリズムの位置と、機械座標系の関係を押さえて重機のキャリブレーションを行い、以下のようにして、ロール、ピッチ、ヨーイングが算出できるようにしておく。 The heavy machinery is calibrated by determining the relationship between the positions of the three prisms attached to the construction machinery and the machine coordinate system, so that the roll, pitch, and yaw can be calculated as follows.
(ア)まず、6台又は図20、図21に示すような7台のカメラ11がカメラ群体11Gのフレームにどのように配置されているかキャリブレーションを行う。
(イ)このキャリブレーションには、例えば図20に示すような、T字状のキャリブレーショ治具50を用いて行うことができる。
この治具50は、両端、並びに中心近傍を避けて左右に離間距離の差が生じる位置に自発光のLEDマーカ51,52、53が設置された(設置位置及び離間距離は既知)ものである。
(ウ)カメラ視野内で、 キャリブレーション治具50を作業員が振り回す(LEDマーカ51,52、53の取り付けた支持棒部を、振り回し面内でメトロノームのように揺動させる、並びにキャリブレーション治具50の支持棒部を、その縦断する面に対して前後に交差する、車輪の転動軌跡のような動きを与える、などする)過程で、各カメラに画像情報として取り込み、各カメラからの画像情報に基づき、個々のカメラの位置の差異を逆算しカメラ群体11Gにおける各カメラ配置を確定させる。
(エ)カメラは、事項以降で説明する設定するカメラ座標系でローカルのX,Y,Z座標を計算することができるようになる。
(A) First, calibration is performed to determine how the six
(a) This calibration can be performed using, for example, a T-shaped
This
(c) Within the camera field of view, an operator swings around the calibration jig 50 (the support rod portion to which the
(d) The camera will be able to calculate local X, Y, and Z coordinates in a camera coordinate system that will be set up as described below.
(オ)次に、カメラ座標系を設定するために、図21に示すように、カメラ視野内に三脚にそれぞれ取り付けたLEDマーカを60A、60B、60Cの3台を、平面視でほぼL字型配置で、ほぼ水平に設置する。このとき、L字型配置の長手方向は重機の軸方向に合わせのるのが望ましい。
L字の角(図21ではLEDマーカ60B)がカメラ座標系の原点(0,0,0)となり、長手方向(LEDマーカ60Bと60Cとを結ぶ方向)がX軸、直角方向(LEDマーカ60Bと60Aとを結ぶ方向)がY軸とする(X軸とY軸であってもよい。)。
長手方向を重機の軸に合わせることによって、建設機械のロール、ピッチ、ヨーと、カメラ座標系のロール、ピッチ、ヨーとを一致させることができる。
(カ)建設機械に取り付けた3つのプリズム19と、カメラ座標系の原点であるL字の角のLEDマーカ60Bを、測量係がトンネル内に持ち込んだ、あるいはトンネル内に既設のトータルステーションTSで計測して、機械座標系とカメラ座標系の原点の関係を押さえておく。
(E) Next, to set the camera coordinate system, three
The corner of the L-shape (
By aligning the longitudinal direction with the axis of the heavy equipment, the roll, pitch, and yaw of the construction equipment can be made to match the roll, pitch, and yaw of the camera coordinate system.
(f) The three
(キ)カメラ視野内にあるL字型に配置したLEDマーカ60Bの中心座標を各カメラで読み取る。これによりカメラ座標系を設定できる。
(ク)絶対座標系に配置された建設機械の3つのプリズム19を計測すると、機械座標系とカメラ座標系の原点との関係より、カメラ座標系の原点の絶対座標系での座標が算出される。
(ケ)このときの建設機械における運動部(例えばブーム)を動作させたときのロール、ピッチ、ヨーイングが、カメラ座標系の絶対座標系に対するロール、ピッチ、ヨーイングとなる。
(コ)モーションカメラが対象物となるLEDマーカを視認した際に算出するカメラ座標系のローカルのX,Y,Z座標を、(ケ)で得られたロール、ピッチ、ヨーイングを基に座標系の回転を行い、絶対座標系でのX,Y,Z座標に変換する。
(サ)(ク)で求めたカメラ座標系原点の絶対座標系の座標と、(コ)で求めた変換後の座標を合成すると、モーションカメラで対象物を見た際に、絶対座標系で座標が算出できる。
(g) The center coordinates of the
(h) When the three
(i) At this time, the roll, pitch, and yawing caused when a moving part (for example, a boom) of the construction machine is operated become the roll, pitch, and yawing relative to the absolute coordinate system of the camera coordinate system.
(J) The local X, Y, and Z coordinates of the camera coordinate system calculated when the motion camera visually recognizes the target LED marker are converted into X, Y, and Z coordinates in the absolute coordinate system by rotating the coordinate system based on the roll, pitch, and yawing obtained in (K).
By combining the coordinates in the absolute coordinate system of the origin of the camera coordinate system obtained in (sa) and (ku) with the transformed coordinates obtained in (ko), it is possible to calculate the coordinates in the absolute coordinate system when the target object is viewed with the motion camera.
本発明のモーションキャプチャターゲットを備えた建設機械は、NATM工法、例えばトンネル内に位置して施工する、コンクリート吹付機(装置)のほか、支保工設置用機械、トンネルドリルジャンボなどの、NATM工法における建設機械一般に適用可能である。 The construction machine equipped with the motion capture target of the present invention can be applied to general construction machines used in the NATM method, such as concrete spraying machines (equipment) located inside tunnels for construction, as well as machines for installing shoring and tunnel drill jumbos.
10…コンクリート吹付機(NATM工法用建設機械)の機械本体、20…運動部、22…吹付用ブーム(アーム)、26…吹付ノズル(機素)、100…トンネル用モーションキャプチャターゲット、110…基板部、111…取付部、121、122、123、124…LED部。 10...Main body of concrete sprayer (construction machine for NATM method), 20...Moving part, 22...Spraying boom (arm), 26...Spraying nozzle (machine element), 100...Tunnel motion capture target, 110...Base plate part, 111...Mounting part, 121, 122, 123, 124...LED part.
Claims (9)
前記ターゲットは、自発光する少なくとも3個のLEDであり、
その少なくとも3個のLEDの配置が、その3個のLEDの配置基準面の中心位置を定める関係にある、
ことを特徴とするモーションキャプチャターゲットを備えた建設機械。 A motion capture target is attached to the tip of the arm unit in order to capture the position and movement of the element when performing construction work while moving the arm unit of the construction machine and the element attached to the tip of the arm unit,
the target is at least three self-illuminating LEDs;
The arrangement of the at least three LEDs is in a relationship that determines a center position of a reference plane for the arrangement of the three LEDs.
A construction machine equipped with a motion capture target.
前記ターゲットは、自発光する少なくとも4個のLEDであり、そのうちの少なくとも3個のLEDの配置が、その3個のLEDの配置基準面の中心位置を定める関係にある、
ことを特徴とするモーションキャプチャターゲットを備えた建設機械。 A motion capture target is attached to the tip of the arm unit in order to capture the position and movement of the element when performing construction work while moving the arm unit of the construction machine and the element attached to the tip of the arm unit,
The target is at least four self-emitting LEDs, and the arrangement of at least three of the LEDs is in a relationship that determines the center position of an arrangement reference plane for the three LEDs.
A construction machine equipped with a motion capture target.
A method for operating a construction machine equipped with a motion capture target, in which, when operating the construction machine of claim 8, the construction machine is operated while grasping the position of the tip of the arm portion or the spray nozzle, as well as movements including roll, pitch and yaw angles.
Publications (1)
Publication Number | Publication Date |
---|---|
JP2024086016A true JP2024086016A (en) | 2024-06-27 |
Family
ID=
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9207078B2 (en) | Device for measuring and marking space points along horizontally running contour lines | |
CN104428626B (en) | Laser pickoff | |
EP2068116B1 (en) | Surveying system | |
JP4998924B2 (en) | Drilling positioning control method for bogie mounted carriage and boom movement control method for tunnel construction machine | |
US6844923B2 (en) | Method and apparatus for surveying the geometry of tunnels | |
JPS5929754B2 (en) | Surveying method in propulsion method | |
JP2012018073A (en) | Inspection system | |
CN110736446A (en) | boom-type roadheader pose identification system and method | |
JP2019167678A (en) | Tunnel spray control method | |
AU2019405686A1 (en) | Method and device for determining the position of a mining and/or construction machine | |
JPH0823260B2 (en) | Drilling position control method and device for rock drill | |
JP2024086016A (en) | Construction machinery with motion capture targets | |
JP2006057439A (en) | Boom positioning control method for construction machinery | |
JP4233725B2 (en) | Setting device for reference position and direction of drilling machine | |
JP3413580B2 (en) | How to display the drilling position on the tunnel face | |
JPH07173987A (en) | Drilling position indicating method for tunnel working face and drilling position indicating system used for the method | |
JP3682461B1 (en) | Drilling positioning control method for bogie mounted carriage | |
JP2009198329A (en) | Position measurement system and position measurement method | |
JPH0747918B2 (en) | Drilling position control method and device for rock drill | |
JP2022074712A (en) | Vacancy information acquisition method within tunnel | |
JP2022075099A (en) | Operating device for construction machine and operation method therefor | |
JP2020084551A (en) | Spray thickness estimation device | |
JP2010270518A (en) | Drilling positioning control method for rock-drill loaded truck, and boom movement control method for tunnel construction machine | |
JP4278766B2 (en) | Method for detecting swivel center of swivel in free section excavator | |
JPH02232499A (en) | Automatic survey positioning system of tunnel living machine |