【解決手段】軌道中心計測装置1は、2本の軌条を走行する計測車両の走行方向において、計測車両に設けられたレーザスキャナからスキャンニングした軌道周辺の物体の形状を3次元点群で表す3次元点群データおよび計測車両の走行軌跡位置データを取得するデータ取得部101と、走行軌跡位置データを基準とした抽出フィルタを設定する第1フィルタ設定部102と、3次元点群データのうちの第1フィルタ設定部により設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定する第2フィルタ設定部103と、反射強度フィルタにより抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出する軌道中心算出部105とを備える。
2本の軌条を走行する計測車両の走行方向において、前記計測車両に設けられたレーザスキャナからスキャンニングした軌道周辺の物体の形状を3次元点群で表す3次元点群データおよび前記計測車両の走行軌跡位置データを取得するデータ取得部と、
前記走行軌跡位置データを基準とした抽出フィルタを設定する第1フィルタ設定部と、
前記3次元点群データのうちの前記第1フィルタ設定部により設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定する第2フィルタ設定部と、
前記反射強度フィルタにより抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出する軌道中心算出部とを備える、軌道中心計測装置。
前記反射強度フィルタにより抽出された軌条頭部点群データのうち前後の連続的な関係性を満たす点群データを抽出する前後関係フィルタを設定する第3フィルタ設定部をさらに備え、
前記軌道中心算出部は、前記反射強度フィルタおよび前記前後関係フィルタにより抽出された2本の連続的な軌条の軌条頭部点群データに基づいて軌条間の中心位置を算出する、請求項1記載の軌道中心計測装置。
2本の軌条を走行する計測車両の走行方向において、前記計測車両に設けられたレーザスキャナからスキャンニングした軌道周辺の物体の形状を3次元点群で表す3次元点群データおよび前記計測車両の走行軌跡位置データを取得するステップと、
前記走行軌跡位置データを基準とした抽出フィルタを設定するステップと、
前記3次元点群データのうちの設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定するステップと、
抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出するステップとを備える、軌道中心計測方法。
【発明を実施するための形態】
【0020】
実施形態について図面を参照しながら詳細に説明する。なお、図中同一または相当部分には同一符号を付し、その説明は繰り返さない。
【0021】
図1は、実施形態に基づく軌道中心計測システムの構成を説明する図である。
図1に示されるように、軌道中心計測システムは、計測装置1と、計測車両2とを含む。
【0022】
本例においては、計測車両2を側面から見た場合が示されている。
計測車両2は、GPS受信機200と、慣性センサ(IMU)210と、レーザスキャナ230と、データ記憶装置250とが含まれている。
【0023】
GPS受信機200は、測位衛星であるGPS衛星からの測位信号を受信する。GPS受信機200は、測位信号に設定されている航法メッセージおよび測位信号の搬送波位相の情報を測位情報の一例であるGPSデータとして受信時刻または計測時刻毎にデータ記憶装置250に記憶する。なお、GPS受信機200は他のGNSS(Global Navigation Satellite Systems)の衛星から測位信号を受信する受信機でもよい。GPSデータにより、計測車両2の走行軌跡位置データを取得することが可能である。
【0024】
レーザスキャナ230は、計測対象物である軌条(レール)の三次元位置を計測するためのセンサであり、進行方向に直交する面内をスキャンすることができる。レーザスキャナ230は、計測車両2の走行中にレーザ光を照射し、計測対象である軌条(レール)から反射したレーザ光を受光する。レーザスキャナ230は、レーザ光の照射から受光までの時間とレーザ光の照射方向とに基づいて、レーザ光が照射された照射点毎にレーザスキャナ230からの距離および方位を距離方位点として計測する。すなわち、距離方位点は、計測対象物に対する計測車両2からの距離および方位を表している。レーザスキャナ230は、計測した複数の距離方位点からなる距離方位点群を計測時刻または取得時刻毎にデータ記憶装置250に記憶する。これにより、軌道周辺の物体の形状を3次元点群で表す3次元点群データが取得される。
【0025】
慣性センサ210は、計測車両2の停止中または走行中において、計測車両2の三次元姿勢角の角速度の微小変異を計測し、姿勢データを計測時刻毎にデータ記憶装置250に記憶する。
【0026】
計測装置1は、計測車両2からの計測データ(3次元点群データ、姿勢データ、走行軌跡位置データ)を取得して、軌条位置を特定し、軌道中心を計測する。
【0027】
計測装置1における各部の機能について説明する。なお、軌条位置とは、軌条(レール)の三次元空間における位置を把握可能な三次元座標系上の位置を意味するものとする。ただし、軌条の三次元座標系上の位置を把握するための情報には、軌条の断面形状を把握するための2次元座標系上の位置情報も含まれるものとする。
【0028】
図2は、実施形態に基づく計測装置1の機能を説明するブロック図である。
図2を参照して、計測装置1は、データ取得部101と、第1フィルタ設定部102と、第2フィルタ設定部103と、軌道中心算出部105と、軌道中心線生成部106と、付加情報算出部110とを含む。
【0029】
付加情報算出部110は、カント量・勾配量算出部107と、スラック量算出部108と、曲線情報算出部109とを含む。
【0030】
データ取得部101は、計測車両2のデータ記憶装置250に記憶された計測データを取得する。本例においては、データ取得部101は、計測データの一例として3次元点群データと、走行軌跡位置データと、姿勢データとを取得する。
【0031】
第1フィルタ設定部102は、走行軌跡位置データを基準とした所定領域に含まれる領域点群データを抽出するための抽出フィルタを設定する。
【0032】
第2フィルタ設定部103は、3次元点群データのうちの第1フィルタ設定部102により設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定する。
【0033】
軌道中心算出部105は、反射強度フィルタにより抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出する。
【0034】
軌道中心線生成部106は、走行方向における連続した軌道中心位置に従って軌道中心線を生成する。
【0035】
付加情報算出部110は、軌道中心位置に対応する軌条に関連する付加情報を生成する。付加情報は、主に軌条の曲線部分に関する情報であり、カント量、勾配量、スラック量および曲線情報を含む。
【0036】
カント量・勾配量算出部107は、軌道中心線の軌道中心位置に対応する2本の軌条のカント量および勾配量を算出する。
【0037】
スラック量算出部108は、走行方向における2本の軌条の曲線部分におけるスラック量を算出する。
【0038】
曲線情報算出部109は、走行方向における2本の軌条の曲線部分の曲線情報を算出する。具体的には、曲線情報として、曲線半径および曲線の向きを算出する。
【0039】
図3は、実施形態に基づく軌道付近の3次元空間における3次元点群データの一例を説明する図である。
【0040】
図3に示されるように、点群データを取得することにより軌条の断面形状を把握することが可能である。本例においては、3次元点群データに基づいて軌条間の軌道中心位置を算出する。
【0041】
図4は、実施形態に基づく計測車両2の走行軌跡位置データを説明する図である。
図4に示されるように、GPSデータにより、計測車両2の走行方向の走行軌跡位置データを取得することが可能である。走行軌跡位置データは、後述する抽出フィルタを設定するための基準点になる。
【0042】
図5は、実施形態に基づく第1フィルタ設定部102の抽出フィルタの設定について説明する図である。
【0043】
図5(A)には、抽出フィルタの設定例(その1)が示されている。
走行軌跡位置データに基づくレーザスキャナ230の位置G0が示されている。
【0044】
第1フィルタ設定部102は、レーザスキャナ230の位置G0を基準にした抽出フィルタを設定する。ここでは、計測車両2の姿勢データに含まれるロール値データは0であるとする。すなわち、計測車両2が水平面と平行の状態であり、計測車両2が進行方向に対して左右に傾いていない状態を意味する。
【0045】
具体的には、4つのパラメータが設けられている。本例においては、照射角度の抽出範囲を設定するための照射範囲設定角range1,range2と、高さ方向の抽出範囲を設定するための高さHmax,Hminとが設けられている。
【0046】
照射範囲設定角range1は、位置G0から計測車両2が位置する水平面に対する垂線方向から左右に広がるレーザ照射角度を表す。
【0047】
照射範囲設定角range1と照射範囲設定角range2との間の範囲角によって表される領域が照射角度の抽出範囲として設定される。
【0048】
高さHmax,Hminは、位置G0から水平面に対する垂線方向の距離の範囲を示す。高さHmaxと高さHminとの間の範囲が高さ方向の抽出範囲として設定される。
【0049】
高さHmaxと高さHminとの間の高さの範囲と照射範囲設定角range1と照射範囲設定角range2との間の範囲角によって表される領域とによって表される領域が抽出範囲として設定される。
【0050】
当該抽出フィルタを適用することにより軌条の軌条頭部周辺の3次元点群データを抽出することが可能である。本例においては、抽出フィルタにより抽出された軌条の軌条頭部周辺の3次元点群データを領域点群データとも称する。
【0051】
図5(B)には、抽出フィルタの設定例(その2)が示されている。
レーザスキャナ230の位置G0が示されている。
【0052】
レーザスキャナ230の位置G0を基準にした抽出フィルタを設定する。ここでは、計測車両2の姿勢データに含まれるロール値データはαであるとする。すなわち、計測車両2が進行方向に対して右に水平面からα°傾いていることを意味する。
【0053】
これにより、ロール値データをさらに考慮して、上記と同様の方式により抽出フィルタを設定することが可能である。
【0054】
具体的には、ロール値データを考慮した照射範囲設定角range1と照射範囲設定角range2との間の範囲角によって表される領域と高さHmaxと高さHminとの間の高さの範囲とによって表される領域が抽出範囲として設定される。
【0055】
図5(C)には、抽出フィルタの設定例(その3)が示されている。
レーザスキャナ230の位置G0を基準にした抽出フィルタを設定する。ここでは、計測車両2の姿勢データに含まれるロール値データは0であるとする。すなわち、計測車両2が水平面と平行の状態であり、計測車両2が進行方向に対して左右に傾いていない状態を意味する。
【0056】
具体的には、4つのパラメータが設けられている。本例においては、高さ方向の抽出範囲を設定するための高さHmax,Hminと、幅方向の抽出範囲を設定するための幅Vmax,幅Vminとが設けられている。
【0057】
高さHmax,Hminは、位置G0から水平面に対する垂線方向の距離の範囲を示す。
【0058】
高さHmaxと高さHminとの間の範囲が高さ方向の抽出範囲として設定される。
幅Vmax,Vminは、位置G0から水平面に対する垂線方向から左右の幅方向に対する距離の範囲を示す。
【0059】
幅Vmaxと幅Vminとの間の範囲が幅方向の抽出範囲として設定される。
高さHmaxと高さHminとの間の高さの範囲と幅Vmaxと幅Vminとの間の幅の範囲とによって表される領域が抽出範囲として設定される。
【0060】
図5(D)には、抽出フィルタの設定例(その4)が示されている。
レーザスキャナ230の位置G0が示されている。
【0061】
レーザスキャナ230の位置G0を基準にした抽出フィルタを設定する。ここでは、計測車両2の姿勢データに含まれるロール値データはαであるとする。すなわち、計測車両2が進行方向に対して右に水平面からα°傾いていることを意味する。
【0062】
これにより、ロール値データをさらに考慮して、上記と同様の方式により抽出フィルタを設定することが可能である。
【0063】
具体的には、ロール値データを考慮した高さHmaxと高さHminとの間の高さの範囲と幅Vmaxと幅Vminとの間の幅の範囲とによって表される領域が抽出範囲として設定される。
【0064】
図6は、実施形態に基づく第2フィルタ設定部103の反射強度フィルタについて説明する図である。
【0065】
図6(A)には、踏切等が有る場合の軌条を説明する図である。
図6(A)に示されるように、踏切等が有る場合には、軌道周辺には踏切を構成する部材等が配置される。
【0066】
したがって、レーザスキャナ230でスキャンした際には、軌条以外の踏切部分も3次元点群データとして取得することになる。
【0067】
第1フィルタ設定部102の抽出フィルタを用いて軌条頭部周辺の3次元点群データを取得することが可能である。
【0068】
しかしながら、当該取得した3次元点群データには、ノイズとなる軌条以外の踏切部分のデータ等も含まれているため軌条頭部の3次元位置を精度よく計測することが難しい。
【0069】
したがって、本例においては、抽出フィルタで抽出された軌条頭部周辺の領域点群データのうちノイズを除いた軌条頭部を抽出するフィルタを設定する。
【0070】
この点で、軌条は、金属部分であるため反射強度が高い。一方、軌条以外の踏切を構成する部材は非金属部分であるため反射強度は低い。
【0071】
したがって、実施形態においては、軌条頭部を抽出するために反射強度フィルタを用いて当該ノイズを除去する。
【0072】
図6(B)は、反射強度による点群の分類を説明する図である。
図6(B)に示されるように、軌条は金属部分であるため反射強度は高く、軌条以外の踏切を構成する部材は非金属部分であるため反射強度が低い。
【0073】
それゆえ、反射強度を所定の閾値で分類することにより軌条頭部と、軌条頭部以外とに分けることが可能である。
【0074】
本例においては、反射強度フィルタを用いて反射強度が所定の閾値よりも高い3次元点群データを抽出する。本例においては、反射強度フィルタで抽出された3次元点群データを軌条頭部点群データとも称する。
【0075】
当該処理により、軌条以外の踏切部分のデータをノイズとして除去することが可能である。すなわち、軌条頭部を正確に抽出することが可能となり、精度の高い軌道中心位置の算出が可能である。
【0076】
図7は、実施形態に従う軌道中心算出部105の内側端点を算出する方式を説明する図である。
【0077】
図7(A)を参照して、軌条頭部を構成する軌条頭部点群データが示されている。
本例においては、軌条頭部点群データのうち軌条頭部上面を構成する近似した2次曲線を算出する。
【0078】
次に、算出した2次曲線について軌道面に垂直方向の高さにおける最高点を求めて、その接線LAを算出する。
【0079】
次に、軌条頭部点群データのうち軌条頭部側面側の内側点群データを抽出する。
次に、接線LAと、内側点群データとに基づいて内側端点Pを算出する。
【0080】
具体的には、軌条頭部側面側の最も内側位置にある点Bを抽出する。
そして、抽出した点Bから接線LAに垂線を引いて交わった交点を内側端点Pとして算出する。
【0081】
本例においては、2本の軌条のうちの左軌条の内側端点Pについて説明したが、右軌条の内側端点Qについても同様である。
【0082】
図7(B)は、別の軌道中心算出部105の内側端点を算出する式を説明する図である。
【0083】
図7(B)には、軌条頭部点群データのうち軌条頭部側面側の内側点群データを用いて近似した直線LCを算出する。
【0084】
算出した直線LCと、接線LAとに基づいて内側端点Pを算出する。
具体的には、直線LCと、接線LAとの交点を内側端点Pとして算出する。
【0085】
本例においては、2本の軌条のうちの左軌条の内側端点Pについて説明したが、右軌条の内側端点Qについても同様である。
【0086】
当該方式により2本の軌条の左軌条および右軌条の軌条頭部の内側端点P,Qが算出される。
【0087】
図8は、実施形態に従う軌道中心算出部105の内側軌条線の算出について説明する図である。
【0088】
図8(A)に示されるように、
図7で算出した内側端点P,Qは、進行方向において位置ずれが生じている。
【0089】
計測車両2は、軌条上を進行方向に進みながらレーザスキャナ230で軌道周辺の物体をスキャンする。
【0090】
レーザスキャナ230は、例えば左側の軌条をスキャンした後に、右側の軌条をスキャンする。したがって、スキャンニング中の計測車両2の進行速度に従って位置がずれることになる。
【0091】
実施形態においては、当該位置ずれを補正した上で精度の高い軌条間の中心位置を算出する。
【0092】
まず、軌道中心算出部105は、走行方向における2本の軌条のそれぞれの内側端点間を結ぶ第1内側軌条線および第2内側軌条線を算出する。
【0093】
本例においては、内側端点P0〜P4をそれぞれ結ぶことにより第1内側軌条線が取得される。また、内側端点Q0〜Q4をそれぞれ結ぶことにより第2内側軌条線が取得される。
【0094】
軌道中心算出部105は、内側端点Pと、内側端点Qとの軌条間の中点Rを算出する。一例として、内側端点P0〜P4と、内側端点Q0〜Q4との中点R0〜R4が示されている。
【0095】
軌道中心算出部105は、内側端点P,Qにおける第1および第2の内側軌条線の方向ベクトルを算出する。本例においては、内側端点P0,Q0の方向ベクトルが示されている。
【0096】
軌道中心算出部105は、中点Rの方向ベクトルを算出する。具体的には、対応する内側端点P,Qの方向ベクトルの平均ベクトルを算出する。
【0097】
軌道中心算出部105は、それぞれの中点R0〜R4に対する方向ベクトルを算出する。
【0098】
図8(B)を参照して、軌道中心算出部105は、算出した中点R0〜R4の方向ベクトルに対して垂直な軌条横断線MA0〜MA4をそれぞれ算出する。
【0099】
軌道中心算出部105は、軌条横断線と第1および第2の内側軌条線の交点を算出する。
【0100】
本例においては、軌条横断線MAと第1の内側軌条線との交点を第1の内側軌条交点データとする。軌条横断線MAと、第2の内側軌条線との交点を第2の内側軌条交点データとする。本例においては、第1の内側軌条線と軌条横断線MA0〜MA4とに基づく第1の内側軌条交点データP0#〜P4#が示されている。また、第2の内側軌条線と軌条横断線MA0〜MA4とに基づく第2の内側軌条交点データQ0#〜Q4#が示されている。
【0101】
図8(C)を参照して、軌道中心算出部105は、第1の内側軌条交点データと第2の内側軌条交点データとに基づいて軌条間の軌道中心位置を算出する。
【0102】
軌道中心算出部105は、第1の内側軌条交点データP0#〜P4#と、第2の内側軌条交点データQ0#〜Q4#とに基づいて軌条間の軌道中心位置R0#〜R4#を算出する。
【0103】
図8(C)に示されるように、軌道中心線生成部106は、走行方向における連続した軌道中心位置R0#〜R4#に従って軌道中心線を生成する。後述するが軌道中心の方向ベクトルの変化量に基づいて軌道中心線の生成方式が異なる。具体的には、軌道中心の方向ベクトルの変化量が所定値以上であるか否かを判断し、所定値以上である場合には曲線部分であると判断する。軌道中心線生成部106は、曲線部分であると判断した場合には、曲線部分において直線部分とは異なる方式で軌道中心線を生成する。軌道中心線生成部106は、第1の内側軌道軌条交点データおよび第2の内側軌道軌条交点データを用いた軌道中心位置に基づいて軌道中心線を生成するのではなく、曲線部分のうちの外側にある内側軌道軌条交点データを基準に軌道中心位置を設定し、それに基づいて軌道中心線を生成する。曲線部分における軌道中心位置は、外側にある内側基準交点データを基準に一定の距離に設定される。
【0104】
図8(D)に示されるように、軌条間の中点と、軌条間の軌道中心位置との間にはずれが生じているが、精度よく補正されることが分かる。すなわち、本方式により、精度の高い軌道中心位置を算出することが可能である。
【0105】
図9は、実施形態に従うカント量・勾配量算出部107の算出方式を説明する図である。
【0106】
図9(A)に示されるように、2本の軌条を走行する鉄道車両や保線計測機器の走行モデルを説明する図である。
【0107】
計測車両2は、進行方向に対して前後方向に少なくとも4輪設けられている。
本例においては、当該4輪が位置する第1および第2の内側軌条交点データに基づいて形成される仮想軌条平面を算出する。
【0108】
当該算出された仮想軌条平面に基づいて軌道中心位置のカント量および勾配量を算出する。
【0109】
図9(B)は、仮想軌条平面の算出について説明する図である。
図9(B)を参照して、一例として、軌道中心位置R2#のカント量および勾配量の算出について説明する。
【0110】
一例として軌道中心位置R2#を基準として進行方向に対して前後2つの軌道中心位置に対応する内側軌条交点データを用いる。
【0111】
本例においては、第1の内側軌条交点データP0#,P4#と、第2の内側軌条交点データQ0#,Q4#とに基づいて仮想軌条平面を算出する。
【0112】
次に、仮想軌条平面に対する法線ベクトルを算出する。
そして、当該法線ベクトルの水平方向ベクトル成分と、進行方向ベクトル成分とを算出する。
【0113】
カント量・勾配量算出部107は、法線ベクトルの算出した水平方向ベクトル成分に基づいて当該軌道中心位置R2#に対するカント量を算出する。
【0114】
カント量・勾配量算出部107は、法線ベクトルの算出した進行方向ベクトル成分に基づいて当該軌道中心位置R2#に対する勾配量を算出する。
【0115】
なお、本方式は、一例であり、特に前後2つの軌道中心位置に対する内側軌条交点データではなく、その範囲は鉄道車両や保線計測機器の大きさに合わせて任意に設定することが可能である。
【0116】
なお、本例においては、仮想軌条平面の中心である軌道中心位置R2#を基準とした場合の算出方式について説明したが、特にこれに限られず、軌道中心位置R0#の算出方式としてもよい。
【0117】
図10は、実施形態に従う2本の軌条の曲線部分について説明する図である。
図10に示されるように、2本の軌条の曲線部分(カーブ)において、実際の軌条位置は、車両が走行し易いように本来の軌条位置よりも所定のスラック量分、軌条の幅を広げて設けられている。
【0118】
したがって、軌道中心線生成部106は、曲線部分において直線部分とは異なる方式で軌道中心線を生成する。軌道中心線生成部106は、曲線部分のうちの外側にある内側軌条交点データを基準に軌道中心位置を設定し、それに基づいて軌道中心線を生成する。曲線部分における軌道中心位置は、外側にある内側基準交点データを基準に一定の距離に設定される。
【0119】
曲線部分においては、車両が遠心力により外方に転倒することを防止するために、外側の軌道を内側の軌道よりも高く設定している。したがって、カント量・勾配量算出部107は、法線ベクトルの算出した水平方向ベクトル成分に基づいて当該軌道中心位置に対するカント量を算出する。
【0120】
曲線情報算出部109は、走行方向における2本の軌条の曲線情報として、中心点Oからの曲線半径および曲線の向きを算出する。曲線情報算出部109は、軌道中心線をN次関数または円曲線に近似することにより曲線半径を算出する。また、曲線情報算出部109は、軌道中心線の方向ベクトルに基づいて曲線の向きを算出する。
【0121】
図11は、実施形態に従うスラック量算出部108の算出方式を説明する図である。
図11に示されるように、ここでは、スラック量の算出方式が示されている。
【0122】
スラック量算出部108は、2本の軌条の内側端点間の距離と、軌間の寸法とに基づいてスラック量を算出する。具体的には、スラック量は、内側端点間距離から軌間の寸法を減算することにより取得される。
【0123】
図12は、実施形態に従う計測装置1の計測処理を説明するフロー図である。
図12を参照して、計測装置1は、データを取得する(ステップS2)。
【0124】
データ取得部101は、計測車両2のデータ記憶装置250に記憶された計測データを取得する。本例においては、データ取得部101は、計測データの一例として3次元点群データと、走行軌跡位置データと、姿勢データとを取得する。
【0125】
次に、計測装置1は、抽出フィルタを設定する(ステップS4)。第1フィルタ設定部102は、
図5で説明したように走行軌跡位置データを基準とした所定領域に含まれる領域点群データを抽出するための抽出フィルタを設定する。
【0126】
次に、計測装置1は、反射強度フィルタを設定する(ステップS6)。第2フィルタ設定部103は、
図6で説明したように3次元点群データのうちの第1フィルタ設定部102により設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定する。
【0127】
次に、計測装置1は、軌条間の中心位置を算出する(ステップS8)。軌道中心算出部105は、反射強度フィルタにより抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出する。軌条間の中心位置の算出処理については後述する。
【0128】
次に、計測装置1は、軌道中心線を算出する(ステップS9)。軌道中心線生成部106は、軌条間の中心位置に基づいて軌道中心線を算出する。また、軌道中心線生成部106は、軌条間の中心位置の方向ベクトルに基づいて曲線か否かを判断する。具体的には、軌道中心線生成部106は、方向ベクトルの変化量が所定量以上である場合には曲線であると判断して、曲線部分のうちの外側にある内側軌道軌条交点データを基準に軌道中心位置を設定し、それに基づいて軌道中心線を生成する。曲線部分における軌道中心位置は、外側にある内側基準交点データを基準に一定の距離に設定される。
【0129】
次に、計測装置1は、付加情報を算出する(ステップS10)。付加情報算出部110は、軌道中心位置に対応する軌条に関連する付加情報として、カント量、勾配量、スラック量および曲線情報を算出する。付加情報の算出については後述する。
【0130】
付加情報算出部110は、付加情報算出部110で算出した付加情報を軌道中心位置に対してそれぞれ関連付けて保存する。
【0131】
そして、処理を終了する(エンド)。
図13は、実施形態に従う軌条間の中心位置算出処理について説明するフロー図である。
【0132】
図13を参照して、軌道中心算出部105は、軌条頭部点群データを取得する(ステップS12)。具体的には、
図7で説明したように軌道中心算出部105は、3次元点群データのうち抽出された反射強度が所定の閾値よりも高い軌条頭部点群データを取得する。
【0133】
次に、軌道中心算出部105は、近似2次曲線を算出する(ステップS14)。
具体的には、軌道中心算出部105は、
図7で説明したように軌条頭部点群データのうち軌条頭部上面を構成する近似した2次曲線を算出する。
【0134】
次に、軌道中心算出部105は、接線を算出する(ステップS16)。
具体的には、軌道中心算出部105は、算出した2次曲線について軌道面に垂直方向の高さにおける最高点を求めて、その接線LAを算出する。
【0135】
次に、軌道中心算出部105は、内側点群データを抽出する(ステップS18)。
具体的には、
図7で説明したように軌道中心算出部105は、軌条頭部点群データのうち軌条頭部側面側の内側点群データを抽出する。
【0136】
次に、軌道中心算出部105は、内側端点を算出する(ステップS20)。
具体的には、軌道中心算出部105は、
図7で説明したように接線LAと、内側点群データとに基づいて内側端点Pを算出する。この点で、軌条頭部側面側の最も内側位置にある点Bを抽出する。そして、抽出した点Bから接線LAに垂線を引いて交わった交点を内側端点Pとして算出する。
【0137】
次に、軌道中心算出部105は、軌道中心を算出する(ステップS22)。
軌道中心の算出処理について後述する。
【0138】
そして、処理を終了する(リターン)。
図14は、実施形態に従う別の軌条間の中心位置算出処理について説明するフロー図である。
【0139】
図14を参照して、
図13のフロー図と比較して、ステップS19がさらに設けられている点が異なる。ステップS19において、軌道中心算出部105は、近似直線を算出する。
【0140】
具体的には、
図7で説明したように軌道中心算出部105は、軌条頭部点群データのうち軌条頭部側面側の内側点群データを用いて近似した直線LCを算出する。そして、軌道中心算出部105は、内側端点を算出する(ステップS20)。具体的には、軌道中心算出部105は、算出した直線LCと、接線LAとに基づいて内側端点Pを算出する。具体的には、直線LCと、接線LAとの交点を内側端点Pとして算出する。
【0141】
他のフローについては同様であるのでその詳細な説明については繰り返さない。
図15は、実施形態に従う軌条間の中心算出処理について説明するフロー図である。
【0142】
図15を参照して、軌道中心算出部105は、内側軌条線を算出する(ステップS30)。具体的には、
図8(A)で説明したように、軌道中心算出部105は、走行方向における2本の軌条のそれぞれの内側端点間を結ぶ第1内側軌条線および第2内側軌条線を算出する。内側端点P0〜P4をそれぞれ結ぶことにより第1内側軌条線が取得される。また、内側端点Q0〜Q4をそれぞれ結ぶことにより第2内側軌条線が取得される。
【0143】
次に、軌道中心算出部105は、方向ベクトルを算出する(ステップS32)。
図8(A)で説明したように、軌道中心算出部105は、内側端点P,Qにおける第1および第2の内側軌条線の方向ベクトルを算出する。
【0144】
次に、軌道中心算出部105は、平均ベクトルを算出する(ステップS34)。
図8(A)で説明したように、軌道中心算出部105は、中点Rの方向ベクトルを算出する。具体的には、対応する内側端点P,Qの方向ベクトルの平均ベクトルを算出する。
【0145】
次に、軌道中心算出部105は、軌条横断線を算出する(ステップS36)。
図8(B)で説明したように、軌道中心算出部105は、算出した中点R0〜R4の方向ベクトルに対して垂直な軌条横断線MA0〜MA4をそれぞれ算出する。
【0146】
次に、軌道中心算出部105は、軌条交点データを算出する(ステップS38)。
図8(B)で説明したように、軌道中心算出部105は、軌条横断線と第1および第2の内側軌条線との交点を算出する。本例においては、軌条横断線MAと、第1の内側軌条線との交点を第1の内側軌条交点データとする。軌条横断線と、第2の内側軌条線との交点を第2の内側軌条交点データとする。
【0147】
次に、軌道中心算出部105は、軌道中心位置を算出する(ステップS40)。
図8(C)で説明したように、軌道中心算出部105は、第1の内側軌条交点データと、第2の内側軌条交点データとに基づいて軌条間の軌道中心位置を算出する。軌道中心算出部105は、第1の内側軌条交点データP0#〜P4#と、第2の内側軌条交点データQ0#〜Q4#とに基づいて軌条間の軌道中心位置R0#〜R4#を算出する。
【0148】
そして、処理を終了する(リターン)。
図16は、実施形態に従う付加情報算出部110の付加情報の算出について説明するフロー図である。
【0149】
図16を参照して、付加情報算出部110は、軌道中心の方向ベクトルの変化量を算出する(ステップS50)。
【0150】
次に付加情報算出部110は、軌道中心の方向ベクトルの変化量が所定量以上の変化量であるか否かを判断する(ステップS52)。
【0151】
ステップS52において、付加情報算出部110は、軌道中心の方向ベクトルの変化量が所定量以上の変化量であると判断した場合(ステップS52においてYESと判断した場合)には、カント量・勾配量を算出する(ステップS54)。具体的には、カント量・勾配量算出部107は、軌道中心線の軌道中心位置に対応する2本の軌条のカント量および勾配量を算出する。カント量・勾配量を算出する方式については後述する。
【0152】
次に、付加情報算出部110は、軌条交点データ間距離を算出する(ステップS56)。スラック量算出部108は、
図11で説明したように第1の内側軌条交点データと、第2の内側軌条交点データとの間の距離を算出する。
【0153】
次に、付加情報算出部110は、スラック量を算出する(ステップS58)。スラック量算出部108は、
図11で説明したように第1の内側軌条交点データと、第2の内側軌条交点データとの間の距離と、軌間の寸法とに基づいてスラック量を算出する。スラック量算出部108は、
図11で説明したように内側軌条交点データ間の距離から軌間の寸法を減算することによりスラック量を取得する。
【0154】
次に、付加情報算出部110は、曲線半径を算出する(ステップS60)。曲線情報算出部109は、軌道中心線をN次関数または円曲線に近似することにより曲線半径を算出する。
【0155】
次に、付加情報算出部110は、曲線の向きを算出する(ステップS62)。曲線情報算出部109は、軌道中心線の方向ベクトルに基づいて曲線の向きを算出する。
【0156】
そして、処理を終了する(エンド)。
一方、ステップS52において、付加情報算出部110は、軌道中心の方向ベクトルの変化量が所定量以上の変化量でないと判断した場合(ステップS52においてNOと判断した場合)には、ステップS54〜S62をスキップして処理を終了する(エンド)。
【0157】
図17は、実施形態に従うカント量・勾配量算出部107ののカント量および勾配量の算出について説明するフロー図である。
【0158】
図17を参照して、仮想軌条平面を算出する(ステップS70)。具体的には、カント量・勾配量算出部107は、
図9(B)に示されるように、第1の内側軌条交点データP0#〜P4#と、第2の内側軌条交点データQ0#〜Q4#とに基づいて仮想軌条平面を算出する。
【0159】
次に、カント量・勾配量算出部107は、仮想軌条平面に対する法線ベクトルを算出する(ステップS72)。
【0160】
次に、カント量・勾配量算出部107は、算出した法線ベクトルの水平方向ベクトル成分に基づいて当該軌道中心位置R2#に対するカント量データを算出する(ステップS74)。
【0161】
カント量・勾配量算出部107は、算出した進行方向ベクトル成分に基づいて当該軌道中心位置R2#に対する勾配量データを算出する(ステップS76)。
【0162】
そして、処理を終了する(エンド)。
なお、本例においては、カント量および勾配量を分けて同時に算出する場合について説明したが、これに限られず、法線ベクトルに基づいてカント量データおよび勾配量データを別々に算出することも可能である。
【0163】
カント量・勾配量算出部107で算出されたカント量データおよび勾配量データ、スラック量算出部108で算出したスラック量ならびに曲線情報算出部109で算出した曲線半径および曲線の向きは、建築限界の設定の際に用いることが可能である。
【0164】
(その他変形例)
図18は、実施形態の変形例に基づく計測装置1#の機能を説明するブロック図である。
【0165】
図18を参照して、計測装置1#は、計測装置1と比較して第3フィルタ設定部104を追加した点が異なる。その他の構成については同様であるのでその詳細な説明については繰り返さない。
【0166】
第3フィルタ設定部104は、反射強度フィルタにより抽出された軌条頭部点群データのうち前後の連続的な関係性を満たす点群データを抽出する前後関係フィルタを設定する。前後関係フィルタは、反射強度フィルタで除いたノイズに対してさらに点群データを除去するフィルタである。
【0167】
図19は、実施形態の変形例に基づく分岐区間および脱線防止ガードを説明する図である。
【0168】
図19(A)を参照して、一例として2本の軌条の間に脱線防止ガードが設けられている。
【0169】
図19(B)を参照して、一例として軌条を分岐させる分岐部が設けられている。
当該脱線防止ガードや、分岐部は、金属部分で構成されている。
【0170】
したがって、反射強度フィルタでは当該脱線防止ガードや分岐部を判別することはできない。
【0171】
実施形態の変形例においては、当該脱線防止ガードや分岐部を除く方式について説明する。
【0172】
具体的には、第3フィルタ設定部104は、前後関係フィルタを設定する。脱線防止ガードや、分岐部は、2本の軌条に沿って配置される。脱線防止ガードや分岐部は、2本の軌条に沿って一部の区間のみ配置され、常に配置される訳ではない。
【0173】
本例においては、第3フィルタ設定部104により設定された前後関係フィルタを用いて点群データを抽出する領域をさらに絞る。
【0174】
図20は、実施形態の変形例に基づく第3フィルタ設定部104に従う前後関係フィルタの設定例を説明する図である。
【0175】
図20(A)を参照して、前後関係フィルタの設定例(その1)が示されている。
前後の連続的な関係性を満たす条件として、1つ前に算出した内側端点Pを用いる。
【0176】
具体的には、1つ前の内側端点Pを基準にパラメータPD1〜PD4によって抽出範囲を設定する。
【0177】
パラメータPD1,PD2は、1つ前の内側端点Pを基準にした上下方向の高さ範囲である。
【0178】
パラメータPD3,PD4は、1つ前の内側端点Pを基準にした左右方向の幅範囲である。
【0179】
そして、設定した抽出範囲の点群データのみを抽出する。
これにより、反射強度フィルタにより抽出された軌条頭部点群データのうち脱線防止ガードに関連する点群データを除去することが可能である。
【0180】
他方の軌条についても同様に、1つ前の内側端点Qを基準にして同様の方式に従って抽出範囲を設定する。
【0181】
図20(B)を参照して、前後関係フィルタの設定例(その2)が示されている。
点群間の距離を基準に点群のグループを作成する。
【0182】
本例においては、グループGAと、グループGBとに分類されている場合が示されている。
【0183】
次に各グループの中心あるいは重心を算出する。
そして、算出された各グループの中心あるいは重心が1つ前の内側端点Pに近い点群のグループのみを抽出する。
【0184】
グループGAは、2本の軌条の連続した軌条頭部に関連する点群データであり、グループGBは、脱線防止ガードに関連する点群データである。
【0185】
したがって、この場合、内側端点Pに近いグループGAの点群データのみを抽出する。
他方の軌条についても同様に、1つ前の内側端点Qを基準にして同様の方式に従って抽出範囲を設定する。
【0186】
脱線防止ガードに限られず分岐部についても同様に適用可能である。
反射強度フィルタで抽出された3次元点群データに対してさらに前後関係フィルタを適用することにより2本の軌条の連続した軌条頭部に関連する3次元点群データのみを抽出することが可能である。すなわち、脱線防止ガードや分岐部の金属部分に対応する3次元点群データを除去することが可能である。
【0187】
したがって、2本の軌条の連続した軌条頭部を正確に抽出することが可能となり、精度の高い軌道中心位置の算出が可能である。
【0188】
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本開示の範囲は、上記した説明ではなく、特許請求の範囲によって示され、特許請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
2本の軌条を走行する計測車両の走行方向において、前記計測車両に設けられたレーザスキャナからスキャンニングした軌道周辺の物体の形状を3次元点群で表す3次元点群データおよび前記計測車両の走行軌跡位置データを取得するデータ取得部と、
前記走行軌跡位置データを基準とした抽出フィルタを設定する第1フィルタ設定部と、
前記3次元点群データのうちの前記第1フィルタ設定部により設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定する第2フィルタ設定部と、
前記反射強度フィルタにより抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出する軌道中心算出部とを備える、軌道中心計測装置。
前記反射強度フィルタにより抽出された軌条頭部点群データのうち前後の連続的な関係性を満たす点群データを抽出する前後関係フィルタを設定する第3フィルタ設定部をさらに備え、
前記軌道中心算出部は、前記反射強度フィルタおよび前記前後関係フィルタにより抽出された2本の連続的な軌条の軌条頭部点群データに基づいて軌条間の中心位置を算出する、請求項1記載の軌道中心計測装置。
2本の軌条を走行する計測車両の走行方向において、前記計測車両に設けられたレーザスキャナからスキャンニングした軌道周辺の物体の形状を3次元点群で表す3次元点群データおよび前記計測車両の走行軌跡位置データを取得するステップと、
前記走行軌跡位置データを基準とした抽出フィルタを設定するステップと、
前記3次元点群データのうちの設定された抽出フィルタに基づいて抽出された領域点群データのうち反射強度の大きさに基づいて軌条頭部を抽出する反射強度フィルタを設定するステップと、
抽出された2本の軌条の軌条頭部に基づいて軌条間の中心位置を算出するステップとを備える、軌道中心計測方法。