(57)【要約】【課題】点検装置の打検機ハンマ部の位置及び／又は姿勢をリアルタイムで高精度に調整すること。【解決手段】点検装置は、移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する機体位置姿勢推定器と、打検機ハンマ部誤差信号を生成する打検機ハンマ部誤差信号生成器と、打検機ハンマ部位置姿勢信号を生成する打検機ハンマ部位置姿勢信号生成器と、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する第１センサデータ周波数特性補完器と、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する第２センサデータ周波数特性補完器と、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する打検機ハンマ部位置姿勢推定器を含む。【選択図】図１
2018173390.tif 000002
【特許請求の範囲】
【請求項１】
被検対象物の状態を点検するための点検装置であって、
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含み、
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含み、
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する機体位置姿勢推定器と、
打検機ハンマ部誤差信号を生成する打検機ハンマ部誤差信号生成器と、
打検機ハンマ部位置姿勢信号を生成する打検機ハンマ部位置姿勢信号生成器と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する第１センサデータ周波数特性補完器と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する第２センサデータ周波数特性補完器と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する打検機ハンマ部位置姿勢推定器
を含む、点検装置。
【請求項２】
前記打検機ハンマ部誤差信号生成器は、
前記打検機ハンマ部の先端に配設された測距センサであって、該打検機ハンマ部の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号を生成する測距センサと、
前記打検機ハンマ部に配設された力覚センサであって、該打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号を生成する力覚センサと、
前記打検機ハンマ部に配設された先端部位置／姿勢センサであって、該打検機ハンマ部の位置／姿勢情報を検出し、検出した位置／姿勢情報から先端部位置／姿勢センサ信号を生成する先端部位置／姿勢センサ、
を含む、
ここで、前記打検機ハンマ部誤差信号は、前記測距センサ信号と、前記力覚センサ信号と、前記先端部位置／姿勢センサ信号から生成される、
請求項１に記載の点検装置。
【請求項３】
前記打検機ハンマ部位置姿勢信号生成器は、
前記打検機アームの直動部に配設された直動部変位センサであって、該直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号を生成する直動部変位センサと、
前記打検機アームの先端部角度駆動部に配設された先端部角度センサであって、先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号を生成する先端部角度センサと、
前記打検機アームのアーム部角度駆動部に配設されたアーム部角度センサであって、アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号を生成するアーム部角度センサ、
を含む、
ここで、前記打検機ハンマ部位置姿勢信号は、前記直動部変位センサ信号と、前記先端部角度センサ信号と、前記アーム部角度センサ信号から生成される、
請求項１に記載の点検装置。
【請求項４】
前記第１センサデータ周波数特性補間器は、前記機体位置姿勢推定信号に対し、前記移動体の位置及び姿勢に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第１センサデータ周波数特性補間信号を生成するよう構成されている、
請求項１に記載の点検装置。
【請求項５】
前記第２センサデータ周波数特性補間器は、前記打検機ハンマ部誤差信号と前記打検機ハンマ部位置姿勢信号に対し、前記打検機アームの直動部及び先端部及びアーム部に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第２センサデータ周波数特性補間信号を生成するよう構成されている、
請求項１乃至３の何れかに記載の点検装置。
【請求項６】
前記打検機ハンマ部位置姿勢推定器は、前記第１センサデータ周波数特性補間信号を伝播信号としかつ前記第２センサデータ周波数特性補間信号を更新信号とするカルマンフィルタ処理を実施することにより前記打検機ハンマ部位置姿勢推定信号を生成するよう構成されている、
請求項１乃至３の何れかに記載の点検装置。
【請求項７】
打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御方法であって、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成するステップと、
打検機ハンマ部誤差信号を生成するステップと、
打検機ハンマ部位置姿勢信号を生成するステップと、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成するステップと、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成するステップと、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成するステップ
を含む、
点検装置の制御方法。
【請求項８】
打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御プログラムであって、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する処理と、
打検機ハンマ部誤差信号を生成する処理と、
打検機ハンマ部位置姿勢信号を生成する処理と、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する処理と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する処理と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する処理
をコンピュータに実行させる、
点検装置の制御プログラム。
【請求項９】
被検対象物の状態を点検するための点検装置であって、
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含み、
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含み、
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する手段と、
打検機ハンマ部誤差信号を生成する手段と、
打検機ハンマ部位置姿勢信号を生成する手段と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する手段と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する手段と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する手段
を含む、
点検装置。
【請求項１０】
請求項１乃至３及び９の何れかに記載の点検装置と、該点検装置と有線又は無線で通信する通信装置を含む、点検システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本開示は、点検装置、点検装置の制御方法及び制御プログラムに関する。
【背景技術】
【０００２】
橋梁、トンネル等のような検査対象物の損傷や欠陥等を検査する方法の１つに、検査対象物をハンマ等で叩いて打音を確認する打音検査がある。この打音検査に関連して幾つかの技術が提案されている。
【０００３】
特許文献１は、検知装置と、該検知装置を遠隔操作する監視・操縦装置を有する、外壁浮き検知システムを記載している。検知装置は、移動飛行体に配設されるとともに、打診器と、移動飛行体操縦受信器と、集音装置と、打診音送信器を有する。監視・操縦装置は、移動飛行体操縦送信器と、打診音受信器と、スピーカを有する。作業者は、移動飛行体を遠隔操縦し、建築物の外壁を打診器により打診する。
【０００４】
特許文献２は、トンネルの軸方向へ走行する走行体に配設されたポストと、ポストの上端部に配設されたアームを有する、トンネル覆工コンクリートの打音検査装置を記載している。アームの先端には支持プレートが配設され、支持プレートには２列の間隔保持車輪と、該２列の間隔保持車輪間に配置された１本のハンマが配設されている。この打音検査装置は、２列の間隔保持車輪を、トンネル覆工コンクリートの表面の凹凸に追従して接触させることにより、トンネル覆工コンクリートの表面とハンマの打撃開始位置との間隔を一定に保持している。
【０００５】
特許文献３は、構造物の表面を叩いて検査する検査ヘッドと、該検査ヘッドを構造物の検査面に押し付けつつ移動させるヘッド移動手段を有する、構造物打音検査装置を記載している。この構造物打音検査装置は、ヘッド移動手段を備えた自走車輌を移動させつつ所定の検査範囲を連続した一連の動作で打音検査する。
【０００６】
特許文献４は、ロボット走行レールに沿って連続的に走行・停止する検査ロボットを有するコンクリート健全度判定装置を記載している。この判定装置は、検査ロボットに配設されたマイクロホンの位置を常に一定とすることによりハンマの打撃音の精度良い採取を図ると同時に、受音解放端部のコンクリート面に対する接合・離間を計測ユニットの上昇下降操作だけで行うことにより検査時間の短縮化を図っている。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２０１２−１４５３４６号公報
【特許文献２】特開２００４−２０５２１６号公報
【特許文献３】特許第３５９５４９２号公報
【特許文献４】特開２００２−３０３６１０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
以下の分析は、本開示によって与えられたものである。
【０００９】
特許文献１に記載の外壁浮き検知システムでは、作業者が移動飛行体を遠隔操縦して適切な点検箇所へ誘導する必要がある。このため、移動飛行体の操縦に作業者の技術を必要とする。作業者が操縦に不慣れな場合、点検作業に想定以上の時間を要し、又は、点検を上手く行えないことになる。
【００１０】
特許文献２に記載のトンネル覆工コンクリートの打音検査装置では、この打音検査装置を搭載した２ｔトラック等の走行体を走行させて、トンネル覆工コンクリートの打音検査装置を移動させる必要がある。従って、この打音検査装置は、走行体が進入できない領域に位置する点検箇所に対しては打音検査を実施できない。
【００１１】
特許文献３に記載の構造物打音検査装置では、点検ヘッド及びヘッド移動手段を搭載した自走車輌を走行させる。このため、この打音検査装置は、自走車輌が進入できない領域に位置する点検箇所に対しては打音検査を実施できない。
【００１２】
特許文献４に記載のコンクリート健全度判定装置では、検査ロボットを搭載した自走車輛を走行させる。このため、この判定装置は、自走車輛が進入できない領域に位置する点検箇所に対しては、健全度判定が実施できない。
【００１３】
本開示は、少なくとも、上記問題点の少なくとも１つを解決することを課題とする。
【課題を解決するための手段】
【００１４】
本開示の第１の視点により、被検対象物の状態を点検するための点検装置が提供される。
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含む。
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含む。
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する機体位置姿勢推定器と、
打検機ハンマ部誤差信号を生成する打検機ハンマ部誤差信号生成器と、
打検機ハンマ部位置姿勢信号を生成する打検機ハンマ部位置姿勢信号生成器と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する第１センサデータ周波数特性補完器と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する第２センサデータ周波数特性補完器と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する打検機ハンマ部位置姿勢推定器
を含む。
【００１５】
本開示の第２の視点により、打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御方法が提供される。
該制御方法は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成するステップと、
打検機ハンマ部誤差信号を生成するステップと、
打検機ハンマ部位置姿勢信号を生成するステップと、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成するステップと、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成するステップと、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成するステップ
を含む。
【００１６】
本開示の第３の視点により、打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御プログラムが提供される。
該制御プログラムは、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する処理と、
打検機ハンマ部誤差信号を生成する処理と、
打検機ハンマ部位置姿勢信号を生成する処理と、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する処理と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する処理と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する処理
をコンピュータに実行させる。
【００１７】
本開示の第４の視点により、被検対象物の状態を点検するための点検装置が提供される。
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含む。
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含む。
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する手段と、
打検機ハンマ部誤差信号を生成する手段と、
打検機ハンマ部位置姿勢信号を生成する手段と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する手段と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する手段と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する手段と、
を含む。
【図面の簡単な説明】
【００１８】
【図１】本開示の一実施形態による点検装置の信号処理系の主要部のブロック図。
【図２】図１の打検機ハンマ部誤差信号生成器のブロック図。
【図３】図１の打検機ハンマ部位置姿勢信号生成器のブロック図。
【図４】本開示の一実施形態による点検装置の駆動用の信号処理系のブロック図。
【図５】本開示の一実施形態による点検装置の一例。
【発明を実施するための形態】
【００１９】
本開示の概要について図１〜図５を参照して説明する。なお、概要に付記する図面参照符号は専ら理解を助けるためのものであり、本開示を図示の態様に限定することを意図するものではない。
【００２０】
点検装置は、一般的に、打検機ハンマ部１０３を先端に有する打検機アーム１０２を有する打音検査機１０１が配設された移動体１００である（図５参照）。本開示に係る点検装置は、その信号処理系の主要部として、移動体１００の位置姿勢情報を推定し機体位置姿勢推定信号２０を生成する機体位置姿勢推定器１と、打検機ハンマ部誤差信号２１を生成する打検機ハンマ部誤差信号生成器２と、打検機ハンマ部位置姿勢信号２２を生成する打検機ハンマ部位置姿勢信号生成器３と、生成された機体位置姿勢推定信号２０を受信し、受信した機体位置姿勢推定信号２０から第１センサデータ周波数特性補完信号２３を生成する第１センサデータ周波数特性補完器４と、生成された打検機ハンマ部誤差信号２１と生成された打検機ハンマ部位置姿勢信号２２を受信し、受信した打検機ハンマ部誤差信号２１と受信した打検機ハンマ部位置姿勢信号２２から第２センサデータ周波数特性補完信号２４を生成する第２センサデータ周波数特性補完器５と、生成された第１センサデータ周波数特性補完信号２３と生成された第２センサデータ周波数特性補完信号２４を受信し、受信した第１センサデータ周波数特性補完信号２３と受信した第２センサデータ周波数特性補完信号２４から打検機ハンマ部位置姿勢推定信号２５を生成する打検機ハンマ部位置姿勢推定器６を有する（図１参照）。なお、ここでいう「機体」とは移動体１００の機体を意味する。
【００２１】
このように構成された点検装置において、打検機ハンマ部位置姿勢推定信号２５は以下のように生成される。即ち、打音検査機１０１が配設された移動体１００の機体位置姿勢推定器１により生成された移動体１００の機体位置姿勢推定信号２０を、低データサンプリングレート処理系で構成された第１センサデータ周波数特性補間器４において、機体制御系の周波数特性を考慮した重み付け補間を実施することにより、第１センサデータ周波数特性補間信号２３を生成する；打検機ハンマ部誤差信号２１と打検機ハンマ部位置姿勢信号２２（両者を合わせて打検機ハンマ部相対誤差推定信号ともいう）を高データサンプリングレート処理系で構成された第２センサデータ周波数特性補間器５において、打音検査機制御系の周波数特性を考慮した重み付け補間を実施することにより、第２センサデータ周波数特性補間信号２４を生成する；打検機ハンマ部位置姿勢推定器６において第１センサデータ周波数特性補間信号２３と第２センサデータ周波数特性補間信号２４を組み合わせることにより、打検機ハンマ部位置姿勢推定信号２５を生成する。
【００２２】
かくして、本開示は、機体位置姿勢推定器１が生成する移動体１００の機体位置姿勢推定信号２０のサンプリング間隔が相対的に長く、その信号から得られる周波数帯域や精度に物理的な制約がある場合であっても、打検機ハンマ部位置姿勢推定信号２５をリアルタイムかつ高精度に生成することができ、その結果、打検機ハンマ部１０３の位置及び／又は姿勢をリアルタイムかつ高精度に調整することができる。
【００２３】
更に、本開示に応じ、打検機ハンマ部誤差信号生成器２は、打検機ハンマ部１０３の先端に配設された測距センサ７と、打検機ハンマ部１０３に配設された力覚センサ８と、打検機ハンマ部１０３に配設された先端部位置姿勢センサ９を含む。測距センサ７は、打検機ハンマ部１０３の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号２６を生成する。力覚センサ８は、打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号２７を生成する。先端部位置姿勢センサ９は、打検機ハンマ部１０３の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号２８を生成する。打検機ハンマ部誤差信号生成器２の打検機ハンマ部誤差信号２１は、測距センサ信号２６と、力覚センサ信号２７と、先端部位置姿勢センサ信号２８から生成される（図２参照）。
【００２４】
更に、本開示に応じ、打検機ハンマ部位置姿勢信号生成器３は、打検機アーム１０２の直動部に配設された直動部変位センサ１０と、打検機アーム１０２の先端部角度駆動部に配設された先端部角度センサ１１と、打検機アーム１０２のアーム部角度駆動部に配設されたアーム部角度センサ１２を含む。直動部変位センサ１０は、直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号２９を生成する。先端部角度センサ１１は、先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号３０を生成する。アーム部角度センサ１２は、アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号３１を生成する。打検機ハンマ部位置姿勢信号生成器３の打検機ハンマ部位置姿勢信号２２は、直動部変位センサ信号２９と、先端部角度センサ信号３０と、アーム部角度センサ信号３１から生成される（図３参照）。
【００２５】
更に、本開示に応じ、点検装置は、生成された打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から機体位置姿勢駆動指令信号を生成する機体位置姿勢駆動指令信号生成器１３と、生成された打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から先端部アクチュエータ指令信号を生成する先端部アクチュエータ指令信号生成器１４と、生成された打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５からアーム部アクチュエータ指令信号を生成するアーム部アクチュエータ指令信号生成器１５と、生成された打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から直動部アクチュエータ指令信号を生成する直動部アクチュエータ指令信号生成器１６を含む（図４参照）。そして、移動体１００の機体の位置及び／又は姿勢は、機体位置姿勢駆動指令信号に基づいて調整される。他方、打検機ハンマ部１０３の位置及び／又は姿勢（ないし配向）は、先端部アクチュエータ指令信号、アーム部アクチュエータ指令信号及び直動部アクチュエータ指令信号に基づいて夫々打音検査機１０１の先端部アクチュエータ、アーム部アクチュエータ及び直動部アクチュエータを駆動することによって調整される。
【００２６】
なお、本開示に係る点検装置は、一般的には、橋梁、トンネル等のような被検対象物の状態、とりわけそれらの損傷や欠陥等の劣化状態の点検に使用される。移動体には、マルチロータヘリないしドローンのような飛行体が含まれるが、これに限定されない。例えば、車両も移動体に含まれ得る。また、移動体は、有利には、無人のものであるが、有人のものであってもよい。更に、点検装置と、該点検装置と有線又は無線で通信する通信装置を含む点検システムを構成することも可能である。通信装置は、例えば、被検対象物の目標部位への接近又は当該目標部位からの離脱を点検装置に指示する指令信号を点検装置に送信する機能や、点検装置が撮影した画像情報を受信する機能を有する。点検システムは、更に、このような信号や情報を処理する情報処理装置も含み得る。
【００２７】
以下に、本開示の具体的実施形態を、図面を参照して詳細に説明する。なお、以下の実施形態に付記する図面参照符号は専ら理解を助けるためのものであり、本発明を図示の態様に限定することを意図するものではない。
【００２８】
図１は、本開示の一実施形態による点検装置の信号処理系の主要部のブロック図である。なお、本実施形態においては、図５に示されているように、点検装置は、打音検査機１０１と、打音検査機１０１が配設された移動体１００を含んで構成され、打音検査機１０１は、打検機アーム１０２と、打検機アーム１０２の先端に配設された打検機ハンマ部１０３を含んで構成される。移動体１００は、本実施形態においては、マルチロータヘリである。
【００２９】
図１に示されているように、点検装置は、機体位置姿勢推定器１、打検機ハンマ部誤差信号生成器２、打検機ハンマ部位置姿勢信号生成器３、第１センサデータ周波数特性補間器４、第２センサデータ周波数特性補間器５及び打検機ハンマ部位置姿勢推定器６を含む。
【００３０】
図２は、図１の打検機ハンマ部誤差信号生成器２のブロック図である。図示のように、打検機ハンマ部誤差信号生成器２は、測距センサ７、力覚センサ８及び先端部位置姿勢センサ９を含んで構成される。測距センサ７は、打検機ハンマ部１０３の先端に配設されており、該打検機ハンマ部１０３の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号２６を生成する。力覚センサ８は、打検機ハンマ部１０３に配設されており、打検機ハンマ部１０３に印加された力情報を検出し、検出した力情報から力覚センサ信号２７を生成する。先端部位置姿勢センサ９は、打検機ハンマ部１０３に配設されており、打検機ハンマ部１０３の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号２８を生成する。打検機ハンマ部誤差信号生成器２は、測距センサ信号２６、力覚センサ信号２７及び先端部位置姿勢センサ信号２８から打検機ハンマ部誤差信号２１を生成する。
【００３１】
図３は、図１の打検機ハンマ部位置姿勢信号生成器３のブロック図である。図示のように、打検機ハンマ部位置姿勢信号生成器３は、直動部変位センサ１０、先端部角度センサ１１及びアーム部角度センサ１２を含んで構成される。直動部変位センサ１０は、打検機アーム１０２の直動部に配設されており、直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号２９を生成する。先端部角度センサ１１は、打検機アーム１０２の先端部角度駆動部に配設されており、先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号３０を生成する。アーム部角度センサ１２は、打検機アーム１０２のアーム部角度駆動部に配設されており、アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号３１を生成する。打検機ハンマ部位置姿勢信号生成器３は、直動部変位センサ信号２９、先端部角度センサ信号３０及びアーム部角度センサ信号３１から打検機ハンマ部位置姿勢信号２２を生成する。
【００３２】
打検機ハンマ部位置姿勢推定器６は、機体位置姿勢推定器１で検出した機体位置姿勢推定信号２０から第１センサデータ周波数特性補間器４によって生成される第１センサデータ周波数特性補間信号２３と、打検機ハンマ部誤差信号生成器２によって生成される打検機ハンマ部誤差信号２１及び打検機ハンマ部位置姿勢信号生成器３によって生成される打検機ハンマ部位置姿勢信号２２から第２センサデータ周波数特性補間器５によって生成される第２センサデータ周波数特性補間信号２４とから、打検機ハンマ部位置姿勢推定信号２５を生成する。
【００３３】
図４は、本開示の一実施形態による点検装置の駆動用の信号処理系のブロック図である。点検装置は、機体位置姿勢駆動指令信号生成器１３と、先端部アクチュエータ指令信号生成器１４と、アーム部アクチュエータ指令信号生成器１５と、直動部アクチュエータ指令信号生成器１６を含む。機体位置姿勢駆動指令信号生成器１３は、打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から機体位置姿勢駆動指令信号を生成する。先端部アクチュエータ指令信号生成器１４は、打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から先端部アクチュエータ指令信号を生成する。アーム部アクチュエータ指令信号生成器１５は、打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５からアーム部アクチュエータ指令信号を生成する。直動部アクチュエータ指令信号生成器１６は、打検機ハンマ部位置姿勢推定信号２５を受信し、受信した打検機ハンマ部位置姿勢推定信号２５から直動部アクチュエータ指令信号を生成する。
【００３４】
移動体１００の機体の位置及び／又は姿勢は、機体位置姿勢駆動指令信号に基づいて調整される。他方、打検機ハンマ部１０３の位置及び／又は姿勢（ないし配向）は、先端部アクチュエータ指令信号、アーム部アクチュエータ指令信号及び直動部アクチュエータ指令信号に基づいて夫々打音検査機１０１の先端部アクチュエータ、アーム部アクチュエータ及び直動部アクチュエータを駆動することによって調整される。
【００３５】
以下に、打音検査機１０１の先端に配された打検機ハンマ部１０３の位置姿勢情報を１ｋＨｚの高サンプリング周波数で推定し生成する場合を説明する。
【００３６】
まず、第１センサデータ周波数特性補間器４は、２Ｈｚ程度に設定された機体制御帯域によって得られる機体挙動を高精度に再現するために、高々１０Ｈｚのサンプリング周波数で機体位置姿勢推定器１が生成する機体位置姿勢推定信号２０に対し、２Ｈｚ付近の周波数特性信号を強調する周波数帯限定強調フィルタ（バンドパスフィルタ／窓関数）処理とデータ補間処理を同時に実施する。その結果、第１センサデータ周波数特性補間器４は、打検機ハンマ部１０３の位置姿勢情報として取得する１ｋＨｚの高サンプリング周波数の推定信号に対応可能な第１センサデータ周波数特性補間信号２３を生成する。
【００３７】
このとき高々１０Ｈｚのサンプリング周波数でしか得られない機体位置姿勢推定信号２０から１ｋＨｚの高サンプリング周波数の推定信号を導出するために、以下の処理を行う。
【００３８】
機体位置姿勢推定信号２０に含まれる機体速度及び機体角速度を、それぞれ、
2018173390.tif 000003
及び
2018173390.tif 000004
と設定する。更に、機体位置及び機体姿勢
2018173390.tif 000005
及び
2018173390.tif 000006
からシステム状態量及び誤差共分散行列を、それぞれ、
2018173390.tif 000007
及び
2018173390.tif 000008
と設定する。そして、第１センサデータ周波数特性補間器４では線形確率システム（状態空間モデル）
2018173390.tif 000009
（１）
（
2018173390.tif 000010
は状態遷移行列、
2018173390.tif 000011
は駆動ノイズ行列、
2018173390.tif 000012
は駆動入力行列、
2018173390.tif 000013
は観測行列、
2018173390.tif 000014
は
2018173390.tif 000015
、
2018173390.tif 000016
は観測信号）に基づき、以下の計算式を用いてシステム状態量に対する予測値
2018173390.tif 000017
と、誤差共分散行列予測値
2018173390.tif 000018
により姿勢予測値／誤差共分散値信号を生成する。
2018173390.tif 000019
（２）
2018173390.tif 000020
（３）
但し、式中、上付きの「＋」はカルマンフィルタ処理後の推定値、上付きの「−」はカルマンフィルタ処理前の伝播予測値、上付きの「Ｔ」は転置行列、下付きの「ｋ」は観測時系列の順序を示す。またシステムノイズ
2018173390.tif 000021
と観測ノイズ
2018173390.tif 000022
は互いに独立な白色ノイズを仮定し、さらに
2018173390.tif 000023
はシステムノイズ
2018173390.tif 000024
の共分散行列（カルマンフィルタ設計者が飛翔体ダイナミクス特性に応じ設定する設計パラメータ）を示す。
【００３９】
更に、第１センサデータ周波数特性補間器４では、機体位置姿勢推定信号２０に含まれる位置姿勢を式（１）に対するカルマンフィルタの更新値と見なした上で、観測時系列の順序を下付きの「ｎ」を用いて今回の観測を「ｎ」、次回の観測を「ｎ＋１」と記述し、このカルマンフィルタ更新処理を次の式（４）、式（５）、式（６）を用いて実施する。
2018173390.tif 000025
（４）
2018173390.tif 000026
（５）
2018173390.tif 000027
（６）
但し、
2018173390.tif 000028
は観測ノイズ
2018173390.tif 000029
の共分散行列（仮想的なカルマンフィルタ設計者が適用するジャイロ特性に応じ設定する設計パラメータ）であり、また上付きの「−１」は逆行列を示す。
【００４０】
以上の結果から、最終的に、第１センサデータ周波数特性補間器４から、式（２）と式（５）によって得られる機体位置姿勢推定補間データは、第１センサデータ周波数特性補間信号２３として生成される。
【００４１】
次に、第２センサデータ周波数特性補間器５は、３０Ｈｚ程度に設定された打検機制御帯域で駆動する打検機の挙動を高精度に推定可能とするために、打検機ハンマ部誤差信号２１と打検機ハンマ部位置姿勢信号２２とから１ｋＨｚのサンプリング周波数で得られる先端部位置姿勢信号に対し、３０Ｈｚ付近の周波数成分を中心に取得した信号の重み付けを実施する周波数強調フィルタ（バンドパスフィルタ／窓関数）処理とデータ補間処理を同時に実施する。その結果、第２センサデータ周波数特性補間器５は、第２センサデータ周波数特性補間信号２４を生成する。
【００４２】
そして、打検機ハンマ部位置姿勢推定器６は、第１センサデータ周波数特性補間信号２３と第２センサデータ周波数特性補間信号２４を組み合わせることにより、１ｋＨｚ及び１０Ｈｚのサンプリング周波数によって打検機ハンマ部位置姿勢推定信号２５を生成することができる。なお、第１センサデータ周波数特性補間信号２３は、第１センサデータ周波数特性補間器４において機体位置姿勢推定信号２０に対し機体位置姿勢挙動の制御帯域に基づいた周波数重み付けにより強調処理すると同時にデータ補間処理により１ｋＨｚのサンプリング周波数相当として生成した機体の位置姿勢推定信号である。また、第２センサデータ周波数特性補間信号２４は、１ｋＨｚのサンプリング周波数によって打検機ハンマ部１０３の誤差信号を生成する打検機ハンマ部誤差信号生成器２と１ｋＨｚのサンプリング周波数によって打検機ハンマ部１０３の位置姿勢信号を生成する打検機ハンマ部位置姿勢信号生成器３とからの生成信号に対し、打検機制御帯域に基づき周波数重み付けで強調処理すると同時にデータ補間処理した打検機ハンマ部先端の位置姿勢信号である。
【００４３】
従って、本実施形態によれば、サンプリング周波数や制御特性の異なる機体位置姿勢推定器１と打検機ハンマ部誤差信号生成器２と打検機ハンマ部位置姿勢信号生成器３とから取得したデータ同士の最適な組合せが、第１センサデータ周波数特性補間器４と第２センサデータ周波数特性補間器５とを同時に適用することで容易に可能になる。このため、打検機ハンマ部位置姿勢推定器６による打検機ハンマ部位置姿勢推定が理想状態に近い形での適切な処理となる。その結果、本実施形態による打検機ハンマ部位置姿勢推定は、単なるデータ補間処理と比較して更に高精度化される。
【００４４】
なお、ここで示した第１センサデータ周波数特性補間器４と第２センサデータ周波数特性補間器５における補間処理は、それぞれ機体と打検機ハンマとの動特性をそれぞれの制御系による制御周波数特性として適切に評価した結果として実現するフィルタリング処理とデータ補間処理との組合せで構成する独自技術であり、公知技術の単なる組合せからは予期し得ない顕著な効果を奏するものである。
【００４５】
以下に、本明細書、図面に開示した本発明に関する好ましい形態を付記する。
［形態１］
被検対象物の状態を点検するための点検装置であって、
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含み、
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含み、
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する機体位置姿勢推定器と、
打検機ハンマ部誤差信号を生成する打検機ハンマ部誤差信号生成器と、
打検機ハンマ部位置姿勢信号を生成する打検機ハンマ部位置姿勢信号生成器と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する第１センサデータ周波数特性補完器と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する第２センサデータ周波数特性補完器と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する打検機ハンマ部位置姿勢推定器
を含む、点検装置。
［形態２］
前記打検機ハンマ部誤差信号生成器は、
前記打検機ハンマ部の先端に配設された測距センサであって、該打検機ハンマ部の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号を生成する測距センサと、
前記打検機ハンマ部に配設された力覚センサであって、該打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号を生成する力覚センサと、
前記打検機ハンマ部に配設された先端部位置姿勢センサであって、該打検機ハンマ部の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号を生成する先端部位置姿勢センサ、
を含む、
ここで、前記打検機ハンマ部誤差信号は、前記測距センサ信号と、前記力覚センサ信号と、前記先端部位置姿勢センサ信号から生成される、
形態１の点検装置。
［形態３］
前記打検機ハンマ部位置姿勢信号生成器は、
前記打検機アームの直動部に配設された直動部変位センサであって、該直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号を生成する直動部変位センサと、
前記打検機アームの先端部角度駆動部に配設された先端部角度センサであって、先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号を生成する先端部角度センサと、
前記打検機アームのアーム部角度駆動部に配設されたアーム部角度センサであって、アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号を生成するアーム部角度センサ、
を含む、
ここで、前記打検機ハンマ部位置姿勢信号は、前記直動部変位センサ信号と、前記先端部角度センサ信号と、前記アーム部角度センサ信号から生成される、
形態１又は２の点検装置。
［形態４］
前記第１センサデータ周波数特性補間器は、前記機体位置姿勢推定信号に対し、前記移動体の位置及び姿勢に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第１センサデータ周波数特性補間信号を生成するよう構成されている、
形態１乃至３の何れかの点検装置。
［形態５］
前記第２センサデータ周波数特性補間器は、前記打検機ハンマ部誤差信号と前記打検機ハンマ部位置姿勢信号に対し、前記打検機アームの直動部及び先端部及びアーム部に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第２センサデータ周波数特性補間信号を生成するよう構成されている、
形態１乃至４の何れかの点検装置。
［形態６］
前記打検機ハンマ部位置姿勢推定器は、前記第１センサデータ周波数特性補間信号を伝播信号としかつ前記第２センサデータ周波数特性補間信号を更新信号とするカルマンフィルタ処理を実施することにより前記打検機ハンマ部位置姿勢推定信号を生成するよう構成されている、
形態１乃至５の何れかの点検装置。
［形態７］
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から機体位置姿勢駆動指令信号を生成する機体位置姿勢駆動指令信号生成器と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から先端部アクチュエータ指令信号を生成する先端部アクチュエータ指令信号生成器と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号からアーム部アクチュエータ指令信号を生成するアーム部アクチュエータ指令信号生成器と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から直動部アクチュエータ指令信号を生成する直動部アクチュエータ指令信号生成部
を含む、
形態１乃至６の何れかの点検装置。
［形態８］
打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御方法であって、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成するステップと、
打検機ハンマ部誤差信号を生成するステップと、
打検機ハンマ部位置姿勢信号を生成するステップと、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成するステップと、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成するステップと、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成するステップ
を含む、
点検装置の制御方法。
［形態９］
前記打検機ハンマ部の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号を生成するステップと、
前記打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号を生成するステップと、
前記打検機ハンマ部の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号を生成するステップと、
前記測距センサ信号と、前記力覚センサ信号と、前記先端部位置姿勢センサ信号から前記打検機ハンマ部誤差信号を生成するステップ
を含む、
形態８の制御方法。
［形態１０］
前記打検機アームの直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号を生成するステップと、
先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号を生成するステップと、
アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号を生成するステップと、
前記直動部変位センサ信号と、前記先端部角度センサ信号と、前記アーム部角度センサ信号から前記打検機ハンマ部位置姿勢信号を生成するステップ
を含む、
形態８又は９の制御方法。
［形態１１］
前記機体位置姿勢推定信号に対し、前記移動体の位置及び姿勢に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第１センサデータ周波数特性補間信号を生成するステップ
を含む、
形態８乃至１０の何れかの制御方法。
［形態１２］
前記打検機ハンマ部誤差信号と前記打検機ハンマ部位置姿勢信号に対し、前記打検機アームの直動部及び先端部及びアーム部に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第２センサデータ周波数特性補間信号を生成するステップ
を含む、
形態８乃至１１の何れかの制御方法。
［形態１３］
前記第１センサデータ周波数特性補間信号を伝播信号としかつ前記第２センサデータ周波数特性補間信号を更新信号とするカルマンフィルタ処理を実施することにより前記打検機ハンマ部位置姿勢推定信号を生成するステップ
を含む、
形態８乃至１２の何れかの制御方法。
［形態１４］
生成された打検機ハンマ部位置姿勢推定信号から機体位置姿勢駆動指令信号を生成するステップと、
生成された打検機ハンマ部位置姿勢推定信号から先端部アクチュエータ指令信号を生成するステップと、
生成された打検機ハンマ部位置姿勢推定信号からアーム部アクチュエータ指令信号を生成するステップと、
生成された打検機ハンマ部位置姿勢推定信号から直動部アクチュエータ指令信号を生成するステップと、
生成された機体位置姿勢駆動指令信号に基づいて、前記移動体の機体の位置及び／又は姿勢を調整するステップと、
生成された先端部アクチュエータ指令信号と、生成されたアーム部アクチュエータ指令信号と、生成された直動部アクチュエータ指令信号に基づいて、前記打検機ハンマ部の位置及び／又は姿勢を調整するステップ
を含む、
形態８乃至１３の何れかの制御方法。
［形態１５］
打検機アーム及び該打検機アームの先端に配設された打検機ハンマ部を含む打音検査機と、該打音検査機が配設された移動体を含む、被検対象物の状態を点検するための点検装置の制御プログラムであって、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する処理と、
打検機ハンマ部誤差信号を生成する処理と、
打検機ハンマ部位置姿勢信号を生成する処理と、
生成された機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する処理と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する処理と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号から機体位置姿勢駆動指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号から先端部アクチュエータ指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号からアーム部アクチュエータ指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号から直動部アクチュエータ指令信号を生成する処理と、
生成された機体位置姿勢駆動指令信号に基づいて、前記移動体の機体の位置及び／又は姿勢を調整する処理と、
生成された先端部アクチュエータ指令信号と、生成されたアーム部アクチュエータ指令信号と、生成された直動部アクチュエータ指令信号に基づいて、前記打検機ハンマ部の位置及び／又は姿勢を調整する処理
をコンピュータに実行させる、
点検装置の制御プログラム。
［形態１６］
前記打検機ハンマ部の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号を生成する処理と、
前記打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号を生成する処理と、
前記打検機ハンマ部の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号を生成する処理と、
前記測距センサ信号と、前記力覚センサ信号と、前記先端部位置姿勢センサ信号から前記打検機ハンマ部誤差信号を生成する処理
をコンピュータに実行させる、
形態１５の制御プログラム。
［形態１７］
前記打検機アームの直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号を生成する処理と、
先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号を生成する処理と、
アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号を生成する処理と、
前記直動部変位センサ信号と、前記先端部角度センサ信号と、前記アーム部角度センサ信号から前記打検機ハンマ部位置姿勢信号を生成する処理
をコンピュータに実行させる、
形態１５又は１６の制御プログラム。
［形態１８］
前記機体位置姿勢推定信号に対し、前記移動体の位置及び姿勢に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第１センサデータ周波数特性補間信号を生成する処理
をコンピュータに実行させる、
形態１５乃至１７の何れかの制御プログラム。
［形態１９］
前記打検機ハンマ部誤差信号と前記打検機ハンマ部位置姿勢信号に対し、前記打検機アームの直動部及び先端部及びアーム部に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第２センサデータ周波数特性補間信号を生成する処理
をコンピュータに実行させる、
形態１５乃至１８の何れかの制御プログラム。
［形態２０］
前記第１センサデータ周波数特性補間信号を伝播信号としかつ前記第２センサデータ周波数特性補間信号を更新信号とするカルマンフィルタ処理を実施することにより前記打検機ハンマ部位置姿勢推定信号を生成する処理
をコンピュータに実行させる、
形態１５乃至１９の何れかの制御プログラム。
［形態２１］
生成された打検機ハンマ部位置姿勢推定信号から機体位置姿勢駆動指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号から先端部アクチュエータ指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号からアーム部アクチュエータ指令信号を生成する処理と、
生成された打検機ハンマ部位置姿勢推定信号から直動部アクチュエータ指令信号を生成する処理と、
生成された機体位置姿勢駆動指令信号に基づいて、前記移動体の機体の位置及び／又は姿勢を調整する処理と、
生成された先端部アクチュエータ指令信号と、生成されたアーム部アクチュエータ指令信号と、生成された直動部アクチュエータ指令信号に基づいて、前記打検機ハンマ部の位置及び／又は姿勢を調整する処理
をコンピュータに実行させる、
形態１５乃至２０の何れかの制御プログラム。
［形態２２］
被検対象物の状態を点検するための点検装置であって、
該点検装置は、打音検査機と、該打音検査機が配設された移動体を含み、
前記打音検査機は、打検機アームと、該打検機アームの先端に配設された打検機ハンマ部を含み、
該点検装置は、
前記移動体の位置姿勢情報を推定し機体位置姿勢推定信号を生成する手段と、
打検機ハンマ部誤差信号を生成する手段と、
打検機ハンマ部位置姿勢信号を生成する手段と、
生成された機体位置姿勢推定信号を受信し、受信した機体位置姿勢推定信号から第１センサデータ周波数特性補完信号を生成する手段と、
生成された打検機ハンマ部誤差信号と生成された打検機ハンマ部位置姿勢信号を受信し、受信した打検機ハンマ部誤差信号と受信した打検機ハンマ部位置姿勢信号から第２センサデータ周波数特性補完信号を生成する手段と、
生成された第１センサデータ周波数特性補完信号と生成された第２センサデータ周波数特性補完信号を受信し、受信した第１センサデータ周波数特性補完信号と受信した第２センサデータ周波数特性補完信号から打検機ハンマ部位置姿勢推定信号を生成する手段
を含む、
点検装置。
［形態２３］
前記打検機ハンマ部誤差信号生成手段は、
前記打検機ハンマ部の先端と打検対象物の表面との距離を検出し、検出した距離から測距センサ信号を生成する手段と、
前記打検機ハンマ部に印加された力情報を検出し、検出した力情報から力覚センサ信号を生成する手段と、
前記打検機ハンマ部の位置姿勢情報を検出し、検出した位置姿勢情報から先端部位置姿勢センサ信号を生成する手段、
を含む、
ここで、前記打検機ハンマ部誤差信号は、前記測距センサ信号と、前記力覚センサ信号と、前記先端部位置姿勢センサ信号から生成される、
形態２２の点検装置。
［形態２４］
前記打検機ハンマ部位置姿勢信号生成手段は、
前記打検機アームの直動部の変位情報を検出し、検出した変位情報から直動部変位センサ信号を生成する手段と、
先端部角度情報を検出し、検出した先端部角度情報から先端部角度センサ信号を生成する手段と、
アーム部角度情報を検出し、検出したアーム部角度情報からアーム部角度センサ信号を生成する手段、
を含む、
ここで、前記打検機ハンマ部位置姿勢信号は、前記直動部変位センサ信号と、前記先端部角度センサ信号と、前記アーム部角度センサ信号から生成される、
形態２２又は２３の点検装置。
［形態２５］
前記第１センサデータ周波数特性補完信号生成手段は、前記機体位置姿勢推定信号に対し、前記移動体の位置及び姿勢に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第１センサデータ周波数特性補間信号を生成する、
形態２２乃至２４の何れかの点検装置。
［形態２６］
前記第２センサデータ周波数特性補間信号生成手段は、前記打検機ハンマ部誤差信号と前記打検機ハンマ部位置姿勢信号に対し、前記打検機アームの直動部及び先端部及びアーム部に対する制御系の周波数特性を考慮した重み付け処理とサンプリング周波数間の補間処理とを組み合わせて適用することにより、前記第２センサデータ周波数特性補間信号を生成する、
形態２２乃至２５の何れかの点検装置。
［形態２７］
前記打検機ハンマ部位置姿勢推定信号生成手段は、前記第１センサデータ周波数特性補間信号を伝播信号としかつ前記第２センサデータ周波数特性補間信号を更新信号とするカルマンフィルタ処理を実施することにより前記打検機ハンマ部位置姿勢推定信号を生成する、
形態２２乃至２６の何れかの点検装置。
［形態２８］
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から機体位置姿勢駆動指令信号を生成する手段と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から先端部アクチュエータ指令信号を生成する手段と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号からアーム部アクチュエータ指令信号を生成する手段と、
生成された打検機ハンマ部位置姿勢推定信号を受信し、受信した打検機ハンマ部位置姿勢推定信号から直動部アクチュエータ指令信号を生成する手段と、
生成された機体位置姿勢駆動指令信号に基づいて、前記移動体の機体の位置及び／又は姿勢を調整する手段、
を含み、
先端部アクチュエータは、生成された先端部アクチュエータ指令信号を受信する手段を有し、
アーム部アクチュエータは、生成されたアーム部アクチュエータ指令信号を受信する手段を有し、及び、
直動部アクチュエータは、生成された直動部アクチュエータ指令信号を受信する手段を有する、
形態２２乃至２７の何れかの点検装置。
［形態２９］
形態１乃至７及び２２乃至２８の何れかに記載の点検装置と、該点検装置と有線又は無線で通信する通信装置を含む、点検システム。
【００４６】
なお、上記特許文献の各開示を引用を以って本書に繰り込むものとする。本発明の全開示（特許請求の範囲及び図面を含む）の枠内において、さらにその基本的技術思想に基づいて、実施形態の変更・調整が可能である。また、本発明の特許請求の範囲の枠内において種々の開示要素（各請求項の各要素、各実施例の各要素、各図面の各要素等を含む）の多様な組み合わせ乃至選択が可能である。すなわち、本発明は、特許請求の範囲及び図面を含む全開示、技術的思想にしたがって当業者であればなし得るであろう各種変形、修正を含むことは勿論である。
【符号の説明】
【００４７】
１      機体位置姿勢推定器
２      打検機ハンマ部誤差信号生成器
３      打検機ハンマ部位置姿勢信号生成器
４      第１センサデータ周波数特性補間器
５      第２センサデータ周波数特性補間器
６      打検機ハンマ部位置姿勢推定器
７      測距センサ
８      力覚センサ
９      先端部位置姿勢センサ
１０    直動部変位センサ
１１    先端部角度センサ
１２    アーム部角度センサ
１３    機体位置姿勢駆動指令信号生成器
１４    先端部アクチュエータ指令信号生成器
１５    アーム部アクチュエータ指令信号生成器
１６    直動部アクチュエータ指令信号生成器
２０    機体位置姿勢推定信号
２１    打検機ハンマ部誤差信号
２２    打検機ハンマ部位置姿勢信号
２３    第１センサデータ周波数特性補間信号
２４    第２センサデータ周波数特性補間信号
２５    打検機ハンマ部位置姿勢推定信号
２６    測距センサ信号
２７    力覚センサ信号
２８    先端部位置姿勢センサ信号
２９    直動部変位センサ信号
３０    先端部角度センサ信号
３１    アーム部角度センサ信号
１００  移動体
１０１  打音検査機
１０２  打検機アーム
１０３  打検機ハンマ部
【図１】
2018173390.tif 000030
【図２】
2018173390.tif 000031
【図３】
2018173390.tif 000032
【図４】
2018173390.tif 000033
【図５】
2018173390.tif 000034