JP5448069B2 - ロボット制御装置及び方法 - Google Patents
ロボット制御装置及び方法 Download PDFInfo
- Publication number
- JP5448069B2 JP5448069B2 JP2009296076A JP2009296076A JP5448069B2 JP 5448069 B2 JP5448069 B2 JP 5448069B2 JP 2009296076 A JP2009296076 A JP 2009296076A JP 2009296076 A JP2009296076 A JP 2009296076A JP 5448069 B2 JP5448069 B2 JP 5448069B2
- Authority
- JP
- Japan
- Prior art keywords
- camera
- workpiece
- robot
- control
- visual servo
- 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
Landscapes
- Manipulator (AREA)
Description
すなわち、ビジュアルサーボ制御では、「カメラによる撮影→画像処理→ワークの認識」と「位置計測→ワークのある方にアーム移動」、の処理を高速に繰り返して、ワークの移動にカメラを追従させるものである。
特許文献2は、画像の周囲領域を解析し、ワークのはみ出し量を推定し、推定した方向にカメラを移動し、かつ推定したはみ出し量に基づいて、カメラの焦点距離を変えるものである。
また、特許文献1では、ワークが視野からはみ出した場合は、焦点距離の制御のみでカメラを移動させないため、ワークを再補足しにくい。
さらに、特許文献2では、カメラの移動方向を計算する必要がある。また、ワークが完全に視野から外れた場合には対応できない問題点があった。
すなわち、本発明の目的は、ビジュアルサーボ制御中に、ワークがロボットに対して相対移動してカメラの視野からワークが外れた場合でも、焦点距離を変化させるズーム機構のないカメラを用いて、短時間にワークを再補足することができるロボット制御装置及び方法を提供することにある。
前記カメラで撮影した画像を画像処理する画像処理装置と、該ロボットを制御するロボットコントローラと、を備え、
ワークの位置と姿勢をカメラで計測し、計測結果に基づいてロボットをフィードバック制御し、カメラをワークの移動に追従させるビジュアルサーボ制御を実施し、
前記ビジュアルサーボ制御中に、ワークがカメラの視野から外れた場合に、認識したワークの最終位置を基に、カメラの目標位置と移動速度を変更してワークを再捕捉する、ことを特徴とするロボット制御装置が提供される。
(A) ワークの位置と姿勢をカメラで計測し、計測結果に基づいてロボットをフィードバック制御し、カメラをワークの移動に追従させるビジュアルサーボ制御と、
(B) 前記ビジュアルサーボ制御中に、ワークがカメラの視野から外れた場合に、認識したワークの最終位置を基に、カメラの目標位置と移動速度を変更してワークを再捕捉する再捕捉制御と、を有することを特徴とするロボット制御方法が提供される。
前記再捕捉制御において、前記目標位置を前記近接距離より離れた離隔距離とワークの最終位置に設定し、かつ前記移動速度をビジュアルサーボ制御時の移動速度より大きく設定する。
また、再捕捉制御により、前記ビジュアルサーボ制御中に、ワークがカメラの視野から外れた場合に、認識したワークの最終位置を基に、カメラの目標位置と移動速度を変更するので、焦点距離を変化させるズーム機構のないカメラを用いて、短時間にワークを再補足することができる。
従って、カメラの目標位置をワークの最終位置に設定することにより移動後のカメラの視野内にワークを再補足しやすい。また、カメラの目標位置をビジュアルサーボ制御時の近接距離より離れた離隔距離に設定することにより、焦点距離を変化させるズーム機構のないカメラの視野が広がり、ワークを再補足しやすくなる。さらに、カメラの移動速度をビジュアルサーボ制御時の移動速度より大きく設定するので、ワークがその最終位置から移動していても、見失ったワークに追いつきやすくなる。
また、カメラの姿勢を変更するワークの移動方向は、直前に認識された位置情報を使って求めるため、特別な計算処理は不要であり、処理時間を短くできる。
ワーク1の移動は、例えばコンベア装置による。コンベア装置は、ローラコンベア、ベルトコンベア、その他であってもよい。また、その移動方向は、テーブル上の水平面内に限定されず、上方又は横方向から見て一定の形状を維持する限りで3次元的に移動してもよい。
デジタル画像5の画素数は、任意であるが、例えば、約30万画素(横640ピクセル×縦480ピクセル)を有する。また、カメラ2は、デジタル画像4を一定の制御周期(例えば30fps:1秒間に30回)で撮影するようになっている。以下、デジタル画像を単に画像という。
ロボット3は、この例では、テーブル4の上面に固定された多間接ロボットであるが、本発明はこれに限定されず、その他のロボットであってもよい。
ワーク1の基準点は、例えば中心、図心、その他の特徴点である。またワーク1の向きは、例えばその形状の対称軸であり、その形状に応じて任意に設定する。
また、画像上のワークの大きさと、予め設定した形状との相違からワーク1とカメラ2の距離mzを算出することができる。mzはこの例ではワーク1からカメラ2までの高さであり、長さの単位(例えばmm)を有する。
なお、mx,my,mzは、同一単位に変換してもよい。
以下、検出されたワーク1の位置を(mx,my,mz)と表示する。
ここで、目標位置とはワーク1の基準点を移動させるための画像上の目標位置(mx0,my0)であり、例えば画像上の原点(0、0)である。また高さの目標位置mz0は、ワーク全体を正確に計測できる近接距離であり、例えば300mmに予め設定する。
上述したビジュアルサーボ制御は、好ましくは、デジタル画像5の取り込みと同期して同一の制御周期で行う。
ビジュアルサーボ制御の開始時(A)、すなわちS1〜S3において、ワーク1の位置(mx,my,mz)を認識すると、S4〜S6において、ワーク1を目標位置(mx0,my0,mz0)に移動するように、ロボットを設定した目標位置に目標速度で制御する(S6)。
従って、ワーク1がカメラ2の視野から外れない限り、カメラをワークの移動に追従させてワーク1を目標位置(mx0,my0,mz0)に保持することができる。
なお、例えば、画像上の目標位置(mx0,my0)は画像上の原点(0、0)であり、高さの目標位置mz0は、ワーク全体を正確に計測できる近接距離(例えば300mm)である。
検出位置から目標位置に達する時間は、制御周期に応じてできるだけ短時間(例えば1秒間=30サイクル以内)に設定するのが好ましい。
また、画像上の目標位置は、認識に失敗する直前に認識できたワーク1の最終位置(mxp,myp)に設定する。
さらに、同時に移動速度をビジュアルサーボ制御時の移動速度より大きく設定する。例えば、移動速度をビジュアルサーボ制御時の最大移動速度、又はロボットが移動可能な最大速度に設定する。
この姿勢変更(S14)は必須ではなく、これを省略してもよい。
その際、再捕捉制御において姿勢変更(S14)を実施した場合には、上述したように、カメラの姿勢を下向きに復帰する姿勢復帰処理S7をステップS2の後に実行する。
また、再捕捉制御が継続して予め設定した回数Nに達した場合は、作動を停止し(S21)、本発明による制御を終了する。また、予め設定したカメラ2の移動範囲を超えた場合にも、同様に本発明による制御を終了する。
この場合には、ロボットを停止させて、例えばアラーム等を出力するのがよい。
再捕捉制御の開始前(ワークの見失い直前)には、図4(A)に示すように、ワーク1の位置(mx,my,mz)が認識(検出)されている。また、再捕捉制御の開始後(ワークの見失い直後)には、図4(B)に示すように、ワーク1の位置は認識できないが、その直前の最終位置(mxp,myp,mzp)は記憶装置に記憶されている。
また、図4(A)から図4(B)までの時間差は、制御周期(例えば1/30秒間)であり、図4(B)においてもワーク1の位置はその直前の最終位置(mxp,myp,mzp)の近傍に存在する。
また、カメラ2の目標位置を、図5(A)に示すように、カメラとワークの距離をビジュアルサーボ制御時の近接距離(例えば300mm)より離れた離隔距離(例えば400mm)に設定することにより、焦点距離を変化させるズーム機構のないカメラ2の視野が広がり、ワーク1をさらに再補足しやすくなる。
さらに、カメラ2の移動速度をビジュアルサーボ制御時の移動速度より大きく、例えば、移動速度をビジュアルサーボ制御時の最大移動速度、又はロボットが移動可能な最大速度に設定するので、ワーク1がその最終位置(mxp,myp)から移動していても、見失ったワーク1に追いつきやすくなる。
また、カメラ2の姿勢を変更するワーク1の移動方向は、直前に認識された最終位置情報(mxp,myp)を使って求めるため、特別な計算処理は不要であり、処理時間を短くできる。
また、再捕捉制御により、ビジュアルサーボ制御中に、ワーク1がカメラ2の視野から外れた場合に、認識したワーク1の最終位置を基に、カメラ2の目標位置と移動速度を変更するので、焦点距離を変化させるズーム機構のないカメラを用いて、短時間にワーク1を再補足することができる。
3 ロボット、3a ロボットアーム、
4 テーブル、5 画像、
10 ロボット制御装置、
12 画像処理装置、
14 ロボットコントローラ
mx,my,mz 検出されたワークの位置、
mx0,my0,mz0 ワークの目標位置、
mxp,myp,mzp 認識されたワークの最終位置
Claims (3)
- ワークを撮影するカメラを有し該カメラを3次元的に移動可能なロボットを制御するロボット制御装置であって、
前記カメラで撮影した画像を画像処理する画像処理装置と、該ロボットを制御するロボットコントローラと、を備え、
ワークの位置と姿勢をカメラで計測し、計測結果に基づいてロボットをフィードバック制御し、カメラをワークの移動に追従させるビジュアルサーボ制御を実施し、
前記ビジュアルサーボ制御において、カメラとワークの距離の目標値を、ワーク全体を正確に計測できる近接距離に設定し、
前記ビジュアルサーボ制御中に、ワークがカメラの視野から外れた場合に、カメラの目標位置を前記近接距離より離れた離隔距離と認識したワークの最終位置に設定し、かつカメラの移動速度をビジュアルサーボ制御時の移動速度より大きく設定して、ワークを再捕捉する、ことを特徴とするロボット制御装置。 - ワークを撮影するカメラを有し該カメラを3次元的に移動可能なロボットを制御するロボット制御方法であって、
(A)ワークの位置と姿勢をカメラで計測し、計測結果に基づいてロボットをフィードバック制御し、カメラをワークの移動に追従させるビジュアルサーボ制御と、
(B)前記ビジュアルサーボ制御中に、ワークがカメラの視野から外れた場合に、認識したワークの最終位置を基に、カメラの目標位置と移動速度を変更してワークを再捕捉する再捕捉制御と、を有し、
前記ビジュアルサーボ制御において、カメラとワークの距離の目標値を、ワーク全体を正確に計測できる近接距離に設定し、
前記再捕捉制御において、前記目標位置を前記近接距離より離れた離隔距離とワークの最終位置に設定し、かつ前記移動速度をビジュアルサーボ制御時の移動速度より大きく設定する、ことを特徴とするロボット制御方法。 - 前記再捕捉制御において、ワークの最終位置を向くようにカメラの姿勢を変更する、ことを特徴とする請求項2に記載のロボット制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009296076A JP5448069B2 (ja) | 2009-12-25 | 2009-12-25 | ロボット制御装置及び方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009296076A JP5448069B2 (ja) | 2009-12-25 | 2009-12-25 | ロボット制御装置及び方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011136377A JP2011136377A (ja) | 2011-07-14 |
JP5448069B2 true JP5448069B2 (ja) | 2014-03-19 |
Family
ID=44348315
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009296076A Active JP5448069B2 (ja) | 2009-12-25 | 2009-12-25 | ロボット制御装置及び方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5448069B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104808590A (zh) * | 2015-02-14 | 2015-07-29 | 浙江大学 | 一种基于关键帧策略的移动机器人视觉伺服控制方法 |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013176212A1 (ja) * | 2012-05-25 | 2013-11-28 | 学校法人立命館 | ロボット制御装置、ロボット制御方法、プログラム、記録媒体、ロボットシステム |
CN102880062B (zh) * | 2012-09-04 | 2014-12-31 | 北京化工大学 | 基于非线性模型预测的智能小车2.5维视觉伺服控制方法 |
JP2014124765A (ja) * | 2012-12-27 | 2014-07-07 | Nitto Seiko Co Ltd | 自動ねじ締め装置 |
CN103963058B (zh) * | 2014-04-30 | 2016-01-06 | 重庆环视高科技有限公司 | 基于多方位视觉定位的机械手臂抓取控制系统及方法 |
JP2016013591A (ja) * | 2014-07-01 | 2016-01-28 | セイコーエプソン株式会社 | ロボットシステム |
US10354371B2 (en) * | 2016-10-06 | 2019-07-16 | General Electric Company | System, method and apparatus for locating the position of a component for use in a manufacturing operation |
JP6915288B2 (ja) | 2017-02-08 | 2021-08-04 | オムロン株式会社 | 画像処理システム、画像処理装置、FPGA(Field Programmable Gate Array)における回路の再構成方法、および、FPGAにおける回路の再構成プログラム |
CN108965690B (zh) | 2017-05-17 | 2021-02-26 | 欧姆龙株式会社 | 图像处理系统、图像处理装置及计算机可读存储介质 |
JP6734253B2 (ja) | 2017-12-20 | 2020-08-05 | ファナック株式会社 | ワークを撮像する視覚センサを備える撮像装置 |
KR102411364B1 (ko) * | 2020-06-22 | 2022-06-21 | 주식회사 대덕 | 머신비전을 이용한 지능형 로봇 제어장치 |
KR102205040B1 (ko) * | 2020-06-22 | 2021-01-19 | 주식회사 대덕알앤디 | 머신비전을 이용한 지능형 로봇 제어방법 |
CN113849000B (zh) * | 2021-09-15 | 2024-03-29 | 山东泰开智能配电有限公司 | 高压隔离开关镀银件镀层厚度自动检测系统的控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002355784A (ja) * | 2001-05-31 | 2002-12-10 | Toyota Central Res & Dev Lab Inc | ロボット装置 |
JP2003191189A (ja) * | 2001-12-21 | 2003-07-08 | Sony Corp | ロボット装置及びその制御方法 |
JP2003211382A (ja) * | 2002-01-16 | 2003-07-29 | Denso Wave Inc | ロボット制御装置 |
JP2003211381A (ja) * | 2002-01-16 | 2003-07-29 | Denso Wave Inc | ロボット制御装置 |
JP2003305675A (ja) * | 2002-04-15 | 2003-10-28 | Denso Wave Inc | 視覚認識装置 |
-
2009
- 2009-12-25 JP JP2009296076A patent/JP5448069B2/ja active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104808590A (zh) * | 2015-02-14 | 2015-07-29 | 浙江大学 | 一种基于关键帧策略的移动机器人视觉伺服控制方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2011136377A (ja) | 2011-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5448069B2 (ja) | ロボット制御装置及び方法 | |
JP5233601B2 (ja) | ロボットシステム、ロボット制御装置およびロボット制御方法 | |
JP2012528016A (ja) | 空間内において少なくとも1つのオブジェクトを最終姿勢に高精度で位置決めするための方法およびシステム | |
JP2019072792A (ja) | 作業システム、物品に対する作業実施方法、およびロボット | |
JP5509859B2 (ja) | ロボット制御装置及び方法 | |
EP3988254A1 (en) | Robot hand-eye calibration method and apparatus, computing device, medium and product | |
CN107614195B (zh) | 齿轮机构的组装装置及组装方法 | |
JP2013086184A (ja) | ワーク取出システム、ロボット装置および被加工物の製造方法 | |
JP2015185925A5 (ja) | ||
JP2015015587A5 (ja) | ||
WO2005124418A1 (ja) | 合焦情報取得装置及び合焦情報取得方法 | |
JP2008045983A (ja) | ステレオカメラの調整装置 | |
EP3345729B1 (en) | Robot system with camera | |
JP5891698B2 (ja) | ロボット | |
JP2017005400A5 (ja) | ||
US11922616B2 (en) | Alignment device | |
JP6204805B2 (ja) | 撮像装置及びその制御方法、プログラム、記憶媒体 | |
JP2020097084A (ja) | ロボットシステムとその調整方法 | |
JP5223683B2 (ja) | ワーク保持位置姿勢計測システムおよびワーク搬送システム | |
JP4647914B2 (ja) | アーク溶接方法およびアーク溶接装置 | |
JP5737584B2 (ja) | ロボットとそのワーク把持方法 | |
JPH02280920A (ja) | 折曲げ加工機の曲げ角度補正装置 | |
JP6889216B2 (ja) | 作業システム | |
JP7275688B2 (ja) | ロボットの部品ピッキングシステム | |
WO2023189077A1 (ja) | 制御装置及び撮像装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20121025 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130906 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20131105 |
|
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: 20131206 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131219 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5448069 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |