ホーム > 特許ランキング > リンクウィズ株式会社
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2022031083
(43)【公開日】2022-02-18
(54)【発明の名称】情報処理方法、情報処理システム、プログラム
(51)【国際特許分類】
B25J 13/08 20060101AFI20220210BHJP
B25J 9/22 20060101ALI20220210BHJP
【ＦＩ】
B25J13/08 A
B25J9/22 Z
【審査請求】未請求
【請求項の数】4
【出願形態】ＯＬ
(21)【出願番号】P 2020186944
(22)【出願日】2020-11-10
(62)【分割の表示】P 2020134703の分割
【原出願日】2020-08-07
(71)【出願人】
【識別番号】517425446
【氏名又は名称】リンクウィズ株式会社
(74)【代理人】
【識別番号】110002790
【氏名又は名称】Ｏｎｅ ｉｐ特許業務法人
(72)【発明者】
【氏名】鈴木 紀克
(72)【発明者】
【氏名】オストロウモフ ゲオルギー
【テーマコード（参考）】
3C707
【Ｆターム（参考）】
3C707AS11
3C707AS12
3C707BS09
3C707KS03
3C707KT03
3C707KT05
3C707KT09
3C707KV11
3C707KX07
3C707LS09
3C707LS15
3C707LT17
3C707MT04
(57)【要約】 （修正有）
【課題】より精度よくロボット座標系とセンサ座標系との対応付けができるようにする。
【解決手段】対象物の所定の平面上の原点当接座標情報及び第１の当接座標情報並びに第２の当接座標情報を取得するステップと、対象物からセンサにより三次元モデルデータを取得するステップと、三次元モデルデータにおける対象物の平面上の任意の３点の座標情報を取得し、平面に対する法線ベクトルを算出するステップと、三次元モデルデータにおける第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、第１の穴部中心座標及び第２の穴部中心座標を算出するステップと、第１の穴部中心座標及び第２の穴部中心座標を結んだ直線ベクトルを算出するステップと、直線ベクトルと、法線ベクトルと、原点から前記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応付けるステップと、含む情報処理方法。
【選択図】図６
【解決手段】対象物の所定の平面上の原点当接座標情報及び第１の当接座標情報並びに第２の当接座標情報を取得するステップと、対象物からセンサにより三次元モデルデータを取得するステップと、三次元モデルデータにおける対象物の平面上の任意の３点の座標情報を取得し、平面に対する法線ベクトルを算出するステップと、三次元モデルデータにおける第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、第１の穴部中心座標及び第２の穴部中心座標を算出するステップと、第１の穴部中心座標及び第２の穴部中心座標を結んだ直線ベクトルを算出するステップと、直線ベクトルと、法線ベクトルと、原点から前記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応付けるステップと、含む情報処理方法。
【選択図】図６
【特許請求の範囲】
【請求項1】
情報処理方法であって、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
を含む、ことを特徴とする情報処理方法。
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
を含む、ことを特徴とする情報処理方法。
【請求項2】
請求項１に記載の情報処理方法であって、
前記対応付けるステップは、
前記直線ベクトルと前記ロボット座標系の１軸を対応付け、
前記法線ベクトルと前記ロボット座標系の他の１軸を対応付け、
前記ロボット座標系または前記センサ座標系を前記第１の直線に沿った方向に前記規定
距離の値だけオフセットすることを含む、
ことを特徴とする情報処理方法。
前記対応付けるステップは、
前記直線ベクトルと前記ロボット座標系の１軸を対応付け、
前記法線ベクトルと前記ロボット座標系の他の１軸を対応付け、
前記ロボット座標系または前記センサ座標系を前記第１の直線に沿った方向に前記規定
距離の値だけオフセットすることを含む、
ことを特徴とする情報処理方法。
【請求項3】
情報処理システムであって、
対象物の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直
線上の第１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられ
たツール先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標
情報及び前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当
接座標情報を取得するロボット座標取得部と、
前記対象物からセンサにより三次元モデルデータを取得する三次元モデルデータ取得部
と、
前記三次元モデルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取
得し、当該３点の座標情報に基づいて当該平面に対する法線ベクトルを算出する法線ベク
トル算出部と、
前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１の穴部及び
第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点の座標情報
から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中心座標を算
出する中心座標算出部と、
前記第１の穴部中心座標及び前記第２の穴部中心座標を結んだ直線ベクトルを算出する
直線ベクトル算出部と、
前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心までの
規定距離の値を用いて、センサ座標系とロボット座標系を対応付ける座標系対応付け部と
、
を含む、ことを特徴とする情報処理システム。
対象物の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直
線上の第１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられ
たツール先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標
情報及び前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当
接座標情報を取得するロボット座標取得部と、
前記対象物からセンサにより三次元モデルデータを取得する三次元モデルデータ取得部
と、
前記三次元モデルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取
得し、当該３点の座標情報に基づいて当該平面に対する法線ベクトルを算出する法線ベク
トル算出部と、
前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１の穴部及び
第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点の座標情報
から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中心座標を算
出する中心座標算出部と、
前記第１の穴部中心座標及び前記第２の穴部中心座標を結んだ直線ベクトルを算出する
直線ベクトル算出部と、
前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心までの
規定距離の値を用いて、センサ座標系とロボット座標系を対応付ける座標系対応付け部と
、
を含む、ことを特徴とする情報処理システム。
【請求項4】
情報処理方法をコンピュータに実行させるためのプログラムであって、
前記プログラムは、前記情報処理方法として、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
をコンピュータに実行させる、ことを特徴とするプログラム。
前記プログラムは、前記情報処理方法として、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
をコンピュータに実行させる、ことを特徴とするプログラム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、情報処理方法、情報処理システム、プログラムに関する。
【背景技術】
【0002】
従来から、センサやカメラなどの計測器から得た情報を基に制御される作業用ロボット
アームが存在しており、このような作業用ロボットアームを動作させる前に計測機器と作
業用ロボットの座標合わせを行うキャリブレーションが実施されていた（例えば、特許文
献１を参照）。
アームが存在しており、このような作業用ロボットアームを動作させる前に計測機器と作
業用ロボットの座標合わせを行うキャリブレーションが実施されていた（例えば、特許文
献１を参照）。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開２０１２－２４０１７４号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
しかしながら、例えば特許文献１に記載のキャリブレーションの場合、作業用ロボット
アームにカメラを備えて、特殊なマーカーを撮影することでキャリブレーションを行うこ
とが必要である。
アームにカメラを備えて、特殊なマーカーを撮影することでキャリブレーションを行うこ
とが必要である。
【0005】
本発明はこのような背景を鑑みてなされたものであり、カメラと特殊なマーカーを用い
ずに精度よくキャリブレーションを行う情報処理システムを提供することが可能である。
ずに精度よくキャリブレーションを行う情報処理システムを提供することが可能である。
【課題を解決するための手段】
【0006】
上記課題を解決するための本発明の主たる発明は、ロボット座標取得部により、対象物
の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直線上の第
１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられたツール
先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標情報及び
前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当接座標情
報を取得するステップと、三次元モデルデータ取得部により、前記対象物からセンサによ
り三次元モデルデータを取得するステップと、法線ベクトル算出部により、前記三次元モ
デルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取得し、当該３点
の座標情報に基づいて当該平面に対する法線ベクトルを算出するステップと、中心座標算
出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１
の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点
の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中
心座標を算出するステップと、直線ベクトル算出部により、前記第１の穴部中心座標及び
前記第２の穴部中心座標を結んだ直線ベクトルを算出するステップと、座標系対応付け部
により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心
までの規定距離の値を用いて、センサ座標系とロボット座標系を対応付けるステップと、
を含む、ことを特徴とする情報処理方法である。
の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直線上の第
１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられたツール
先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標情報及び
前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当接座標情
報を取得するステップと、三次元モデルデータ取得部により、前記対象物からセンサによ
り三次元モデルデータを取得するステップと、法線ベクトル算出部により、前記三次元モ
デルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取得し、当該３点
の座標情報に基づいて当該平面に対する法線ベクトルを算出するステップと、中心座標算
出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１
の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点
の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中
心座標を算出するステップと、直線ベクトル算出部により、前記第１の穴部中心座標及び
前記第２の穴部中心座標を結んだ直線ベクトルを算出するステップと、座標系対応付け部
により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心
までの規定距離の値を用いて、センサ座標系とロボット座標系を対応付けるステップと、
を含む、ことを特徴とする情報処理方法である。
【0007】
その他本願が開示する課題やその解決方法については、発明の実施形態の欄及び図面に
より明らかにされる。
より明らかにされる。
【発明の効果】
【0008】
本発明によれば、カメラと特殊なマーカーを用いずに精度よくキャリブレーションを行
う情報処理システムを提供することができる。
う情報処理システムを提供することができる。
【図面の簡単な説明】
【0009】
【図1】本実施形態の一の情報処理システム１００の全体構成例を示す図である。
【図2】本実施形態に係る端末１のハードウェア構成例を示す図である。
【図3】本実施形態に係る端末１の機能構成例を示す図である。
【図4】本実施形態に係る三次元モデルデータ７０の表示例を示す図を示す。
【図5】本実施形態に係る対象物６０の構成例を示す図である。
【図6】本実施形態に係る情報処理方法のフローチャート例を示す図である。
【図7】本実施形態に係る三次元モデルデータ７０の表示例を示す図である。
【図8】本実施形態に係る三次元モデルデータ７０の表示例を示す他の図である。
【図9】本実施形態に係る輪郭点群データの表示例を示す図である。
【図10】本実施形態に係るバウンダリ処理方法のフローチャート例を示す図である。
【図11】本実施形態に係るバウンダリ処理方法の一例を説明する図である。
【発明を実施するための形態】
【0010】
本発明の実施形態の内容を列記して説明する。本発明は、たとえば以下のような構成を
備える。
備える。
【0011】
［項目１］
情報処理方法であって、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
を含む、ことを特徴とする情報処理方法。
［項目２］
項目１に記載の情報処理方法であって、
前記対応付けるステップは、
前記直線ベクトルと前記ロボット座標系の１軸を対応付け、
前記法線ベクトルと前記ロボット座標系の他の１軸を対応付け、
前記ロボット座標系または前記センサ座標系を前記第１の直線に沿った方向に前記規定
距離の値だけオフセットすることを含む、
ことを特徴とする情報処理方法。
［項目３］
情報処理システムであって、
対象物の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直
線上の第１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられ
たツール先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標
情報及び前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当
接座標情報を取得するロボット座標取得部と、
前記対象物からセンサにより三次元モデルデータを取得する三次元モデルデータ取得部
と、
前記三次元モデルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取
得し、当該３点の座標情報に基づいて当該平面に対する法線ベクトルを算出する法線ベク
トル算出部と、
前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１の穴部及び
第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点の座標情報
から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中心座標を算
出する中心座標算出部と、
前記第１の穴部中心座標及び前記第２の穴部中心座標を結んだ直線ベクトルを算出する
直線ベクトル算出部と、
前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心までの
規定距離の値を用いて、センサ座標系とロボット座標系を対応付ける座標系対応付け部と
、
を含む、ことを特徴とする情報処理システム。
［項目４］
情報処理方法をコンピュータに実行させるためのプログラムであって、
前記プログラムは、前記情報処理方法として、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
をコンピュータに実行させる、ことを特徴とするプログラム。
情報処理方法であって、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
を含む、ことを特徴とする情報処理方法。
［項目２］
項目１に記載の情報処理方法であって、
前記対応付けるステップは、
前記直線ベクトルと前記ロボット座標系の１軸を対応付け、
前記法線ベクトルと前記ロボット座標系の他の１軸を対応付け、
前記ロボット座標系または前記センサ座標系を前記第１の直線に沿った方向に前記規定
距離の値だけオフセットすることを含む、
ことを特徴とする情報処理方法。
［項目３］
情報処理システムであって、
対象物の所定の平面上の第１の直線及び第２の直線の交点である原点及び当該第１の直
線上の第１の点並びに当該第２の直線上の第２の点の各点に、ロボットアームに設けられ
たツール先端を当接した際の、ロボット座標系における、前記原点に対する原点当接座標
情報及び前記第１の点に対する第１の当接座標情報並びに前記第２の点に対する第２の当
接座標情報を取得するロボット座標取得部と、
前記対象物からセンサにより三次元モデルデータを取得する三次元モデルデータ取得部
と、
前記三次元モデルデータにおける前記対象物の前記平面上の任意の３点の座標情報を取
得し、当該３点の座標情報に基づいて当該平面に対する法線ベクトルを算出する法線ベク
トル算出部と、
前記三次元モデルデータにおける前記対象物の前記平面上に設けられた第１の穴部及び
第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該各穴部の３点の座標情報
から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の第２の穴部中心座標を算
出する中心座標算出部と、
前記第１の穴部中心座標及び前記第２の穴部中心座標を結んだ直線ベクトルを算出する
直線ベクトル算出部と、
前記直線ベクトルと、前記法線ベクトルと、前記原点から前記第１の穴部の中心までの
規定距離の値を用いて、センサ座標系とロボット座標系を対応付ける座標系対応付け部と
、
を含む、ことを特徴とする情報処理システム。
［項目４］
情報処理方法をコンピュータに実行させるためのプログラムであって、
前記プログラムは、前記情報処理方法として、
ロボット座標取得部により、対象物の所定の平面上の第１の直線及び第２の直線の交点
である原点及び当該第１の直線上の第１の点並びに当該第２の直線上の第２の点の各点に
、ロボットアームに設けられたツール先端を当接した際の、ロボット座標系における、前
記原点に対する原点当接座標情報及び前記第１の点に対する第１の当接座標情報並びに前
記第２の点に対する第２の当接座標情報を取得するステップと、
三次元モデルデータ取得部により、前記対象物からセンサにより三次元モデルデータを
取得するステップと、
法線ベクトル算出部により、前記三次元モデルデータにおける前記対象物の前記平面上
の任意の３点の座標情報を取得し、当該３点の座標情報に基づいて当該平面に対する法線
ベクトルを算出するステップと、
中心座標算出部により、前記三次元モデルデータにおける前記対象物の前記平面上に設
けられた第１の穴部及び第２の穴部周辺の任意の３点の座標情報をそれぞれ取得し、当該
各穴部の３点の座標情報から前記第１の穴部の第１の穴部中心座標及び前記第２の穴部の
第２の穴部中心座標を算出するステップと、
直線ベクトル算出部により、前記第１の穴部中心座標及び前記第２の穴部中心座標を結
んだ直線ベクトルを算出するステップと、
座標系対応付け部により、前記直線ベクトルと、前記法線ベクトルと、前記原点から前
記第１の穴部の中心までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付けるステップと、
をコンピュータに実行させる、ことを特徴とするプログラム。
【0012】
＜実施の形態の詳細＞
本発明の一実施形態に係る情報処理システム１００の具体例を、以下に図面を参照しつ
つ説明する。なお、本発明はこれらの例示に限定されるものではなく、特許請求の範囲に
よって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれること
が意図される。以下の説明では、添付図面において、同一または類似の要素には同一また
は類似の参照符号及び名称が付され、各実施形態の説明において同一または類似の要素に
関する重複する説明は省略することがある。また、各実施形態で示される特徴は、互いに
矛盾しない限り他の実施形態にも適用可能である。
本発明の一実施形態に係る情報処理システム１００の具体例を、以下に図面を参照しつ
つ説明する。なお、本発明はこれらの例示に限定されるものではなく、特許請求の範囲に
よって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれること
が意図される。以下の説明では、添付図面において、同一または類似の要素には同一また
は類似の参照符号及び名称が付され、各実施形態の説明において同一または類似の要素に
関する重複する説明は省略することがある。また、各実施形態で示される特徴は、互いに
矛盾しない限り他の実施形態にも適用可能である。
【0013】
図１は、本実施形態の情報処理システム１００の一例を示す図である。図１に示される
ように、本実施形態の情報処理システム１００では、端末１と、作業用ロボット２とを有
している。作業用ロボット２は、少なくともアーム２１、ツール２２、センサ２３を有し
ている。端末１と作業用ロボット２とは、有線または無線にて互いに通信可能に接続され
ている。
ように、本実施形態の情報処理システム１００では、端末１と、作業用ロボット２とを有
している。作業用ロボット２は、少なくともアーム２１、ツール２２、センサ２３を有し
ている。端末１と作業用ロボット２とは、有線または無線にて互いに通信可能に接続され
ている。
【0014】
＜端末１＞
図２は、端末１のハードウェア構成を示す図である。端末１は、例えばパーソナルコン
ピュータのような汎用コンピュータとしてもよいし、或いはクラウド・コンピューティン
グによって論理的に実現されてもよい。なお、図示された構成は一例であり、これ以外の
構成を有していてもよい。例えば、端末１のプロセッサ１０に設けられる一部の機能が外
部のサーバや別端末により実行されてもよい。
図２は、端末１のハードウェア構成を示す図である。端末１は、例えばパーソナルコン
ピュータのような汎用コンピュータとしてもよいし、或いはクラウド・コンピューティン
グによって論理的に実現されてもよい。なお、図示された構成は一例であり、これ以外の
構成を有していてもよい。例えば、端末１のプロセッサ１０に設けられる一部の機能が外
部のサーバや別端末により実行されてもよい。
【0015】
端末１は、少なくとも、プロセッサ１０、メモリ１１、ストレージ１２、送受信部１３
、入出力部１４等を備え、これらはバス１５を通じて相互に電気的に接続される。
、入出力部１４等を備え、これらはバス１５を通じて相互に電気的に接続される。
【0016】
プロセッサ１０は、端末１全体の動作を制御し、少なくとも作業用ロボット２とのデー
タ等の送受信の制御、及びアプリケーションの実行及び認証処理に必要な情報処理等を行
う演算装置である。例えばプロセッサ１０はＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉ
ｎｇ Ｕｎｉｔ）および／またはＧＰＵ（Ｇｒａｐｈｉｃｓ Ｐｒｏｃｅｓｓｉｎｇ Ｕ
ｎｉｔ）であり、ストレージ１２に格納されメモリ１１に展開された本システムのための
プログラム等を実行して各情報処理を実施する。
タ等の送受信の制御、及びアプリケーションの実行及び認証処理に必要な情報処理等を行
う演算装置である。例えばプロセッサ１０はＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉ
ｎｇ Ｕｎｉｔ）および／またはＧＰＵ（Ｇｒａｐｈｉｃｓ Ｐｒｏｃｅｓｓｉｎｇ Ｕ
ｎｉｔ）であり、ストレージ１２に格納されメモリ１１に展開された本システムのための
プログラム等を実行して各情報処理を実施する。
【0017】
メモリ１１は、ＤＲＡＭ（Ｄｙｎａｍｉｃ Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒ
ｙ）等の揮発性記憶装置で構成される主記憶と、フラッシュメモリやＨＤＤ（Ｈａｒｄ
Ｄｉｓｃ Ｄｒｉｖｅ）等の不揮発性記憶装置で構成される補助記憶と、を含む。メモリ
１１は、プロセッサ１０のワークエリア等として使用され、また、端末１の起動時に実行
されるＢＩＯＳ（Ｂａｓｉｃ Ｉｎｐｕｔ ／ Ｏｕｔｐｕｔ Ｓｙｓｔｅｍ）、及び各
種設定情報等を格納する。
ｙ）等の揮発性記憶装置で構成される主記憶と、フラッシュメモリやＨＤＤ（Ｈａｒｄ
Ｄｉｓｃ Ｄｒｉｖｅ）等の不揮発性記憶装置で構成される補助記憶と、を含む。メモリ
１１は、プロセッサ１０のワークエリア等として使用され、また、端末１の起動時に実行
されるＢＩＯＳ（Ｂａｓｉｃ Ｉｎｐｕｔ ／ Ｏｕｔｐｕｔ Ｓｙｓｔｅｍ）、及び各
種設定情報等を格納する。
【0018】
ストレージ１２は、アプリケーション・プログラム等の各種プログラムを格納する。各
処理に用いられるデータを格納したデータベースがストレージ１２に構築されていてもよ
い。
処理に用いられるデータを格納したデータベースがストレージ１２に構築されていてもよ
い。
【0019】
送受信部１３は、端末１を少なくとも作業用ロボット２と接続し、プロセッサの指示に
従い、データ等の送受信を行う。なお、送受信部１３は、有線または無線により構成され
おり、無線である場合には、例えば、ＷｉＦｉやＢｌｕｅｔｏｏｔｈ（登録商標）及びＢ
ＬＥ（Ｂｌｕｅｔｏｏｔｈ Ｌｏｗ Ｅｎｅｒｇｙ）の近距離通信インターフェースによ
り構成されていてもよい。
従い、データ等の送受信を行う。なお、送受信部１３は、有線または無線により構成され
おり、無線である場合には、例えば、ＷｉＦｉやＢｌｕｅｔｏｏｔｈ（登録商標）及びＢ
ＬＥ（Ｂｌｕｅｔｏｏｔｈ Ｌｏｗ Ｅｎｅｒｇｙ）の近距離通信インターフェースによ
り構成されていてもよい。
【0020】
入出力部１４は、キーボード・マウス類等の情報入力機器、及びディスプレイ等の出力
機器である。
機器である。
【0021】
バス１５は、上記各要素に共通に接続され、例えば、アドレス信号、データ信号及び各
種制御信号を伝達する。
種制御信号を伝達する。
【0022】
＜作業用ロボット２＞
図１に戻り、本実施形態に係る作業用ロボット２について説明する。
図１に戻り、本実施形態に係る作業用ロボット２について説明する。
【0023】
上述のとおり、作業用ロボット２は、アーム２１と、ツール２２と、センサ２３とを有
する。なお、図示された構成は一例であり、これ以外の構成を有していてもよい。
する。なお、図示された構成は一例であり、これ以外の構成を有していてもよい。
【0024】
アーム２１は、三次元のロボット座標系に基づき、端末１にその動作を制御される。ま
た、アーム２１は、有線または無線で作業用ロボット２と接続されたコントローラ３をさ
らに備え、これによりその動作を制御されてもよい。
た、アーム２１は、有線または無線で作業用ロボット２と接続されたコントローラ３をさ
らに備え、これによりその動作を制御されてもよい。
【0025】
ツール２２は、三次元のツール座標系に基づき、端末１にその動作を制御される。また
、ツール２２の構成は、用途に合わせて何れのツールを備えていてもよく、例えば、溶接
用トーチや塗装用塗料噴射装置、把持装置、掘削装置、研磨装置などであってもよい。
、ツール２２の構成は、用途に合わせて何れのツールを備えていてもよく、例えば、溶接
用トーチや塗装用塗料噴射装置、把持装置、掘削装置、研磨装置などであってもよい。
【0026】
センサ２３は、三次元のセンサ座標系に基づき、対象物のセンシングを行う。センサ２
３は、例えば三次元スキャナとして動作するレーザセンサであり、センシングにより対象
物の三次元モデルデータ４１を取得する。三次元モデルデータは、例えば、図４に示され
るような三次元点群データであり、それぞれの点データがセンサ座標を有し、点群により
対象物の形状を把握することが可能となる。なお、センサ２３は、レーザセンサに限らず
、例えばステレオ方式などを用いた画像センサなどであってもよく、三次元のセンサ座標
系が取得できるものであればよい。
３は、例えば三次元スキャナとして動作するレーザセンサであり、センシングにより対象
物の三次元モデルデータ４１を取得する。三次元モデルデータは、例えば、図４に示され
るような三次元点群データであり、それぞれの点データがセンサ座標を有し、点群により
対象物の形状を把握することが可能となる。なお、センサ２３は、レーザセンサに限らず
、例えばステレオ方式などを用いた画像センサなどであってもよく、三次元のセンサ座標
系が取得できるものであればよい。
【0027】
より具体的には、作業前に所定のキャリブレーションを行い、ロボット座標系及びツー
ル座標系、センサ座標系を互いに対応付け、例えばセンサ座標系を基にユーザが位置を指
定することにより、アーム２１やツール２２が対応した位置を基に動作制御されるように
構成をなす。ロボット座標系及びツール座標系の対応付けは既知の方法で行われてよく、
ロボット及びツールを提供する事業者により対応付けがなされていることが通常であり、
本発明として、その後のセンサ座標系のキャリブレーションについて、後述する。
ル座標系、センサ座標系を互いに対応付け、例えばセンサ座標系を基にユーザが位置を指
定することにより、アーム２１やツール２２が対応した位置を基に動作制御されるように
構成をなす。ロボット座標系及びツール座標系の対応付けは既知の方法で行われてよく、
ロボット及びツールを提供する事業者により対応付けがなされていることが通常であり、
本発明として、その後のセンサ座標系のキャリブレーションについて、後述する。
【0028】
＜端末１の機能＞
図３は、端末１に実装される機能を例示したブロック図である。本実施の形態において
は、端末１のプロセッサ１０は、ロボット座標取得部１０１、三次元モデルデータ取得部
１０２、三次元モデルデータ表示部１０３、法線ベクトル算出部１０４、中心座標算出部
１０５、直線ベクトル算出部１０６、座標系対応付け部１０７を有している。また、端末
１のストレージ１２は、ロボット座標記憶部１２１、三次元モデルデータ記憶部１２２、
法線ベクトル関連情報記憶部１２３、中心座標関連情報記憶部１２４、直線ベクトル関連
情報記憶部１２５、座標系対応付け関連情報記憶部１２６を有している。
図３は、端末１に実装される機能を例示したブロック図である。本実施の形態において
は、端末１のプロセッサ１０は、ロボット座標取得部１０１、三次元モデルデータ取得部
１０２、三次元モデルデータ表示部１０３、法線ベクトル算出部１０４、中心座標算出部
１０５、直線ベクトル算出部１０６、座標系対応付け部１０７を有している。また、端末
１のストレージ１２は、ロボット座標記憶部１２１、三次元モデルデータ記憶部１２２、
法線ベクトル関連情報記憶部１２３、中心座標関連情報記憶部１２４、直線ベクトル関連
情報記憶部１２５、座標系対応付け関連情報記憶部１２６を有している。
【0029】
ロボット座標取得部１０１は、端末１またはコントローラ３により作業用ロボット２を
操作し、端末１により作業用ロボット２の位置がロボット座標系で何れの位置にいるかを
取得する。例えばロボット座標系は、既知のとおり、作業用ロボット２の所定の位置を原
点座標とする三次元座標である。取得したロボット座標は、例えば入力項目（例えば、後
述の原点Ｐ０、第１の点Ｐ１、第２の点Ｐ２など）に対応付けられてロボット座標記憶部
１２１に記憶される。
操作し、端末１により作業用ロボット２の位置がロボット座標系で何れの位置にいるかを
取得する。例えばロボット座標系は、既知のとおり、作業用ロボット２の所定の位置を原
点座標とする三次元座標である。取得したロボット座標は、例えば入力項目（例えば、後
述の原点Ｐ０、第１の点Ｐ１、第２の点Ｐ２など）に対応付けられてロボット座標記憶部
１２１に記憶される。
【0030】
三次元モデルデータ取得部１０２は、端末１またはコントローラ３により、作業用ロボ
ット２を操作し、例えばロボット座標取得部１０１を用いて、作業用ロボット２のアーム
２１のスキャン開始座標情報を取得及び設定し、センサ２３により対象物の三次元モデル
データを取得する。アーム２１の移動は、例えばスキャン終了座標情報が同様に設定され
ていてもよいし、スキャンの移動距離がユーザにより端末１から設定されていてもよい。
また、スキャン開始座標情報やスキャン終了座標情報は、ユーザにより端末１から設定さ
れていてもよい。取得した三次元モデルデータは、例えばセンサ座標系に基づく三次元座
標情報データであり、三次元モデルデータ記憶部１２２に記憶される。
ット２を操作し、例えばロボット座標取得部１０１を用いて、作業用ロボット２のアーム
２１のスキャン開始座標情報を取得及び設定し、センサ２３により対象物の三次元モデル
データを取得する。アーム２１の移動は、例えばスキャン終了座標情報が同様に設定され
ていてもよいし、スキャンの移動距離がユーザにより端末１から設定されていてもよい。
また、スキャン開始座標情報やスキャン終了座標情報は、ユーザにより端末１から設定さ
れていてもよい。取得した三次元モデルデータは、例えばセンサ座標系に基づく三次元座
標情報データであり、三次元モデルデータ記憶部１２２に記憶される。
【0031】
三次元モデルデータ表示部１０３は、三次元モデルデータ取得部１０２により取得され
た三次元モデルデータ（例えば、三次元点群データ）を、例えば図４に例示されるように
端末１の入出力部１４に表示する。ユーザは、表示された三次元モデルデータを任意の方
向から視認可能であり、例えば入出力部１４に接続されたキーボード・マウス類等の情報
入力機器にて、当該任意の方向を指定可能である。
た三次元モデルデータ（例えば、三次元点群データ）を、例えば図４に例示されるように
端末１の入出力部１４に表示する。ユーザは、表示された三次元モデルデータを任意の方
向から視認可能であり、例えば入出力部１４に接続されたキーボード・マウス類等の情報
入力機器にて、当該任意の方向を指定可能である。
【0032】
法線ベクトル算出部１０４は、端末１において、端末１上に表示された三次元モデルデ
ータ７０における任意の３点の座標情報を取得し、既知の演算により、当該３点の座標情
報に基づいて当該平面に対する法線ベクトル算出する。より具体的な例としては、例えば
垂直二等分線を用いるなどして３点が円周上に載っている円の中心座標や輪郭線、円平面
を算出したり、さらに予め設定された高さパラメータに基づき仮想円柱を設定し、円柱内
の点群に基づき平均円平面を求めるなどして、当該円平面に対する法線ベクトルを算出す
るようにしてもよい。上記３点の座標情報や中心座標、法線ベクトル等の法線ベクトル関
連情報は、法線ベクトル関連情報記憶部１２３に記憶される。
ータ７０における任意の３点の座標情報を取得し、既知の演算により、当該３点の座標情
報に基づいて当該平面に対する法線ベクトル算出する。より具体的な例としては、例えば
垂直二等分線を用いるなどして３点が円周上に載っている円の中心座標や輪郭線、円平面
を算出したり、さらに予め設定された高さパラメータに基づき仮想円柱を設定し、円柱内
の点群に基づき平均円平面を求めるなどして、当該円平面に対する法線ベクトルを算出す
るようにしてもよい。上記３点の座標情報や中心座標、法線ベクトル等の法線ベクトル関
連情報は、法線ベクトル関連情報記憶部１２３に記憶される。
【0033】
中心座標算出部１０５は、本実施形態においては、詳細は後述するが、端末１において
、端末１上に表示された三次元モデルデータ７０における対象物６０の所定の平面上に設
けられた第１の穴部６３及び第２の穴部６４周辺の任意の３点の座標情報Ｐ７－Ｐ９をそ
れぞれ取得し、各３点の座標情報から第１の穴部６３の第１の穴部中心座標Ｐ１０及び第
２の穴部６４の第２の穴部中心座標Ｐ１１を算出する。算出された第１の穴部中心座標Ｐ
１０及び第２の穴部中心座標Ｐ１１等の中心座標関連情報は、中心座標関連情報記憶部１
２４に記憶される。
、端末１上に表示された三次元モデルデータ７０における対象物６０の所定の平面上に設
けられた第１の穴部６３及び第２の穴部６４周辺の任意の３点の座標情報Ｐ７－Ｐ９をそ
れぞれ取得し、各３点の座標情報から第１の穴部６３の第１の穴部中心座標Ｐ１０及び第
２の穴部６４の第２の穴部中心座標Ｐ１１を算出する。算出された第１の穴部中心座標Ｐ
１０及び第２の穴部中心座標Ｐ１１等の中心座標関連情報は、中心座標関連情報記憶部１
２４に記憶される。
【0034】
直線ベクトル算出部１０６は、本実施形態においては、詳細は後述するが、端末１にお
いて、第１の穴部中心座標Ｐ１０及び第２の穴部中心座標Ｐ１１を結んだ直線ベクトルＶ
２を算出する。算出された直線ベクトル等の直線ベクトル関連情報は、直線ベクトル関連
情報記憶部１２５に記憶される。
いて、第１の穴部中心座標Ｐ１０及び第２の穴部中心座標Ｐ１１を結んだ直線ベクトルＶ
２を算出する。算出された直線ベクトル等の直線ベクトル関連情報は、直線ベクトル関連
情報記憶部１２５に記憶される。
【0035】
座標系対応付け部１０７は、直線ベクトルＶ２と、法線ベクトルＶ１と、原点Ｐ０から
第１の穴中心Ｐ１０までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付ける。センサ座標系とロボット座標系との対応付けに関する情報は、座標系対応付け関
連情報記憶部１２６に記憶される。
第１の穴中心Ｐ１０までの規定距離の値を用いて、センサ座標系とロボット座標系を対応
付ける。センサ座標系とロボット座標系との対応付けに関する情報は、座標系対応付け関
連情報記憶部１２６に記憶される。
【0036】
【0037】
一例として、対象物６０は平板形状の金属製または樹脂製のプレートであり、所定の平
面に図５の示されるような構成が設けられている。すなわち、第１の直線６１と第２の直
線６２とは互いに原点Ｐ０を交点として直交している。そして、原点Ｐ０から十分に離れ
た位置に、第１の直線６１上の第１の点Ｐ１及び第２の直線６２上の第２の点Ｐ２が設け
られている。これらの直線や点は、対象物６０上で目視で認識可能になっていればよく、
対象物６０上にインクや刻印等で直接書かれていてもよいし、対象物６０上に貼付された
シール等で間接的に書かれていてもよい。なお、説明の簡単化のために本実施形態におい
ては第１の直線６１及び第２の直線６２が直交しているが、第２の点Ｐ２はその他の原点
Ｐ０及び第１の点Ｐ１と組み合わせて所定の平面（例えば、ｘｙ平面）を規定するために
用いられればよいため、所定の平面上であれば何れの位置にあってもよい。
面に図５の示されるような構成が設けられている。すなわち、第１の直線６１と第２の直
線６２とは互いに原点Ｐ０を交点として直交している。そして、原点Ｐ０から十分に離れ
た位置に、第１の直線６１上の第１の点Ｐ１及び第２の直線６２上の第２の点Ｐ２が設け
られている。これらの直線や点は、対象物６０上で目視で認識可能になっていればよく、
対象物６０上にインクや刻印等で直接書かれていてもよいし、対象物６０上に貼付された
シール等で間接的に書かれていてもよい。なお、説明の簡単化のために本実施形態におい
ては第１の直線６１及び第２の直線６２が直交しているが、第２の点Ｐ２はその他の原点
Ｐ０及び第１の点Ｐ１と組み合わせて所定の平面（例えば、ｘｙ平面）を規定するために
用いられればよいため、所定の平面上であれば何れの位置にあってもよい。
【0038】
また、対象物６０の所定の平面には、図５に示されるような第１の穴部６３及び第２の
穴部６４が設けられており、各穴部は窪んでいてもよいし、貫通する構成であってもよい
。これらの穴部の形状は図示されるものに限定されず、後述のフローチャートが実施可能
な形状であれば、他の形状であってもよいし、互いに異なる形状であってもよい。また、
図５では第１の穴部６３のほうが大きく形成されているが、これに限らず、第１の穴部６
３のほうが小さく形成されていてもよい。さらに、穴形状に限らず突起でもよく、例えば
第２の穴部６４に代えて突起を設けることでも、後述の直線ベクトルＶ２を算出可能であ
る。
穴部６４が設けられており、各穴部は窪んでいてもよいし、貫通する構成であってもよい
。これらの穴部の形状は図示されるものに限定されず、後述のフローチャートが実施可能
な形状であれば、他の形状であってもよいし、互いに異なる形状であってもよい。また、
図５では第１の穴部６３のほうが大きく形成されているが、これに限らず、第１の穴部６
３のほうが小さく形成されていてもよい。さらに、穴形状に限らず突起でもよく、例えば
第２の穴部６４に代えて突起を設けることでも、後述の直線ベクトルＶ２を算出可能であ
る。
【0039】
【0040】
まず、ユーザは、端末１またはコントローラ３により作業用ロボット２を操作し、図６
に例示されるように対象物６０の所定の平面上に直行する２つの第１の直線６１及び第２
の直線６２の交点である原点Ｐ０及び当該第１の直線６１上の第１の点Ｐ１並びに当該第
２の直線６２上の第２の点Ｐ２の各点に、アーム２１に設けられたツール２２先端を当接
し、ロボット座標取得部１０１により、その際のアーム２１の原点Ｐ０に対する原点当接
座標情報及び第１の点Ｐ１に対する第１の当接座標情報並びに第２の点Ｐ２に対する第２
の当接座標情報を端末１にて取得する（ＳＱ１０１）。これにより、ロボット座標系にお
いて対象物６０の所定の平面上の３点の座標情報を取得したので、既知の演算により、作
業用ロボット２のロボット座標系の三次元座標と対象物６０の所定の平面の現実位置との
対応付けが可能となる。
に例示されるように対象物６０の所定の平面上に直行する２つの第１の直線６１及び第２
の直線６２の交点である原点Ｐ０及び当該第１の直線６１上の第１の点Ｐ１並びに当該第
２の直線６２上の第２の点Ｐ２の各点に、アーム２１に設けられたツール２２先端を当接
し、ロボット座標取得部１０１により、その際のアーム２１の原点Ｐ０に対する原点当接
座標情報及び第１の点Ｐ１に対する第１の当接座標情報並びに第２の点Ｐ２に対する第２
の当接座標情報を端末１にて取得する（ＳＱ１０１）。これにより、ロボット座標系にお
いて対象物６０の所定の平面上の３点の座標情報を取得したので、既知の演算により、作
業用ロボット２のロボット座標系の三次元座標と対象物６０の所定の平面の現実位置との
対応付けが可能となる。
【0041】
次に、ユーザは、端末１またはコントローラ３により作業用ロボット２を操作し、セン
サ２３による対象物６０からの三次元モデルデータ取得における作業用ロボット２のアー
ム２１のスキャン開始座標情報を設定し、三次元モデルデータ取得部１０２により、セン
サ２３により、上述のスキャン開始座標情報に基づき、例えば作業台上に位置する対象物
６０から三次元モデルデータ７０（例えば、三次元点群データなど）を取得する（ＳＱ１
０２）。なお、必要に応じてスキャン終了座標情報を設定するようにしてもよいが、本実
施形態においては、スキャンの移動距離が予め設定されているのでこの限りではない。ま
た、スキャン開始座標情報の設定は、スキャンまでに実行されていればよいため、前述の
ステップＳＱ１０１よりも先に実行されてもよい。
サ２３による対象物６０からの三次元モデルデータ取得における作業用ロボット２のアー
ム２１のスキャン開始座標情報を設定し、三次元モデルデータ取得部１０２により、セン
サ２３により、上述のスキャン開始座標情報に基づき、例えば作業台上に位置する対象物
６０から三次元モデルデータ７０（例えば、三次元点群データなど）を取得する（ＳＱ１
０２）。なお、必要に応じてスキャン終了座標情報を設定するようにしてもよいが、本実
施形態においては、スキャンの移動距離が予め設定されているのでこの限りではない。ま
た、スキャン開始座標情報の設定は、スキャンまでに実行されていればよいため、前述の
ステップＳＱ１０１よりも先に実行されてもよい。
【0042】
次に、三次元モデルデータ表示部１０３により、取得した三次元モデルデータ７０を端
末１上で表示する（ＳＱ１０３）。なお、本実施形態においては、センサ２３がアーム２
１に対してツール２２の取り付け位置よりスキャン方向前方にあるため、図７に例示され
るように第１の穴部６３及び第２の穴部６４部分を含む対象物６０の範囲の三次元モデル
データ７０が取得されており、本情報処理方法においては当該範囲の三次元モデルデータ
７０で十分であるが、センサ２３による三次元モデルデータ７０の取得範囲はこれに限定
されるものではない。
末１上で表示する（ＳＱ１０３）。なお、本実施形態においては、センサ２３がアーム２
１に対してツール２２の取り付け位置よりスキャン方向前方にあるため、図７に例示され
るように第１の穴部６３及び第２の穴部６４部分を含む対象物６０の範囲の三次元モデル
データ７０が取得されており、本情報処理方法においては当該範囲の三次元モデルデータ
７０で十分であるが、センサ２３による三次元モデルデータ７０の取得範囲はこれに限定
されるものではない。
【0043】
次に、法線ベクトル算出部１０４により、図７に例示されるように、端末１において、
端末１上に表示された三次元モデルデータ７０における対象物６０の上述の平面上の任意
の３点の座標情報Ｐ４－Ｐ６を取得し、既知の演算により、当該３点の座標情報に基づい
て当該平面に対する法線ベクトルＶ１を算出する（ＳＱ１０４）。既知の演算は、例えば
上記３点の座標情報Ｐ４－Ｐ６から垂直二等分線を用いるなどして円平面を求めたり、さ
らに当該円及び予め設定された高さパラメータに基づき仮想円柱を設定し、円柱内の点群
に基づき平均円平面を求めるなどして、当該円平面に対する法線ベクトルを法線ベクトル
Ｖ１として算出する。これにより、対象物６０の所定の平面に対して垂直方向をセンサ座
標系の１軸（例えば、ｚ軸）として認識させることができる。なお、本ステップＳＱ１０
５は、後述のステップＳＱ１０７までに実行されていればよいため、次に説明するステッ
プＳＱ１０６が先に実行されてもよい。
端末１上に表示された三次元モデルデータ７０における対象物６０の上述の平面上の任意
の３点の座標情報Ｐ４－Ｐ６を取得し、既知の演算により、当該３点の座標情報に基づい
て当該平面に対する法線ベクトルＶ１を算出する（ＳＱ１０４）。既知の演算は、例えば
上記３点の座標情報Ｐ４－Ｐ６から垂直二等分線を用いるなどして円平面を求めたり、さ
らに当該円及び予め設定された高さパラメータに基づき仮想円柱を設定し、円柱内の点群
に基づき平均円平面を求めるなどして、当該円平面に対する法線ベクトルを法線ベクトル
Ｖ１として算出する。これにより、対象物６０の所定の平面に対して垂直方向をセンサ座
標系の１軸（例えば、ｚ軸）として認識させることができる。なお、本ステップＳＱ１０
５は、後述のステップＳＱ１０７までに実行されていればよいため、次に説明するステッ
プＳＱ１０６が先に実行されてもよい。
【0044】
次に、中心座標算出部１０５により、図８に例示されるように、端末１において、三次
元モデルデータ７０における対象物６０の所定の平面上に設けられた第１の穴部６３及び
第２の穴部６４周辺の任意の３点の座標情報Ｐ７－Ｐ９をそれぞれ取得し、各３点の座標
情報から第１の穴部６３及び第２の穴部６４の第１の穴部中心座標Ｐ１０及び第２の穴部
６４の第２の穴部中心座標Ｐ１１を算出する（ＳＱ１０５）。より具体的には、中心座標
算出部１０５は、例えば、第１の穴部６３及び第２の穴部６４周辺の各３点から垂直二等
分線を用いるなどして仮円中心座標を算出し、当該仮円中心座標から順次放射状に広がる
方向に三次元モデルデータを探索しながら最初に到達した三次元モデルデータ座標を基に
第１の穴部６３及び第２の穴部６４の仮輪郭座標を導出する。そして、当該仮輪郭座標を
基に、既知の演算（例えば、円の最小二乗法など）により、第１の穴部中心座標Ｐ１０及
び第２の穴部中心座標Ｐ１１を算出する。
元モデルデータ７０における対象物６０の所定の平面上に設けられた第１の穴部６３及び
第２の穴部６４周辺の任意の３点の座標情報Ｐ７－Ｐ９をそれぞれ取得し、各３点の座標
情報から第１の穴部６３及び第２の穴部６４の第１の穴部中心座標Ｐ１０及び第２の穴部
６４の第２の穴部中心座標Ｐ１１を算出する（ＳＱ１０５）。より具体的には、中心座標
算出部１０５は、例えば、第１の穴部６３及び第２の穴部６４周辺の各３点から垂直二等
分線を用いるなどして仮円中心座標を算出し、当該仮円中心座標から順次放射状に広がる
方向に三次元モデルデータを探索しながら最初に到達した三次元モデルデータ座標を基に
第１の穴部６３及び第２の穴部６４の仮輪郭座標を導出する。そして、当該仮輪郭座標を
基に、既知の演算（例えば、円の最小二乗法など）により、第１の穴部中心座標Ｐ１０及
び第２の穴部中心座標Ｐ１１を算出する。
【0045】
なお、当該輪郭座標の導出は、例えば反対に、上述の３点の座標情報Ｐ７－Ｐ９から得
られた仮輪郭座標から仮円中心座標に順次収束する方向に三次元モデルデータを探索しな
がら、最初に消失した位置の直前の三次元モデルデータ座標を基に実行されてもよい。ま
た、中心座標算出部１０５は、出願人が特許第６７１３７００号にて公開済みの技術（輪
郭点群座標の算出）を用いて、例えば三次元点群データの輪郭座標を算出し、円の最小二
乗法により第１の穴部６３及び第２の穴部６４の第１の穴部中心座標Ｐ１０及び第２の穴
部６４の第２の穴部中心座標Ｐ１１を算出してもよい。さらに、第１の穴部６３及び第２
の穴部６４が円形状であるが、例えば、既知の演算により、四角形状（特に正方形など）
などであってもよく、各穴部の形状に合わせたパラメータを算出すればよい。
られた仮輪郭座標から仮円中心座標に順次収束する方向に三次元モデルデータを探索しな
がら、最初に消失した位置の直前の三次元モデルデータ座標を基に実行されてもよい。ま
た、中心座標算出部１０５は、出願人が特許第６７１３７００号にて公開済みの技術（輪
郭点群座標の算出）を用いて、例えば三次元点群データの輪郭座標を算出し、円の最小二
乗法により第１の穴部６３及び第２の穴部６４の第１の穴部中心座標Ｐ１０及び第２の穴
部６４の第２の穴部中心座標Ｐ１１を算出してもよい。さらに、第１の穴部６３及び第２
の穴部６４が円形状であるが、例えば、既知の演算により、四角形状（特に正方形など）
などであってもよく、各穴部の形状に合わせたパラメータを算出すればよい。
【0046】
次に、直線ベクトル算出部１０６により、端末１において、第１の穴部中心座標Ｐ１０
及び第２の穴部中心座標Ｐ１１を結んだ直線ベクトルＶ２を算出する（ＳＱ１０６）。
及び第２の穴部中心座標Ｐ１１を結んだ直線ベクトルＶ２を算出する（ＳＱ１０６）。
【0047】
次に、座標系対応付け部１０７により、直線ベクトルＶ２と、法線ベクトルＶ１と、原
点Ｐ０から第１の穴中心Ｐ１０までの規定距離の値を用いて、センサ座標系とロボット座
標系を対応付ける（ＳＱ１０７）。より具体的には、直線ベクトルＶ２（センサ座標系の
ｘ軸方向）と第１の直線６１に基づくロボット座標系のｘ軸方向が対応付けられるととも
に、法線ベクトルＶ１とロボット座標系のz軸方向とが対応付けられ、さらに対象物６０
において、第１の穴中心Ｐ１０が原点Ｐ０からの第１の直線６１上の規定距離（例えば、
１００～２００ｍｍの所定の長さ）と設定されているため、これらをロボット座標系とセ
ンサ座標系の第１の直線６１に沿ったオフセット値として用いることで、両座標系の対応
付けが行われ、キャリブレーションが完了したこととなる。
点Ｐ０から第１の穴中心Ｐ１０までの規定距離の値を用いて、センサ座標系とロボット座
標系を対応付ける（ＳＱ１０７）。より具体的には、直線ベクトルＶ２（センサ座標系の
ｘ軸方向）と第１の直線６１に基づくロボット座標系のｘ軸方向が対応付けられるととも
に、法線ベクトルＶ１とロボット座標系のz軸方向とが対応付けられ、さらに対象物６０
において、第１の穴中心Ｐ１０が原点Ｐ０からの第１の直線６１上の規定距離（例えば、
１００～２００ｍｍの所定の長さ）と設定されているため、これらをロボット座標系とセ
ンサ座標系の第１の直線６１に沿ったオフセット値として用いることで、両座標系の対応
付けが行われ、キャリブレーションが完了したこととなる。
【0048】
このように、ＳＱ１０７において、法線ベクトルＶ１を用いることにより、より精度よ
くロボット座標系とセンサ座標系との対応付けが可能となる。より具体的には、三次元モ
デルデータ７０における第１の穴部６３及び第２の穴部６４の輪郭部分は、データが徐々
に欠落して結果として穴部であることが示されているところ、センサ２３の特性上（特に
レーザセンサや画像センサの特性上）、例えば上述の方法で輪郭座標を算出（探索）した
場合に穴部を形成する輪郭形状が実際の輪郭形状とは異なりガタつくことがある。また、
特に三次元点群データを用いる場合には、一見平面に見えるが実際にはｚ軸方向にズレが
生じている。これらの結果、そのような輪郭形状を基に法線ベクトルを算出すると、対象
物６０の所定の平面に対して垂直ではないベクトルが算出されてしまうことがあり、ｘｙ
ｚ軸がずれてしまうことがあった。そこで、法線ベクトルＶ１をセンサ座標系の１軸（例
えば、ｚ軸）として利用することで、より精度よくロボット座標系とセンサ座標系との対
応付けが可能となる。
くロボット座標系とセンサ座標系との対応付けが可能となる。より具体的には、三次元モ
デルデータ７０における第１の穴部６３及び第２の穴部６４の輪郭部分は、データが徐々
に欠落して結果として穴部であることが示されているところ、センサ２３の特性上（特に
レーザセンサや画像センサの特性上）、例えば上述の方法で輪郭座標を算出（探索）した
場合に穴部を形成する輪郭形状が実際の輪郭形状とは異なりガタつくことがある。また、
特に三次元点群データを用いる場合には、一見平面に見えるが実際にはｚ軸方向にズレが
生じている。これらの結果、そのような輪郭形状を基に法線ベクトルを算出すると、対象
物６０の所定の平面に対して垂直ではないベクトルが算出されてしまうことがあり、ｘｙ
ｚ軸がずれてしまうことがあった。そこで、法線ベクトルＶ１をセンサ座標系の１軸（例
えば、ｚ軸）として利用することで、より精度よくロボット座標系とセンサ座標系との対
応付けが可能となる。
【0049】
したがって、本実施形態の情報処理システム１００は、カメラと特殊なマーカーを用い
ずにキャリブレーションを行う情報処理システムを提供することができるものである。
ずにキャリブレーションを行う情報処理システムを提供することができるものである。
【0050】
以下、参考として、上述のＳＱ１０５にて例示された輪郭点群座標の算出（バウンダリ
処理）について説明する。
処理）について説明する。
【0051】
この場合、端末１のプロセッサ１０は、さらにバウンダリ処理部を備える。バウンダリ
処理部は、図４に例示されるような三次元モデルデータ４１が三次元点群データである場
合に、図９に例示されるような三次元点群データの輪郭を構成する輪郭点群データ９１の
みを残すように処理を行う。輪郭点群データは、三次元点群データ同様、例えばセンサ座
標系に基づく三次元座標情報データであり、中心座標関連情報記憶部１２４や輪郭点群デ
ータ記憶部（不図示）等に記憶される。
処理部は、図４に例示されるような三次元モデルデータ４１が三次元点群データである場
合に、図９に例示されるような三次元点群データの輪郭を構成する輪郭点群データ９１の
みを残すように処理を行う。輪郭点群データは、三次元点群データ同様、例えばセンサ座
標系に基づく三次元座標情報データであり、中心座標関連情報記憶部１２４や輪郭点群デ
ータ記憶部（不図示）等に記憶される。
【0052】
【0053】
まず、バウンダリ処理部は、三次元点群データのうち１つの点データを選択する（ＳＱ
２０１）。
２０１）。
【0054】
次に、バウンダリ処理部は、選択された点データを中心とする所定の半径を有する円の
内部に含まれる点のそれぞれについて、選択された点データから線分をそれぞれ引く（Ｓ
Ｑ２０２）。
内部に含まれる点のそれぞれについて、選択された点データから線分をそれぞれ引く（Ｓ
Ｑ２０２）。
【0055】
次に、複数の当該線分のうち、例えば選択された点データを中心に所定の回転方向で隣
り合う２つの線分がなす角度を算出する（ＳＱ２０３）。
り合う２つの線分がなす角度を算出する（ＳＱ２０３）。
【0056】
次に、算出された角度の何れもが、ユーザが設定した設定値より小さいかどうかを判定
する（ＳＱ２０４）。
する（ＳＱ２０４）。
【0057】
より具体的には、図１１において、例えばユーザが設定値を１００°と設定した場合、
円７１においては、いずれの隣り合う２つの線分がなす角度も角度Ａのように設定値より
も小さい値（Ａ＜１００°）であると判定され（Ｙｅｓ）、円７２においては、角度Ｂの
ように設定値よりも大きい値（Ｂ＞１００°）を有する角度が存在すると判定される（Ｎ
ｏ）。
円７１においては、いずれの隣り合う２つの線分がなす角度も角度Ａのように設定値より
も小さい値（Ａ＜１００°）であると判定され（Ｙｅｓ）、円７２においては、角度Ｂの
ように設定値よりも大きい値（Ｂ＞１００°）を有する角度が存在すると判定される（Ｎ
ｏ）。
【0058】
ここで、Ｎｏと判定された場合には、選択された点データを輪郭点群データとして輪郭
点群データ記憶部に記憶する（ＳＱ２０５）。
点群データ記憶部に記憶する（ＳＱ２０５）。
【0059】
そして、Ｙｅｓと判定された場合、または、ＳＱ２０５終了後には、全ての点データを
選択したかどうかを判定し、Ｎｏと判定された場合にはＳＱ２０１へ戻り、Ｙｅｓと判定
された場合には終了とする（ＳＱ２０６）。
選択したかどうかを判定し、Ｎｏと判定された場合にはＳＱ２０１へ戻り、Ｙｅｓと判定
された場合には終了とする（ＳＱ２０６）。
【0060】
したがって、この場合の本実施形態の情報処理システム１００は、例えば上述のバウン
ダリ処理方法により、三次元点群データから対象物の輪郭形状を構成する輪郭点群データ
を簡易かつ迅速に検出することのできるものである。
ダリ処理方法により、三次元点群データから対象物の輪郭形状を構成する輪郭点群データ
を簡易かつ迅速に検出することのできるものである。
【0061】
以上、本実施形態について説明したが、上記実施形態は本発明の理解を容易にするため
のものであり、本発明を限定して解釈するためのものではない。本発明は、その趣旨を逸
脱することなく、変更、改良され得ると共に、本発明にはその等価物も含まれる。
のものであり、本発明を限定して解釈するためのものではない。本発明は、その趣旨を逸
脱することなく、変更、改良され得ると共に、本発明にはその等価物も含まれる。
【符号の説明】
【0062】
１ 端末
２ 作業用ロボット
２１ アーム
２２ ツール
２３ センサ
２ 作業用ロボット
２１ アーム
２２ ツール
２３ センサ
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】