JP6202559B2 - 埋設管路の計測装置、及び、埋設管路の計測方法 - Google Patents
埋設管路の計測装置、及び、埋設管路の計測方法 Download PDFInfo
- Publication number
- JP6202559B2 JP6202559B2 JP2013156041A JP2013156041A JP6202559B2 JP 6202559 B2 JP6202559 B2 JP 6202559B2 JP 2013156041 A JP2013156041 A JP 2013156041A JP 2013156041 A JP2013156041 A JP 2013156041A JP 6202559 B2 JP6202559 B2 JP 6202559B2
- Authority
- JP
- Japan
- Prior art keywords
- measurement
- measuring
- information
- vehicle
- surface shape
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 41
- 238000005259 measurement Methods 0.000 claims description 227
- 238000012937 correction Methods 0.000 claims description 42
- 238000004364 calculation method Methods 0.000 claims description 38
- 238000012545 processing Methods 0.000 claims description 7
- 230000004807 localization Effects 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 230000003028 elevating effect Effects 0.000 claims description 5
- 230000036544 posture Effects 0.000 description 24
- 230000032683 aging Effects 0.000 description 7
- 239000010865 sewage Substances 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 6
- 230000033001 locomotion Effects 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 2
- 238000009412 basement excavation Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000018109 developmental process Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000001965 increasing effect Effects 0.000 description 2
- 238000003780 insertion Methods 0.000 description 2
- 230000037431 insertion Effects 0.000 description 2
- 238000011835 investigation Methods 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000011002 quantification Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1656—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with passive imaging devices, e.g. cameras
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C7/00—Tracing profiles
- G01C7/06—Tracing profiles of cavities, e.g. tunnels
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Multimedia (AREA)
- Sewage (AREA)
- Length Measuring Devices By Optical Means (AREA)
Description
本発明は、下水管等の埋設管路の内面の地理座標を測位する技術に関するものであって、詳しくは前記埋設管路の埋設位置の測量、及び前記埋設管の内面形状の測定技術に関するものである。
近年、下水管路等インフラ設備の老朽化が進む中で、老朽管の更新に向けては様々な調査が必要となってきている。
例えば老朽管の埋設位置の特定、及び老朽管の劣化度合いの定量化、また更生時に必要な内面形状の精度測量等が調査診断業務としてなされている。
このうち、埋設位置の特定については、公的な管理台帳においても充分な情報が無い場合があり、開削及び人手による測量を行っているのが現状である。
また、老朽管の復旧措置として、既設管内に別の管を敷設する更生工法があるが、更生前には内面形状の精度測量が必要であり、現状では既設管径よりやや小径のダミー管を全管経路に渡って挿入し、おおまかな形状を推察するダミー管挿入調査法を用いて、施工時に必要な口径を決定している。
例えば老朽管の埋設位置の特定、及び老朽管の劣化度合いの定量化、また更生時に必要な内面形状の精度測量等が調査診断業務としてなされている。
このうち、埋設位置の特定については、公的な管理台帳においても充分な情報が無い場合があり、開削及び人手による測量を行っているのが現状である。
また、老朽管の復旧措置として、既設管内に別の管を敷設する更生工法があるが、更生前には内面形状の精度測量が必要であり、現状では既設管径よりやや小径のダミー管を全管経路に渡って挿入し、おおまかな形状を推察するダミー管挿入調査法を用いて、施工時に必要な口径を決定している。
竹内栄二朗、坪内孝司、「疎行列連立方程式解法に基づく複数外界センサを用いた地図生成」第１３回ロボティックスシンポジア予稿集 P.166−P.173、2008年３月
下水管等埋設管の埋設位置の特定について、開削工事と人手による測量を行う場合、公共道路の封鎖や膨大な測量費用を必要とする。今後の老朽化した社会インフラは益々増大し、これらコストの課題を解決する事は老朽化したインフラストックの整備を遅滞なく進める上で急務となってくる。
埋設管の内面形状の測量において、ダミー管挿入調査法においては、管路の不陸、蛇行、段差の詳細がわからず、計画設計通りに施工出来ない場合がある。
埋設管の内面形状の測量において、ダミー管挿入調査法においては、管路の不陸、蛇行、段差の詳細がわからず、計画設計通りに施工出来ない場合がある。
測量対象物の3次元位置を移動体により測量する方法としては、車両にIMU（Inertial Measurement Unitの略。慣性計測装置）とオドメトリ（odometry。走行距離計）、GPS受信装置を搭載し、GPS情報を元に逐次自己位置の補正をしながら測量する方法（特開2013-113702）がある（特許文献１参照）。
また、上記同様の測量におけるIMUの累積誤差、及びGPS受信のバラツキより生じる誤差を補正するために、得られたデータにベイズフィルタ処理を行い（Kalmanフィルタリング）自己位置の精度を上げながら測量する方法がある(特開2009-121945）（特許文献２参照）。
また、上記同様の測量におけるIMUの累積誤差、及びGPS受信のバラツキより生じる誤差を補正するために、得られたデータにベイズフィルタ処理を行い（Kalmanフィルタリング）自己位置の精度を上げながら測量する方法がある(特開2009-121945）（特許文献２参照）。
これら先行技術はいずれもオドメトリ及びIMUにより連続的な自己位置の移動を計測しながら、約1秒間隔で受信できるGPSによりその誤差を逐次補正し、自己位置を特定する方法である。
しかしながら、これら技術的アルゴリズムを、埋設された管路の地理座標測位に適用する場合、逐次のGPS補正が出来ない。
しかしながら、これら技術的アルゴリズムを、埋設された管路の地理座標測位に適用する場合、逐次のGPS補正が出来ない。
これに対し、IMU、オドメトリの誤差を最小化するアルゴリズムとして、近年、三次元SLAM（Simultaneous Localization And Mapping)アルゴリズムの一種であるGraph-SLAMアルゴリズムの活用が試みられている。前記三次元ＳＬＡＭは、３次元空間で計測装置の位置・姿勢と周辺の地図を同時に推定するアルゴリズムであり、前記Graph-SLAMアルゴリズムは三次元ＳＬＡＭの解法の１つである。
Graph-SLAMアルゴリズムのGraphとは図形のグラフの意味であり、Graph-SLAMアルゴリズムにおいては、計測装置（台車・センサ）で周囲を計測するたびに、計測装置をノード（結束）とし、その間をリンクとし、リンクのつながりを位置に関する推定誤差とするグラフを作成する。また、ランドマークを観測するたびに、先ほどのグラフに、計測装置とランドマークをノード（結束）とし、その間の観測をリンクとし、リンクのつながりの強さを観測誤差とする部分グラフを追加する。できたグラフのいくつかのノードの位置が分かった際に、もっともよく当てはまるグラフの形を推定することで、計測装置の位置・姿勢と周辺の地図を構築する方法である。(非特許文献１参照）
Graph-SLAMアルゴリズムのGraphとは図形のグラフの意味であり、Graph-SLAMアルゴリズムにおいては、計測装置（台車・センサ）で周囲を計測するたびに、計測装置をノード（結束）とし、その間をリンクとし、リンクのつながりを位置に関する推定誤差とするグラフを作成する。また、ランドマークを観測するたびに、先ほどのグラフに、計測装置とランドマークをノード（結束）とし、その間の観測をリンクとし、リンクのつながりの強さを観測誤差とする部分グラフを追加する。できたグラフのいくつかのノードの位置が分かった際に、もっともよく当てはまるグラフの形を推定することで、計測装置の位置・姿勢と周辺の地図を構築する方法である。(非特許文献１参照）
しかし、埋設管路内に特徴的なランドマークを設定する事は作業上困難、設置できたとしても管路全般に渡って設置するのは現実的で無い。
そこで、埋設管路内に特徴的なランドマークがない場合であっても、最低限、計測開始位置と計測終了位置の座標を特定することができれば、埋設管路内における計測車の走行回路を正確に推定することを可能とし、さらには、埋設された管路の地理座標測位を可能とする技術を提供することを目的として本発明はなされたものである。
そこで、埋設管路内に特徴的なランドマークがない場合であっても、最低限、計測開始位置と計測終了位置の座標を特定することができれば、埋設管路内における計測車の走行回路を正確に推定することを可能とし、さらには、埋設された管路の地理座標測位を可能とする技術を提供することを目的として本発明はなされたものである。
本発明の請求項１に係る埋設管路の計測装置は、
走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車と、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を出力する開始位置特定手段と、
計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を出力する終了位置特定手段と、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する逐次位置推定演算手段と、
所定の時間間隔ごとに、前記逐次位置推定演算手段により得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる内面形状情報を用いて逐次補正演算する逐次位置補正演算手段と、
前記計測終了位置に到達後において、前記逐次補正演算された前記逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う全補正演算手段と、を備えたことを特徴としている。
走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車と、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を出力する開始位置特定手段と、
計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を出力する終了位置特定手段と、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する逐次位置推定演算手段と、
所定の時間間隔ごとに、前記逐次位置推定演算手段により得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる内面形状情報を用いて逐次補正演算する逐次位置補正演算手段と、
前記計測終了位置に到達後において、前記逐次補正演算された前記逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う全補正演算手段と、を備えたことを特徴としている。
請求項２では、さらに、前記全補正演算手段により得られる、前記計測車が走行した経路の全体位置推定情報と、前記内面形状計測手段により得られる、前記管路の内面形状情報に基づいて、前記管路の内面の位置を推定することにより、前記管路の地理座標を推定する管路地理座標推定手段を備えたことを特徴としている。
請求項３では、前記内面形状計測手段として、前記管路の内面を走査するレーザー計測装置が用いられている。
請求項４では、前記内面形状計測手段は、互いに非平行な３つの平面内を走査して前記管路の内面形状情報を得るように構成されている。
請求項３では、前記内面形状計測手段として、前記管路の内面を走査するレーザー計測装置が用いられている。
請求項４では、前記内面形状計測手段は、互いに非平行な３つの平面内を走査して前記管路の内面形状情報を得るように構成されている。
請求項５では、前記内面形状計測手段は、前記管路の管軸に垂直な平面内を走査して、少なくとも前記管路の断面形状を計測するように構成されている。
請求項６では、前記内面形状計測手段は、前記管路の管軸方向成分と、当該管軸に直交する水平方向成分とで特定される平面内を走査して、少なくとも前記管路の管軸方向の横断面形状を計測するように構成されている。
請求項６では、前記内面形状計測手段は、前記管路の管軸方向成分と、当該管軸に直交する水平方向成分とで特定される平面内を走査して、少なくとも前記管路の管軸方向の横断面形状を計測するように構成されている。
請求項７では、前記内面形状計測手段は、前記管路の管軸方向成分を含む垂直平面内を走査して、少なくとも前記管路の管軸方向の縦断面形状を計測するように構成されている
。
請求項８では、前記内面形状計測手段が配設された架台を昇降させる昇降機構を備えている。
。
請求項８では、前記内面形状計測手段が配設された架台を昇降させる昇降機構を備えている。
請求項９では、前記三次元ＳＬＡＭアルゴリズムとして、
特定された前記計測開始位置と特定された前記計測終了位置をランドマークとし、 前記計測開始位置と特定された前記計測終了位置の間における計測車の逐次位置情報を、その間のリンクとノードとし、
前記リンクのつながりの強さを計測誤差とするグラフを作成し、当該グラフが最も当てはまる形を推定することで、前記計測車の位置および姿勢の推定と、地図作製を並行して実行するGraph-SLAMアルゴリズムを用いることを特徴としている。
特定された前記計測開始位置と特定された前記計測終了位置をランドマークとし、 前記計測開始位置と特定された前記計測終了位置の間における計測車の逐次位置情報を、その間のリンクとノードとし、
前記リンクのつながりの強さを計測誤差とするグラフを作成し、当該グラフが最も当てはまる形を推定することで、前記計測車の位置および姿勢の推定と、地図作製を並行して実行するGraph-SLAMアルゴリズムを用いることを特徴としている。
請求項１０に係る埋設管路の計測方法は、
走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車を用いた埋設管路の計測方法であって、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を得る第１のステップと、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する第２のステップと、
所定の時間間隔ごとに、前記第２のステップにおいて得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる前記管路の内面形状情報を用いて逐次補正演算する第３のステップと、
前記計測終了位置に到達後において、計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を得る第４のステップと、
前記計測終了位置に到達後において、前記逐次補正演算された前記計測車の逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う第５のステップと、を含んでいることを特徴としている。
走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車を用いた埋設管路の計測方法であって、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を得る第１のステップと、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する第２のステップと、
所定の時間間隔ごとに、前記第２のステップにおいて得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる前記管路の内面形状情報を用いて逐次補正演算する第３のステップと、
前記計測終了位置に到達後において、計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を得る第４のステップと、
前記計測終了位置に到達後において、前記逐次補正演算された前記計測車の逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う第５のステップと、を含んでいることを特徴としている。
本発明によれば、計測対象の管路の計測開始位置座標を特定しておき、走行距離計測手段、姿勢計測手段または慣性計測手段、および、管路の内面形状を計測する内面形状計測手段を備えた計測車を管路内を移動させて、
前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記管路内を走行中に、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算し、前記内面形状計測手段による管路の内面形状情報に基づいて、前記管路内を走行中における前記計測車の逐次位置情報を逐次補正演算する。
そして、前記計測終了位置に到達後においては、計測終了位置座標を特定して、前記補正演算された前記逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいた三次元ＳＬＡＭアルゴリズムによって全補正して、前記計測車が走行した経路の三次元空間における位置推定を行うので、ＧＰＳを直接利用できない埋設管路内の走行経路を正確に推定することができる。
前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記管路内を走行中に、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算し、前記内面形状計測手段による管路の内面形状情報に基づいて、前記管路内を走行中における前記計測車の逐次位置情報を逐次補正演算する。
そして、前記計測終了位置に到達後においては、計測終了位置座標を特定して、前記補正演算された前記逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいた三次元ＳＬＡＭアルゴリズムによって全補正して、前記計測車が走行した経路の三次元空間における位置推定を行うので、ＧＰＳを直接利用できない埋設管路内の走行経路を正確に推定することができる。
請求項２によれば、上記構成に加えて、さらに、前記全補正演算手段にて得られた、前記計測車が走行した経路の全体位置推定情報と、前記内面形状計測手段による前記管路の内面形状情報に基づいて、前記管路の内面の位置を推定することにより、前記管路の地理座標を推定する管路地理座標推定手段を備えているので、前記走行経路に基づいて管路の位置を正確に推定することが可能となる。
請求項３によれば、前記内面形状計測手段として、前記管路の内面を走査するレーザー計測装置が用いられているので、小型且つ低コストで埋設管路の計測装置を構成できる。
請求項４によれば、前記内面形状計測手段は、互いに非平行な３つの平面内を走査して前記管路の内面形状情報を得るので、管路の内面形状情報を、より詳細に得ることができ、管路の不陸、蛇行等の状況をより正確に把握することができる。
請求項３によれば、前記内面形状計測手段として、前記管路の内面を走査するレーザー計測装置が用いられているので、小型且つ低コストで埋設管路の計測装置を構成できる。
請求項４によれば、前記内面形状計測手段は、互いに非平行な３つの平面内を走査して前記管路の内面形状情報を得るので、管路の内面形状情報を、より詳細に得ることができ、管路の不陸、蛇行等の状況をより正確に把握することができる。
請求項５によれば、前記内面形状計測手段は、前記管路の管軸に垂直な平面内を走査するので、管軸に垂直な管路の断面形状を計測しやすい。
請求項６によれば、前記内面形状計測手段は、前記管路の管軸方向成分と、当該管軸に直交する水平方向成分とで特定される平面内を走査するので、管路の内面の側面部分の形状を計測しやすい。
請求項６によれば、前記内面形状計測手段は、前記管路の管軸方向成分と、当該管軸に直交する水平方向成分とで特定される平面内を走査するので、管路の内面の側面部分の形状を計測しやすい。
請求項７によれば、前記内面形状計測手段は、前記管路の管軸方向成分を含む垂直平面内を走査するので、管路の内面の天井と床の形状を計測しやすい。
請求項８によれば、前記内面形状計測手段が配設された架台を昇降させる昇降機構を備えているので、異なる管の内部においても、前記内面形状計測手段の高さを前記管軸と一致させて配設しやすく、管内面の形状を把握しやすい。
請求項８によれば、前記内面形状計測手段が配設された架台を昇降させる昇降機構を備えているので、異なる管の内部においても、前記内面形状計測手段の高さを前記管軸と一致させて配設しやすく、管内面の形状を把握しやすい。
請求項９では、前記三次元ＳＬＡＭアルゴリズムとしては、特定された前記計測開始位置と特定された前記計測終了位置をランドマークとするGraph-SLAMアルゴリズムを用いるので、実際の埋設管路の位置をさらに正確に推定することができる。
請求項１０に係る埋設管路の計測方法は、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する第２のステップと、
所定の時間間隔ごとに、前記第２のステップにおいて得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる前記管路の内面形状情報を用いて逐次補正演算する第３のステップと、
前記計測終了位置に到達後において、計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を得る第４のステップと、
前記計測終了位置に到達後において、前記逐次補正演算された前記計測車の逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う第５のステップとを含んでいるので、ＧＰＳを直接利用できない埋設管路内の走行経路を正確に推定することができ、さらに、前記走行経路に基づいて管路の位置を正確に推定することが可能となる。
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する第２のステップと、
所定の時間間隔ごとに、前記第２のステップにおいて得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる前記管路の内面形状情報を用いて逐次補正演算する第３のステップと、
前記計測終了位置に到達後において、計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を得る第４のステップと、
前記計測終了位置に到達後において、前記逐次補正演算された前記計測車の逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う第５のステップとを含んでいるので、ＧＰＳを直接利用できない埋設管路内の走行経路を正確に推定することができ、さらに、前記走行経路に基づいて管路の位置を正確に推定することが可能となる。
図１は、計測対象の埋設された管路の断面の概略を示した模式図であり、
ｍ１は計測開始位置のマンホール、ｍ２は計測終了位置のマンホール、１は計測対象の管路Ｐ内に配置された計測車である。計測車１は、計測開始位置のマンホールｍ１から計測終了位置のマンホールｍ２まで管路Ｐ内を計測しつつ移動する。なお、管路Ｐの内径が充分に大きい場合には、作業者が押して移動させることができるが、管路Ｐの内径が小さい場合には、計測車１のフックにロープ等を繋ぎ、計測終了位置のマンホールｍ２から牽引等して移動させる。
ｍ１は計測開始位置のマンホール、ｍ２は計測終了位置のマンホール、１は計測対象の管路Ｐ内に配置された計測車である。計測車１は、計測開始位置のマンホールｍ１から計測終了位置のマンホールｍ２まで管路Ｐ内を計測しつつ移動する。なお、管路Ｐの内径が充分に大きい場合には、作業者が押して移動させることができるが、管路Ｐの内径が小さい場合には、計測車１のフックにロープ等を繋ぎ、計測終了位置のマンホールｍ２から牽引等して移動させる。
次に、計測車１の構造を、図２、図３、図４を参照して説明する。
計測車１は、例えば、２つの前輪と２つの後輪とを備えた車体２と、車体２の上部に配設された水平な架台３を備えている。なお、図２においては、計測車１を水平な管路内に配置した状態を示している。
車体２の後部には、走行距離を計測して走行距離情報を出力する走行距離計測手段としてのオドメトリ４を備えている。
前記架台３の上面には、計測車１の姿勢を計測して姿勢情報を出力する慣性計測手段としてのＩＭＵ５と、
管路の内面形状を計測して内面形状情報を出力する内面形状計測手段として、第１、第２、第３の３つのレーザー計測装置６、７、８が固定されている。
前記３つのレーザー計測装置６、７、８は、互いに非平行な（具体的には、互いに直交する）３つの平面内を走査して管路の内面形状情報を計測するように構成されている。
なお、慣性計測手段としてのＩＭＵ５に代えて、他の姿勢計測手段を用いることもできる。
計測車１は、例えば、２つの前輪と２つの後輪とを備えた車体２と、車体２の上部に配設された水平な架台３を備えている。なお、図２においては、計測車１を水平な管路内に配置した状態を示している。
車体２の後部には、走行距離を計測して走行距離情報を出力する走行距離計測手段としてのオドメトリ４を備えている。
前記架台３の上面には、計測車１の姿勢を計測して姿勢情報を出力する慣性計測手段としてのＩＭＵ５と、
管路の内面形状を計測して内面形状情報を出力する内面形状計測手段として、第１、第２、第３の３つのレーザー計測装置６、７、８が固定されている。
前記３つのレーザー計測装置６、７、８は、互いに非平行な（具体的には、互いに直交する）３つの平面内を走査して管路の内面形状情報を計測するように構成されている。
なお、慣性計測手段としてのＩＭＵ５に代えて、他の姿勢計測手段を用いることもできる。
オドメトリ４は、図３に示したように、真下の管底位置から若干振った位置で、管の内面に接触できるように支持ブーム４１を振った状態で斜めに支持する機構を備えている。真下の管底近傍には下水が流れていたり、堆積物が存在する確立が高いため、斜めに支持する機構によって、これらの下水や堆積物などを避けて管の内面に接触し、より正確な距離測定が可能となる。
ＩＭＵ５は、３軸のジャイロと３方向の加速度計を備えており、３次元の角速度と加速度が求められる。３次元の角速度情報を積分することにより計測車の向き（姿勢）を求め、加速度情報に基づいて重力方向を求めることができる。
オドメトリ４による走行距離とＩＭＵ５による走行方向とを蓄積処理することによって、計測開始位置を基準とした計測車の自己位置情報を逐次得て、さらに、計測開始位置からの走行軌跡を得ることができる。ここにおける処理を、逐次位置推定演算（Ａ）と称する。この逐次位置推定演算（Ａ）の詳細は後述する。
オドメトリ４とＩＭＵ５によって計測車の自己位置計測手段を構成している。
ＩＭＵ５は、３軸のジャイロと３方向の加速度計を備えており、３次元の角速度と加速度が求められる。３次元の角速度情報を積分することにより計測車の向き（姿勢）を求め、加速度情報に基づいて重力方向を求めることができる。
オドメトリ４による走行距離とＩＭＵ５による走行方向とを蓄積処理することによって、計測開始位置を基準とした計測車の自己位置情報を逐次得て、さらに、計測開始位置からの走行軌跡を得ることができる。ここにおける処理を、逐次位置推定演算（Ａ）と称する。この逐次位置推定演算（Ａ）の詳細は後述する。
オドメトリ４とＩＭＵ５によって計測車の自己位置計測手段を構成している。
３つのレーザー計測装置６、７、８とＩＭＵ５は、図４に示したように、管内画像撮像用のカメラ９とともに、計測車１上に配設された架台３に固定されている。
前記架台３は、ハンドル操作によるパンタグラフ機構３１によって水平に昇降させて、第１のレーザー計測装置６の走査中心軸と、管軸とがほぼ一致するように調整することが可能である。（図２、図３参照。）
前記架台３は、ハンドル操作によるパンタグラフ機構３１によって水平に昇降させて、第１のレーザー計測装置６の走査中心軸と、管軸とがほぼ一致するように調整することが可能である。（図２、図３参照。）
次に、各レーザー計測装置６、７、８の配置を、図２〜図５を参照して説明する。
第1のレーザー計測装置６は、管軸方向に垂直な平面（図５の平面Ｂ、Ｘ−Ｚ平面）内を走査して、管路の断面における管路内面の各点の逐次位置を計測するように構成されている。なお、前記管軸方向とは、実施例では、第1のレーザー計測装置６におけるレーザー光の走査軸方向である。
第１のレーザー計測装置６から得られる計測データを、断面計測センサーデータと称する。
第1のレーザー計測装置６は、管軸方向に垂直な平面（図５の平面Ｂ、Ｘ−Ｚ平面）内を走査して、管路の断面における管路内面の各点の逐次位置を計測するように構成されている。なお、前記管軸方向とは、実施例では、第1のレーザー計測装置６におけるレーザー光の走査軸方向である。
第１のレーザー計測装置６から得られる計測データを、断面計測センサーデータと称する。
第２のレーザー計測装置７は、管軸方向成分と、前記管軸方向成分に直交する水平方向成分とで規定される平面（図５の平面Ａ、Ｘ−Ｙ平面）内を走査して、管路の管軸方向の横断面における管路内面の各点の逐次位置を計測するように構成されている。
第２のレーザー計測装置７から得られる計測データを、水平計測センサーデータと称する。
第２のレーザー計測装置７から得られる計測データを、水平計測センサーデータと称する。
第３のレーザー計測装置８は、管軸方向成分を含む垂直平面（図５の平面Ｃ、Ｙ−Ｚ平面）内を走査して、管路の管軸方向の縦断面における管路内面の各点の逐次位置を計測するように構成されている。
第３のレーザー計測装置８から得られる計測データを、垂直計測センサーデータと称する。
第３のレーザー計測装置８から得られる計測データを、垂直計測センサーデータと称する。
図４の（Ａ）に示したように、前記架台３には、第１のレーザー計測装置６の走査範囲を広く確保するための切り込み６１と、第３のレーザー計測装置８の走査範囲を広く確保するための切り込み８１とが設けられている。
なお、３つのレーザー計測装置６、７、８の走査面は、図５に示したように、互いに直交する３つの平面としたが、互いに平行でなく交差する平面であれば、演算が複雑にはなるが直交しなくてもよい。
なお、３つのレーザー計測装置６、７、８の走査面は、図５に示したように、互いに直交する３つの平面としたが、互いに平行でなく交差する平面であれば、演算が複雑にはなるが直交しなくてもよい。
第１〜第３のレーザー計測装置６、７、８によって、計測車１の特定の基準点を基準として、管路の内面の各点の逐次位置を計測することによって、管路の内面の３次元形状を計測する。
次に、図１に例示した管路Ｐを、前記計測車１を用いて計測する手順を説明する。
まず、計測開始地点となるマンホールｍ１の底部に配置された計測車１の初期位置と姿勢（方向）を計測する。これは、地表に設置した、ＧＰＳ装置もしくはトータルステーション等の位置特定手段を用いて測定して決定する。
このような初期位置の決定作業においては、計測車１はマンホールの底もしくは管路内等の地下に存在するため、ＧＰＳ電波を利用するＧＰＳ装置で直接初期位置を決定することは困難である。また、初期状態での計測車の姿勢（向き、方向）を決定する必要もある。そのための具体的な手順は、後述する実施例１〜４のように種々考えられる。
まず、計測開始地点となるマンホールｍ１の底部に配置された計測車１の初期位置と姿勢（方向）を計測する。これは、地表に設置した、ＧＰＳ装置もしくはトータルステーション等の位置特定手段を用いて測定して決定する。
このような初期位置の決定作業においては、計測車１はマンホールの底もしくは管路内等の地下に存在するため、ＧＰＳ電波を利用するＧＰＳ装置で直接初期位置を決定することは困難である。また、初期状態での計測車の姿勢（向き、方向）を決定する必要もある。そのための具体的な手順は、後述する実施例１〜４のように種々考えられる。
何れかの手順で計測車１の初期位置と姿勢を決定した後、計測車１を移動させて管路Ｐの計測を開始する。
管路内を移動中は、オドメトリ４による走行距離とＩＭＵ５による走行方向とを蓄積処理することによって、計測開始位置を基準とした計測車１の自己位置情報を、後述する逐次位置推定演算（Ａ）によって逐次得る。
さらに、３つのレーザー計測装置６、７、８によって得られた断面計測センサーデータ、水平計測センサーデータ、および垂直計測センサーデータを用いて、逐次位置推定演算（Ａ）にて得られた自己位置情報を、後述する逐次位置補正演算（Ｂ）によって逐次補正して、補正後の自己位置情報を得る。
管路内を移動中は、オドメトリ４による走行距離とＩＭＵ５による走行方向とを蓄積処理することによって、計測開始位置を基準とした計測車１の自己位置情報を、後述する逐次位置推定演算（Ａ）によって逐次得る。
さらに、３つのレーザー計測装置６、７、８によって得られた断面計測センサーデータ、水平計測センサーデータ、および垂直計測センサーデータを用いて、逐次位置推定演算（Ａ）にて得られた自己位置情報を、後述する逐次位置補正演算（Ｂ）によって逐次補正して、補正後の自己位置情報を得る。
以上のようにして、計測車１を、計測開始位置から埋設された管路内を移動させながら、計測開始位置を基準とした自己位置情報を前記逐次位置推定演算（Ａ）によって逐次計測し、さらに、前記逐次位置補正演算（Ｂ）によって逐次補正しつつ、計測終了位置へ向かう。
計測終了位置となるマンホールｍ２の底部に到達すると、地上に設置したＧＰＳ装置もしくはトータルステーション等の位置特定手段を用いて計測車１の終焉位置と終焉姿勢（方向）を計測する。
このようにして得られた計測車１の終焉位置と姿勢に基づいて、前記逐次位置補正演算（Ｂ）によって得られた全ての自己位置情報と姿勢情報を、Graph-SLAMアルゴリズムを用いて補正する。この補正演算処理を全補正Graph-SLAM（Ｃ）と称する。
計測終了位置となるマンホールｍ２の底部に到達すると、地上に設置したＧＰＳ装置もしくはトータルステーション等の位置特定手段を用いて計測車１の終焉位置と終焉姿勢（方向）を計測する。
このようにして得られた計測車１の終焉位置と姿勢に基づいて、前記逐次位置補正演算（Ｂ）によって得られた全ての自己位置情報と姿勢情報を、Graph-SLAMアルゴリズムを用いて補正する。この補正演算処理を全補正Graph-SLAM（Ｃ）と称する。
前記Graph-SLAMアルゴリズムのGraphとは図形のグラフの意味であり、Graph-SLAMアルゴリズムは三次元ＳＬＡＭの解法の１つである。
Graph-SLAMアルゴリズムにおいては、計測装置（台車・センサ）で周囲を計測するたびに、計測装置をノード（結束）とし、その間をリンクとし、リンクのつながりを位置に関する推定誤差とするグラフを作成する。また、ランドマークを観測するたびに、先ほどのグラフに、計測装置とランドマークをノード（結束）とし、その間の観測をリンクとし、リンクのつながりの強さを観測誤差とする部分グラフを追加する。できたグラフのいくつ
かのノードの位置が分かった際に、もっともよく当てはまるグラフの形を推定することで、計測装置の位置・姿勢と周辺の地図を構築する方法である。
本発明の場合では、ランドマークは、マンホールｍ１の位置での台車の位置座標（計測開始位置情報）と、マンホールｍ２の位置での台車の位置座標（計測終了位置情報）に対応し、その間のリンクとノードは、マンホールｍ１，ｍ２の間における計測装置の逐次位置情報に対応している。
Graph-SLAMアルゴリズムにおいては、計測装置（台車・センサ）で周囲を計測するたびに、計測装置をノード（結束）とし、その間をリンクとし、リンクのつながりを位置に関する推定誤差とするグラフを作成する。また、ランドマークを観測するたびに、先ほどのグラフに、計測装置とランドマークをノード（結束）とし、その間の観測をリンクとし、リンクのつながりの強さを観測誤差とする部分グラフを追加する。できたグラフのいくつ
かのノードの位置が分かった際に、もっともよく当てはまるグラフの形を推定することで、計測装置の位置・姿勢と周辺の地図を構築する方法である。
本発明の場合では、ランドマークは、マンホールｍ１の位置での台車の位置座標（計測開始位置情報）と、マンホールｍ２の位置での台車の位置座標（計測終了位置情報）に対応し、その間のリンクとノードは、マンホールｍ１，ｍ２の間における計測装置の逐次位置情報に対応している。
以下においては、前記逐次位置推定演算（Ａ）、前記逐次位置補正演算（Ｂ）、そして、前記全補正演算（Ｃ）について、図６を参照して詳細に説明する。
図６に示したステップＳ１においては、
計測開始位置のマンホールｍ１に設置したＧＰＳ装置等の位置特定手段を用いて、計測車１の初期位置（X0,Y0,Z0)と初期姿勢(R0,P0,Ya0)を得る。
X0,Y0,Z0は、それぞれ位置情報のX座標成分、Y座標成分、Z座標成分を示し、R0,P0,Ya0は、それぞれ姿勢情報のRoll成分、Pitch成分、Yaw成分を示している。
図６に示したステップＳ１においては、
計測開始位置のマンホールｍ１に設置したＧＰＳ装置等の位置特定手段を用いて、計測車１の初期位置（X0,Y0,Z0)と初期姿勢(R0,P0,Ya0)を得る。
X0,Y0,Z0は、それぞれ位置情報のX座標成分、Y座標成分、Z座標成分を示し、R0,P0,Ya0は、それぞれ姿勢情報のRoll成分、Pitch成分、Yaw成分を示している。
ステップＳ２においては、オドメトリ４による走行距離情報（x,y,z)と、ＩＭＵ５による姿勢情報（R,P,Ya）とに基づいて逐次位置推定演算（Ａ）を行い、ステップＳ３において、次の位置における自己位置情報（Xt,Yt,Zt)と姿勢情報（Rt,Pt,Yat）を得る。
ステップＳ４においては、前記自己位置情報（Xt,Yt,Zt)と姿勢情報（Rt,Pt,Yat）を、断面計測センサーデータと、水平計測センサーデータと、垂直計測センサーデータを用いて、逐次位置補正演算（Ｂ）を行い、ステップＳ５において、補正後の自己位置情報（X't,Y't,Z't)と姿勢情報（R't,P't,Ya't）を得る。
以上のステップＳ２〜ステップＳ５の処理を、所定時間間隔で繰り返しつつ、計測終了位置へ向かう。
ステップＳ４においては、前記自己位置情報（Xt,Yt,Zt)と姿勢情報（Rt,Pt,Yat）を、断面計測センサーデータと、水平計測センサーデータと、垂直計測センサーデータを用いて、逐次位置補正演算（Ｂ）を行い、ステップＳ５において、補正後の自己位置情報（X't,Y't,Z't)と姿勢情報（R't,P't,Ya't）を得る。
以上のステップＳ２〜ステップＳ５の処理を、所定時間間隔で繰り返しつつ、計測終了位置へ向かう。
計測終了位置のマンホールｍ２に到達すると、
ステップＳ６において、計測終了位置のマンホールｍ２に設置したＧＰＳ装置等の位置特定手段を用いて、計測車１の終焉位置（Xe,Ye,Ze)と終焉姿勢(Re,Pe,Yae)を得る。
この後、ステップＳ７においては、ステップＳ１〜ステップＳ５によって得られた、全ての前記補正後の自己位置情報（X't,Y't,Z't)と姿勢情報（R't,P't,Ya't）を、前記計測車１の終焉位置（Xe,Ye,Ze)と終焉姿勢(Re,Pe,Yae)に基づいて補正する。
この補正が前記全補正Graph-SLAM（Ｃ）である。
ステップＳ６において、計測終了位置のマンホールｍ２に設置したＧＰＳ装置等の位置特定手段を用いて、計測車１の終焉位置（Xe,Ye,Ze)と終焉姿勢(Re,Pe,Yae)を得る。
この後、ステップＳ７においては、ステップＳ１〜ステップＳ５によって得られた、全ての前記補正後の自己位置情報（X't,Y't,Z't)と姿勢情報（R't,P't,Ya't）を、前記計測車１の終焉位置（Xe,Ye,Ze)と終焉姿勢(Re,Pe,Yae)に基づいて補正する。
この補正が前記全補正Graph-SLAM（Ｃ）である。
ステップＳ８においては、以上の全補正Graph-SLAM（Ｃ）によって、計測開始位置から計測終了位置までの全ての前記補正後の自己位置情報（X't,Y't,Z't)と姿勢情報（R't,P't,Ya't）を補正して、計測開始位置から計測終了位置までの全ての自己位置情報（X,Y,Z)と姿勢情報（R,P,Ya）を確定する。
ステップＳ９においては、以上において計測開始位置から計測終了位置までにおける計測車１の自己位置情報（全体位置推定情報）が全経路にわたって確定されたことにより、前記計測車が走行した経路の全体位置推定情報と、前記内面形状計測手段による、前記管路の内面形状情報に基づいて、計測車１の逐次位置における管内面の位置を推定することができ、計測開始位置から計測終了位置までにおける管路の地理座標を確定することができる。
さらに、ステップＳ１０においては、以下のようにして、管内の不陸情報、および管路の蛇行情報を得ることができる。
蛇行と不陸の分離のために、管断面を計測するための第１のレーザー計測装置６と、管軸に平行な垂直断面を計測するための第３のレーザー計測装置８とを用いる。図１３においては、第１のレーザー計測装置６による管断面の計測状況を楕円で示し、第３のレーザー計測装置８による垂直断面の計測状況を矢線で示した。
管内においては、図１３の領域Ａのように通常天井と床とは平行になっているため、図１３の領域Ｂのように計測車１の傾き（姿勢）と、第３のレーザー計測装置８によって計測した管内の天井の傾きとが一致しない場合には、不陸と判断できる。この場合には、天井と床の傾きも一致しない。
また、図１３の領域Ｃのように計測車１の傾きと、天井および床の傾きとが一致している場合には、不陸ではなく、管の蛇行であると判断できる。
蛇行と不陸の分離のために、管断面を計測するための第１のレーザー計測装置６と、管軸に平行な垂直断面を計測するための第３のレーザー計測装置８とを用いる。図１３においては、第１のレーザー計測装置６による管断面の計測状況を楕円で示し、第３のレーザー計測装置８による垂直断面の計測状況を矢線で示した。
管内においては、図１３の領域Ａのように通常天井と床とは平行になっているため、図１３の領域Ｂのように計測車１の傾き（姿勢）と、第３のレーザー計測装置８によって計測した管内の天井の傾きとが一致しない場合には、不陸と判断できる。この場合には、天井と床の傾きも一致しない。
また、図１３の領域Ｃのように計測車１の傾きと、天井および床の傾きとが一致している場合には、不陸ではなく、管の蛇行であると判断できる。
なお、前記ステップＳ１は特許請求の範囲に記載された第１のステップに、
前記ステップＳ２、Ｓ３は特許請求の範囲に記載された第２のステップに、
前記ステップＳ４、Ｓ５は特許請求の範囲に記載された第３のステップに、
前記ステップＳ６は特許請求の範囲に記載された第４のステップに、
前記ステップＳ７、Ｓ８は特許請求の範囲に記載された第５のステップにそれぞれ対応している。
なお、前記ステップＳ９は、特許請求の範囲に記載された管路地理座標推定手段における処理に対応している。
前記ステップＳ２、Ｓ３は特許請求の範囲に記載された第２のステップに、
前記ステップＳ４、Ｓ５は特許請求の範囲に記載された第３のステップに、
前記ステップＳ６は特許請求の範囲に記載された第４のステップに、
前記ステップＳ７、Ｓ８は特許請求の範囲に記載された第５のステップにそれぞれ対応している。
なお、前記ステップＳ９は、特許請求の範囲に記載された管路地理座標推定手段における処理に対応している。
以上のようにして、計測開始位置と計測終了位置において、ＧＰＳ装置もしくはトータルステーション等の位置特定手段を用いてグローバル座標系における地理座標を得ることができれば、計測開始位置から計測終了位置までの埋設管の位置を全て得ることができる。
さらには、管路の途中における蛇行と不陸の分離も可能であるので、実際に長期間使用された下水管等の埋設管路でも充分正確に地理座標を得ることができる。したがって、下水管等の既設の埋設管の埋設位置の特定が、開削工事と人手による測量を行うことなく、正確に行えるので、計測費用を低減することが可能となり、今後の老朽化した社会インフラストックの整備を遅滞なく進めることが可能となる。
さらには、管路の途中における蛇行と不陸の分離も可能であるので、実際に長期間使用された下水管等の埋設管路でも充分正確に地理座標を得ることができる。したがって、下水管等の既設の埋設管の埋設位置の特定が、開削工事と人手による測量を行うことなく、正確に行えるので、計測費用を低減することが可能となり、今後の老朽化した社会インフラストックの整備を遅滞なく進めることが可能となる。
なお、前記逐次位置推定演算（Ａ）、前記逐次位置補正演算（Ｂ）、および、前記全補正演算（Ｃ）の一部もしくは全ての演算は、計測車１に搭載したパーソナルコンピュータ（可搬型の小型コンピュータ）で処理してもよい。また、オドメトリ４、ＩＭＵ５、および３つのレーザー計測装置６、７、８による計測情報の一部もしくは全てを、有線もしくは無線の通信手段を介して、随時外部へ送信して外部に設置したコンピュータを用いて蓄積および演算を処理してもよい。そのための通信手段として、電波や赤外線等を利用した無線通信手段や、保護された通信ケーブルや光ファイバ等の有線通信手段を利用することができる。そして、保護された通信ケーブルや光ファイバは、計測車１を牽引するローブに沿わせて敷設してもよい。以上において、計測車１に搭載したパーソナルコンピュータもしくは外部に設置したコンピュータは、特許請求の範囲に記載された逐次位置推定手段、逐次位置補正手段、全補正演算手段、及び、管路地理座標推定手段に対応している。
次に、前記逐次位置推定演算（Ａ）の詳細を説明する。
時刻tでの計測車の位置xtは、下記の式で求める。
ｘは計測車の位置、θは計測車の姿勢、ｕは微小変化量。
時刻tでの計測車の位置xtは、下記の式で求める。
θr ：ロール軸周りの回転角
θp ：ピッチ軸周りの回転角
θy ：ヨー軸周りの回転角
角度の更新式を以下に示す。
位置の更新式を以下に示す。
Rは、以下に示すように、それぞれの軸周りでの回転行列である。
次に、前記逐次位置補正演算（Ｂ）の詳細を説明する。
前記逐次位置補正演算（Ｂ）は、第１のレーザー計測装置６によって得られる断面計測センサーデータと、第２のレーザー計測装置７によって得られる水平計測センサーデータと、第３のレーザー計測装置８によって得られる垂直計測センサーデータとを用いた補正であり、オドメトリ４による位置推定だけでは誤差が大きいと考えられるので、前記３つのレーザー計測装置６、７、８を用いて逐次位置の補正を行うものである。
前記逐次位置補正演算（Ｂ）は、第１のレーザー計測装置６によって得られる断面計測センサーデータと、第２のレーザー計測装置７によって得られる水平計測センサーデータと、第３のレーザー計測装置８によって得られる垂直計測センサーデータとを用いた補正であり、オドメトリ４による位置推定だけでは誤差が大きいと考えられるので、前記３つのレーザー計測装置６、７、８を用いて逐次位置の補正を行うものである。
時刻tにおけるオドメトリ４による位置をxt、レーザー計測装置による管内形状の計測値をztとする。h(xt)は、１つ前の時刻の位置から、オドメトリ、ＩＭＵで計測した微小位置移動に基づいた時刻ｔの管内形状の推定値である。
誤差のためztとh(xt)は一致しないので、その差に定数Ｋを乗じたものと加算して位置xtを補正する。
Kはカルマンゲインであり、共分散行列Σ、Ο(位置データの誤差の大きさ)の比であらわされる。
誤差のためztとh(xt)は一致しないので、その差に定数Ｋを乗じたものと加算して位置xtを補正する。
h(x):計測の予測値
Ｈ :ヤコビ行列
Σ :運動モデルの共分散行列
Ο :計測の共分散行列
次に、前記全補正Graph-SLAM（Ｃ）の詳細を説明する。
計測終了位置のマンホールｍ２位置での修正にGraph-SLAMを用いる。
下記の式で示したJGraph-SLAMを最小化するxが最も確からしい推定結果となる。
g(ut,xt-t)はひとつ前の位置と、微小移動量から現在位置を推定する関数であるから、xt-g(ut,xt-t)は推定位置の差分となる。これに共分散行列R(誤差の大きさを示す)の逆行列をかけた[xt-g(ut,xt-t)]TR-1 [xt-g(ut,xt-t)]は運動モデルの拘束条件となる。
h(mc,xt)はマンホール位置mから計測車の位置ｘを計測したときの計測関数である。これと実際の計測値ｚの差にこれに共分散行列Q(誤差の大きさを示す)をかけたΣ[zt-h(mc,xt)]TQ-1 [zt-h(mc,xt)] は計測モデルの拘束条件となる。（図８参照。）
これらの拘束条件の和が以下に示すJGraph-SLAMである。
計測終了位置のマンホールｍ２位置での修正にGraph-SLAMを用いる。
下記の式で示したJGraph-SLAMを最小化するxが最も確からしい推定結果となる。
g(ut,xt-t)はひとつ前の位置と、微小移動量から現在位置を推定する関数であるから、xt-g(ut,xt-t)は推定位置の差分となる。これに共分散行列R(誤差の大きさを示す)の逆行列をかけた[xt-g(ut,xt-t)]TR-1 [xt-g(ut,xt-t)]は運動モデルの拘束条件となる。
h(mc,xt)はマンホール位置mから計測車の位置ｘを計測したときの計測関数である。これと実際の計測値ｚの差にこれに共分散行列Q(誤差の大きさを示す)をかけたΣ[zt-h(mc,xt)]TQ-1 [zt-h(mc,xt)] は計測モデルの拘束条件となる。（図８参照。）
これらの拘束条件の和が以下に示すJGraph-SLAMである。
ＩＭＵを用いた計測において、傾き誤差が最も大きくなるベクトルはYawである。
Roll、Pitch は重力方向をIMUで検知して誤差補正できる。
Yawは誤差補正に地磁気の検出を要するが、埋設管路内では地磁気は使用できないため、Yawの自動的な誤差補正は望めない。しかし、本発明によれば、３つのレーザー計測装置による補正を併用して、管路内での逐次補正演算（Ｂ）を行うことにより、Yawの自動的な誤差補正も可能となった。さらに、計測終了位置におけるＧＰＳ等による位置情報によって、全補正Graph-SLAM（Ｃ）により、全地理座標を補正することにより、さらに正確な管路の地理座標の特定が可能となった。
Roll、Pitch は重力方向をIMUで検知して誤差補正できる。
Yawは誤差補正に地磁気の検出を要するが、埋設管路内では地磁気は使用できないため、Yawの自動的な誤差補正は望めない。しかし、本発明によれば、３つのレーザー計測装置による補正を併用して、管路内での逐次補正演算（Ｂ）を行うことにより、Yawの自動的な誤差補正も可能となった。さらに、計測終了位置におけるＧＰＳ等による位置情報によって、全補正Graph-SLAM（Ｃ）により、全地理座標を補正することにより、さらに正確な管路の地理座標の特定が可能となった。
以下においては、計測開始位置と計測終了位置のマンホールｍ１，ｍ２での位置計測方法の実施例を説明する。
ＧＰＳ等の全地球測位システムもしくはトータルステーション等により計測された計測車１の異なる２箇所の座標位置（Xm0,Ym0,Zm0）及び（Xm1,Ym1,Zm1）から、１つの座標位置及び方角（X0,Y0,Z0,Ya0）を演算により取得し、またＩＭＵ５により方角以外の姿勢（R0,P0）を取得し、それらより計測車１の１つの座標位置及び姿勢（X0,Y0,Z0,R0,P0,Ya0）を特定する。
ＧＰＳ等の全地球測位システムもしくはトータルステーション等により計測された計測車１の異なる２箇所の座標位置（Xm0,Ym0,Zm0）及び（Xm1,Ym1,Zm1）から、１つの座標位置及び方角（X0,Y0,Z0,Ya0）を演算により取得し、またＩＭＵ５により方角以外の姿勢（R0,P0）を取得し、それらより計測車１の１つの座標位置及び姿勢（X0,Y0,Z0,R0,P0,Ya0）を特定する。
まず、計測開始位置と計測終了位置における計測車１の座標位置を特定するための第１の具体的な方法を、図９を参照して説明する。
図９に示したように、計測開始位置のマンホールｍ１の上部開口部にはトータルステーションＴＳを配し、トータルステーションＴＳの真下のマンホールｍ１の底面に計測車１を配置する。マンホールｍ１の底部は計測対象の管路Ｐとつながっている。
計測車１に方眼プレート１１を設置し、トータルステーションＴＳにレーザ求心装置ＬＣを取り付け、方眼プレート１１に求心レーザが照射されるように、トータルステーションＴＳの地上位置を調節する。
図９に示したように、計測開始位置のマンホールｍ１の上部開口部にはトータルステーションＴＳを配し、トータルステーションＴＳの真下のマンホールｍ１の底面に計測車１を配置する。マンホールｍ１の底部は計測対象の管路Ｐとつながっている。
計測車１に方眼プレート１１を設置し、トータルステーションＴＳにレーザ求心装置ＬＣを取り付け、方眼プレート１１に求心レーザが照射されるように、トータルステーションＴＳの地上位置を調節する。
その位置でのトータルステーションＴＳでの計測により、地上座標を求める。また方眼プレート１１のどの位置に求心レーザが照射されているかを記録する。
トータルステーションＴＳから方眼プレート１１までの距離は別途メジャー等の距離計測手段を用いて計測する。
上記方法を方眼プレート１１の別の位置でも行い、計測車１の異なる２箇所の座標位置の特定を行う。２箇所の座標位置から計測車１の姿勢を特定する。
以上のようにして、計測開始位置における計測車１の位置と姿勢を決定する。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、前記トータルステーションＴＳ、前記レーザ求心装置ＬＣ、前記距離計測手段、及び前記方眼プレート１１が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
トータルステーションＴＳから方眼プレート１１までの距離は別途メジャー等の距離計測手段を用いて計測する。
上記方法を方眼プレート１１の別の位置でも行い、計測車１の異なる２箇所の座標位置の特定を行う。２箇所の座標位置から計測車１の姿勢を特定する。
以上のようにして、計測開始位置における計測車１の位置と姿勢を決定する。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、前記トータルステーションＴＳ、前記レーザ求心装置ＬＣ、前記距離計測手段、及び前記方眼プレート１１が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
上記の場合は地上から計測車１が真下に見える場合であるが、図１０のようにマンホールｍ１の真下は管への接続するための空間となっているだけの場合もある。
その場合には、以下の第２の具体的な方法を用いることができる。
マンホールの真下に立方体１２を設置する。
地上からは上記方法と同様に、トータルステーション等を用いて立方体１２の位置測定を行う。
また計測車１からは、レーザー計測装置７、８、９を用いて立方体１２の位置形状を計測する。
これにより、計測開始位置における計測車１の位置と姿勢を決定する。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、トータルステーション、前記立方体１２、及び前記レーザー計測装置７、８、９が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
その場合には、以下の第２の具体的な方法を用いることができる。
マンホールの真下に立方体１２を設置する。
地上からは上記方法と同様に、トータルステーション等を用いて立方体１２の位置測定を行う。
また計測車１からは、レーザー計測装置７、８、９を用いて立方体１２の位置形状を計測する。
これにより、計測開始位置における計測車１の位置と姿勢を決定する。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、トータルステーション、前記立方体１２、及び前記レーザー計測装置７、８、９が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
第３の具体的な方法は、図１１に示したように、計測車１にLEDランプ１３を４箇所に設置し、マンホールの蓋の代わりに設置できるカメラＣＭを取り付けた器具を設置する。
カメラＣＭの位置は地上にてトータルステーション等を用いて座標位置計測を行う。
写真測量により、計測車１の位置と姿勢の特定を行う。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、トータルステーション、前記カメラＣＭ、及び前記LEDランプ１３が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
カメラＣＭの位置は地上にてトータルステーション等を用いて座標位置計測を行う。
写真測量により、計測車１の位置と姿勢の特定を行う。
計測終了位置のマンホールｍ２においても同様の作業を行う。
以上においては、トータルステーション、前記カメラＣＭ、及び前記LEDランプ１３が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
第４の具体的な方法は、図１２に示したように、計測車１に方眼プレート１４を設置し、地上の３箇所からハンディ計測器Ｈ１、Ｈ２、Ｈ３にて方眼プレート１４の特定の２箇所への距離を計測する。
各ハンディ計測器Ｈ１、Ｈ２、Ｈ３の座標位置は地上にてトータルステーション等を用いて座標位置計測を行う。
これにより、計測車１の位置と姿勢の特定を行う。
計測終了位置のマンホールｍ２においても同様の作業を行う。
計測車１の位置を特定する方法は種々あるが、以上の４つの具体的な方法を例示した。
計測開始位置のマンホールｍ１と、計測終了位置のマンホール２とでは、同じ方法に限らず異なる方法を用いてもよい。
以上においては、前記トータルステーション、前記ハンディ計測器Ｈ１、Ｈ２、Ｈ３、及び前記方眼プレート１４が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
各ハンディ計測器Ｈ１、Ｈ２、Ｈ３の座標位置は地上にてトータルステーション等を用いて座標位置計測を行う。
これにより、計測車１の位置と姿勢の特定を行う。
計測終了位置のマンホールｍ２においても同様の作業を行う。
計測車１の位置を特定する方法は種々あるが、以上の４つの具体的な方法を例示した。
計測開始位置のマンホールｍ１と、計測終了位置のマンホール２とでは、同じ方法に限らず異なる方法を用いてもよい。
以上においては、前記トータルステーション、前記ハンディ計測器Ｈ１、Ｈ２、Ｈ３、及び前記方眼プレート１４が、特許請求の範囲に記載された開始位置特定手段、または終了位置特定手段に対応している。
走行距離計測手段としては、車輪を用いたオドメトリに代えて、走行距離を計測するものであれば種々の距離計測手段を利用することができる。
姿勢計測手段または慣性計測手段としては、慣性計測装置（IMU）に代えて、地磁気を利用した姿勢方位基準装置（ＡＨＲＳ）等の技術を利用することができる。
埋設管路中では、地磁気が利用できない場合もあるため、慣性計測装置（IMU）が好ましい。
内面形状計測手段としては、レーザー計測装置に限らず、内面計測手段から管の内壁面までの距離を非接触で計測可能な種々の距離計測装置を利用することができる。
例えば、充分に高精度のミリ波レーダーを用いた距離計測装置等を利用することができる。
姿勢計測手段または慣性計測手段としては、慣性計測装置（IMU）に代えて、地磁気を利用した姿勢方位基準装置（ＡＨＲＳ）等の技術を利用することができる。
埋設管路中では、地磁気が利用できない場合もあるため、慣性計測装置（IMU）が好ましい。
内面形状計測手段としては、レーザー計測装置に限らず、内面計測手段から管の内壁面までの距離を非接触で計測可能な種々の距離計測装置を利用することができる。
例えば、充分に高精度のミリ波レーダーを用いた距離計測装置等を利用することができる。
また、内面形状計測手段として、３つのレーザー計測装置６、７、８を搭載した例を説明したが、３つに限定されるものではなく、１つ以上のレーザー計測装置を用いて内面形状情報を得ることが可能である。
レーザー計測装置の数を多くすれば、さらに高精度の計測が可能となる。
管の内径がある程度既知であれば、１つのレーザー計測装置を用いることが可能である。
また、三角測量の原理に基づいて薄いシート状の光を投影することで対象物の３次元位置を得る光切断法を用いた３次元計測装置を利用することも可能である。
また、現時点では高価であるが、３次元スキャナー装置を利用して、１台の三次元スキャナー装置で管の内面形状計測手段を構成することも可能である。
レーザー計測装置の数を多くすれば、さらに高精度の計測が可能となる。
管の内径がある程度既知であれば、１つのレーザー計測装置を用いることが可能である。
また、三角測量の原理に基づいて薄いシート状の光を投影することで対象物の３次元位置を得る光切断法を用いた３次元計測装置を利用することも可能である。
また、現時点では高価であるが、３次元スキャナー装置を利用して、１台の三次元スキャナー装置で管の内面形状計測手段を構成することも可能である。
ｍ１ 計測開始位置のマンホール
ｍ２ 計測終了位置のマンホール
Ｐ 計測対象の管路
１ 計測車
２ 車体
３ 架台
３１ パンタグラフ機構
４ オドメトリ、走行距離計測手段
５ ＩＭＵ、慣性計測手段
６ 第１のレーザー計測装置、内面形状計測手段
６１ 切り込み
７ 第２のレーザー計測装置、内面形状計測手段
８ 第３のレーザー計測装置、内面形状計測手段
８１ 切り込み
９ カメラ
１１ 方眼プレート
１２ 立方体
１３ LEDランプ
１４ 方眼プレート
ＴＳ トータルステーション、開始位置特定手段、終了位置特定手段
ＣＭ カメラ
Ｈ１，Ｈ２，Ｈ３ ハンディ計測器
ｍ２ 計測終了位置のマンホール
Ｐ 計測対象の管路
１ 計測車
２ 車体
３ 架台
３１ パンタグラフ機構
４ オドメトリ、走行距離計測手段
５ ＩＭＵ、慣性計測手段
６ 第１のレーザー計測装置、内面形状計測手段
６１ 切り込み
７ 第２のレーザー計測装置、内面形状計測手段
８ 第３のレーザー計測装置、内面形状計測手段
８１ 切り込み
９ カメラ
１１ 方眼プレート
１２ 立方体
１３ LEDランプ
１４ 方眼プレート
ＴＳ トータルステーション、開始位置特定手段、終了位置特定手段
ＣＭ カメラ
Ｈ１，Ｈ２，Ｈ３ ハンディ計測器
Claims (10)
- 走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車と、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を出力する開始位置特定手段と、
計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を出力する終了位置特定手段と、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する逐次位置推定演算手段と、
所定の時間間隔ごとに、前記逐次位置推定演算手段により得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる内面形状情報を用いて逐次補正演算する逐次位置補正演算手段と、
前記計測終了位置に到達後において、前記逐次補正演算された前記逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う全補正演算手段と、を備えたことを特徴とする埋設管路の計測装置。 - 前記全補正演算手段により得られる、前記計測車が走行した経路の全体位置推定情報と、前記内面形状計測手段により得られる、前記管路の内面形状情報に基づいて、前記管路の内面の位置を推定することにより、前記管路の地理座標を推定する管路地理座標推定手段を備えたことを特徴とする、請求項１に記載の埋設管路の計測装置。
- 前記内面形状計測手段として、前記管路の内面を走査するレーザー計測装置が用いられることを特徴とする、請求項１、２の何れか１項に記載の埋設管路の計測装置。
- 前記内面形状計測手段は、互いに非平行な３つの平面内を走査して前記管路の内面形状情報を得るように構成されていることを特徴とする、請求項３に記載の埋設管路の計測装置。
- 前記内面形状計測手段は、前記管路の管軸に垂直な平面内を走査して、少なくとも前記管路の断面形状を計測するように構成されていることを特徴とする、請求項４に記載の埋設管路の計測装置。
- 前記内面形状計測手段は、前記管路の管軸方向成分と、当該管軸に直交する水平方向成分とで特定される平面内を走査して、少なくとも前記管路の管軸方向の横断面形状を計測するように構成されていることを特徴とする、請求項４に記載の埋設管路の計測装置。
- 前記内面形状計測手段は、前記管路の管軸方向成分を含む垂直平面内を走査して、少なくとも前記管路の管軸方向の縦断面形状を計測するように構成されていることを特徴とする、請求項４に記載の埋設管路の計測装置。
- 前記内面形状計測手段が配設された架台を昇降させる昇降機構を備えていることを特徴とする、請求項１〜７の何れか１項に記載の埋設管路の計測装置。
- 前記三次元ＳＬＡＭアルゴリズムとして、
特定された前記計測開始位置と特定された前記計測終了位置をランドマークとし、 前記計測開始位置と特定された前記計測終了位置の間における計測車の逐次位置情報を、その間のリンクとノードとし、
前記リンクのつながりの強さを計測誤差とするグラフを作成し、当該グラフが最も当てはまる形を推定することで、前記計測車の位置および姿勢の推定と、地図作製を並行して実行するGraph-SLAMアルゴリズムを用いることを特徴とする、請求項１に記載の埋設管路の計測装置。 - 走行距離を計測して走行距離情報を出力する走行距離計測手段、計測車の姿勢を計測して姿勢情報を出力する姿勢計測手段または慣性計測手段、および、管路の内面形状を計測して内面形状情報を出力する内面形状計測手段を備えて管路内を走行可能な計測車を用いた埋設管路の計測方法であって、
計測開始位置における前記計測車の位置と姿勢を特定して計測開始位置情報を得る第１のステップと、
前記管路内を走行中に、所定の時間間隔ごとに、前記走行距離計測手段により得られる走行距離情報と前記姿勢計測手段または慣性計測手段により得られる姿勢情報を用いて、前記計測開始位置を基準とした前記計測車の逐次位置情報を逐次推定演算する第２のステップと、
所定の時間間隔ごとに、前記第２のステップにおいて得られる前記計測車の逐次位置情報を、前記内面形状計測手段により得られる前記管路の内面形状情報を用いて逐次補正演算する第３のステップと、
前記計測終了位置に到達後において、計測終了位置における前記計測車の位置と姿勢を特定して計測終了位置情報を得る第４のステップと、
前記計測終了位置に到達後において、前記逐次補正演算された前記計測車の逐次位置情報を、前記計測開始位置情報と前記計測終了位置情報に基づいて、位置推定と地図作製を並行して実行する三次元ＳＬＡＭ（Simultaneous Localization And Mapping）アルゴリズムによって全補正演算処理して、前記計測車が走行した経路の三次元空間における位置推定を行う第５のステップと、を含んでいることを特徴とする埋設管路の計測方法。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013156041A JP6202559B2 (ja) | 2013-07-26 | 2013-07-26 | 埋設管路の計測装置、及び、埋設管路の計測方法 |
| PCT/JP2014/069656 WO2015012382A1 (ja) | 2013-07-26 | 2014-07-25 | 埋設管路の計測装置、及び、埋設管路の計測方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013156041A JP6202559B2 (ja) | 2013-07-26 | 2013-07-26 | 埋設管路の計測装置、及び、埋設管路の計測方法 |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2015025753A JP2015025753A (ja) | 2015-02-05 |
| JP2015025753A5 JP2015025753A5 (ja) | 2017-04-13 |
| JP6202559B2 true JP6202559B2 (ja) | 2017-09-27 |
Family
ID=52393414
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2013156041A Active JP6202559B2 (ja) | 2013-07-26 | 2013-07-26 | 埋設管路の計測装置、及び、埋設管路の計測方法 |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP6202559B2 (ja) |
| WO (1) | WO2015012382A1 (ja) |
Families Citing this family (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6272269B2 (ja) * | 2015-04-28 | 2018-01-31 | 三菱電機株式会社 | 横断スキャンデータ補正装置および横断スキャンデータ補正プログラム |
| KR101742487B1 (ko) | 2015-09-23 | 2017-06-02 | 전자부품연구원 | 관로 내 위치 인식 장치 및 방법 |
| KR102147661B1 (ko) | 2016-03-15 | 2020-08-26 | 한국전자기술연구원 | 위치 인식 시스템 및 방법 |
| JP6874343B2 (ja) * | 2016-11-24 | 2021-05-19 | 株式会社豊田中央研究所 | 地図作成装置 |
| KR101956447B1 (ko) * | 2017-04-20 | 2019-03-12 | 한국과학기술원 | 그래프 구조 기반의 무인체 위치 추정 장치 및 그 방법 |
| KR102030612B1 (ko) * | 2018-08-23 | 2019-10-10 | 한국지질자원연구원 | 위치가 공간형상정보로 정의되는 지도를 이용한 네비게이션 시스템 |
| JP7261439B2 (ja) * | 2018-10-16 | 2023-04-20 | 株式会社弘栄ドリームワークス | 配管測定システム、配管測定装置、情報処理装置およびプログラム |
| JP7290885B2 (ja) * | 2018-10-16 | 2023-06-14 | 株式会社弘栄ドリームワークス | 配管測定装置 |
| JP2020197467A (ja) * | 2019-06-04 | 2020-12-10 | 俊雄 小泉 | Ｓｌａｍによる自律飛行機能を備えた無人機を用いた構造物の検査方法 |
| CN115943268A (zh) * | 2020-05-21 | 2023-04-07 | 萧时英 | 用于管道线路和斜度检查的轮胎式电机/电动车 |
| CN113343061A (zh) * | 2021-06-24 | 2021-09-03 | 广州高新兴机器人有限公司 | 一种gps激光融合slam中坐标系动态对齐方法 |
| JP7346682B1 (ja) | 2022-08-30 | 2023-09-19 | 東芝プラントシステム株式会社 | 埋め込み管路の形状測定装置及び形状測定方法 |
| JP7563681B2 (ja) | 2022-12-05 | 2024-10-08 | 株式会社Ntec | 管内形状確認装置及び管内形状確認方法 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61130593A (ja) * | 1984-11-30 | 1986-06-18 | 古河鉱業株式会社 | 余掘測定システム |
| IT1242165B (it) * | 1990-11-13 | 1994-02-16 | Comitato Naz Le Per La Ricerca | Sistema automatico per il rilevamento del profilo interno di gallerie ferroviarie e simili. |
| JP4317900B2 (ja) * | 1999-06-28 | 2009-08-19 | 雄司 今崎 | 地下埋設管路配設状況表示システム |
| JP5204955B2 (ja) * | 2006-02-09 | 2013-06-05 | 大成建設株式会社 | 三次元レーザスキャナのスキャニング方法 |
| FR2960082B1 (fr) * | 2010-05-17 | 2012-08-10 | Commissariat Energie Atomique | Procede et systeme pour fusionner des donnees issues de capteurs d'images et de capteurs de mouvement ou de position |
| AU2011305154B2 (en) * | 2010-09-24 | 2015-02-05 | Irobot Corporation | Systems and methods for VSLAM optimization |
| JP5748566B2 (ja) * | 2011-05-31 | 2015-07-15 | 東急建設株式会社 | 三次元形状情報取得装置 |
-
2013
- 2013-07-26 JP JP2013156041A patent/JP6202559B2/ja active Active
-
2014
- 2014-07-25 WO PCT/JP2014/069656 patent/WO2015012382A1/ja active Application Filing
Also Published As
| Publication number | Publication date |
|---|---|
| JP2015025753A (ja) | 2015-02-05 |
| WO2015012382A1 (ja) | 2015-01-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6202559B2 (ja) | 埋設管路の計測装置、及び、埋設管路の計測方法 | |
| CN105066917B (zh) | 一种小型管道地理信息系统测量装置及其测量方法 | |
| JP5927735B2 (ja) | 地図データ作成装置、自律移動システムおよび自律移動制御装置 | |
| JP2019074532A (ja) | Ｓｌａｍデータに実寸法を付与する方法とそれを用いた位置測定 | |
| US10539956B2 (en) | Subsurface robotic mapping system and method | |
| JP2015025753A5 (ja) | ||
| KR20110043538A (ko) | 영상 지도의 구축 및 차량 위치 결정을 위한 방법 및 시스템 | |
| JP5610870B2 (ja) | 無人走行車両の誘導装置及び無人走行車両の誘導方法 | |
| JP2012251774A (ja) | 三次元形状情報取得装置 | |
| JP3746283B2 (ja) | 連続ケーブル位置探査装置、連続ケーブル位置探査方法、及び連続ケーブル位置探査プログラム | |
| EP3203185A1 (en) | System and method for determining paths in underground pipelines | |
| JP6478578B2 (ja) | 探査装置 | |
| CN114051552A (zh) | 用于地形表征的钻探规划工具、系统和相关方法 | |
| JP3753833B2 (ja) | 道路線形自動測量装置 | |
| JP2007122247A (ja) | 自動ランドマーク情報作成方法及びシステム | |
| KR101860262B1 (ko) | 지중관로의 위치탐사 및 심도측정방법 | |
| JP2005062083A (ja) | 位置誤差補正機能を持つ測量システム | |
| JP2010249709A (ja) | 断面計測装置、断面計測方法および断面計測プログラム | |
| KR101821652B1 (ko) | 지중관로 내부 측정장치 및 방법 | |
| JP2006119144A (ja) | 道路線形自動測量装置 | |
| JP7162208B2 (ja) | 含水比マッピング方法及び含水比マッピング装置 | |
| JP2000338865A (ja) | デジタル道路地図のデータ収集装置 | |
| JP6773473B2 (ja) | 測量情報管理装置および測量情報管理方法 | |
| KR20220083195A (ko) | 지하시설물에 대한 3차원 현장 정보 취득이 가능한 지하시설물 현장 탐사장치 및 이를 이용한 지하시설물 현장 탐사방법 | |
| KR101730481B1 (ko) | 지하 매설물 경로 탐지 장치 및 지하 매설물의 위치정보를 제공하기 위한 서버 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160725 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20170307 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20170725 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170823 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6202559 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |