JP6823015B2 - ロボットシステム - Google Patents
ロボットシステム Download PDFInfo
- Publication number
- JP6823015B2 JP6823015B2 JP2018134393A JP2018134393A JP6823015B2 JP 6823015 B2 JP6823015 B2 JP 6823015B2 JP 2018134393 A JP2018134393 A JP 2018134393A JP 2018134393 A JP2018134393 A JP 2018134393A JP 6823015 B2 JP6823015 B2 JP 6823015B2
- Authority
- JP
- Japan
- Prior art keywords
- robot
- movement locus
- obstacle
- locus
- feature point
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/021—Optical sensing devices
- B25J19/023—Optical sensing devices including video camera means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39082—Collision, real time collision avoidance
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Multimedia (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Description
本発明は、動作範囲内に他のロボットや人が存在して協働作業を行う場合に、相互の干渉を回避しつつ、生産性を向上することができるロボットシステムを提供することを目的としている。
この構成により、障害物の移動に基づいて修正された移動軌跡は、ロボットの移動の始点および終点を変更することなく、移動する障害物とロボットとの干渉を回避することができる最適な移動軌跡となる。所定の制約条件下に移動軌跡を最適化する演算は非凸問題であり、演算時間がかかるため、リアルタイム性が低いが、ロボットを移動させる前の初期の移動軌跡の演算においては、時間を比較的長くかけることができて有効に初期の最適な移動軌跡を設定することができる。
この構成により、算出された移動軌跡に沿ってロボットを移動させることにより、減速機寿命を最大化し、あるいは、移動軌跡、消費電力、軌跡精度および振動を最小化することができる。
本実施形態に係るロボットシステム1は、図1に示されるように、ロボット2と、ロボット2を制御する制御装置3と、ロボット2の上方に配置され、ロボット2の動作範囲全体を含む領域の画像を取得するカメラ4とを備えている。
制御装置3は、図2に示されるように、カメラ4により取得された画像を処理して障害物Wを検出し、障害物Wに備わっている特徴点の位置を検出する特徴点位置検出部5と、ロボット2の動作前の状態で検出された障害物Wの特徴点の位置に基づいて初期の移動軌跡を算出する移動軌跡算出部6と、検出された特徴点の位置および算出された移動軌跡を記憶する記憶部9と、ロボット2の動作中に、時間間隔をあけて検出された障害物Wの特徴点の位置に基づいてマッピング関数を導出するマッピング関数導出部7と、導出されたマッピング関数を用いて、ロボット2の移動軌跡を動的に修正する軌跡修正部8とを備えている。制御装置3はプロセッサおよびメモリにより構成されている。
移動軌跡算出部6は、ロボット2の動作の始点および終点が与えられたときに、ロボット2の速度および加速度、ロボット2と障害物Wとの距離を制限条件として、最短となるような移動軌跡を算出する。
また、式(2)は、移動軌跡の始点x0と終点xhとを規定する制限条件である。
また、式(3)は、ロボット2の速度Vxおよび加速度Axを所定の範囲内に収めることを規定する制限条件である。
また、式(4)は、全てのqについて、移動軌跡上の点xqと障害物Wの表面Oqとの距離d(xq,Oq)が所定の閾値dmin以上であることを規定する制限条件である。
数2の右辺第1項はマッピング精度、第2項はマッピング平滑度であり、これらの和を最小にするマッピング関数fを求めている。
軌跡修正部8は、障害物Wの移動前におけるロボット2の移動軌跡をマッピング関数を用いて変換することにより、障害物Wの移動後のロボット2の移動軌跡を算出する。
本実施形態に係るロボットシステム1によれば、ロボット2を動作させる前にカメラ4により画像が取得され移動軌跡算出部6および特徴点位置検出部5に入力される。移動軌跡算出部6においては、入力された画像に加え、ロボット2の移動軌跡の始点x0と終点xhとが入力されることにより、移動軌跡算出部6により初期の移動軌跡が、数1により算出され、記憶部9に記憶される。
新たに検出された障害物Wの特徴点の位置x1′,x2′,x3′,x4′および記憶部9に記憶されている1つ前の画像における障害物Wの特徴点の位置x1,x2,x3,x4はマッピング関数導出部7に入力され、位置x1,x2,x3,x4から位置x1′,x2′,x3′,x4′への変換関数であるマッピング関数fが数2により算出される。
マッピング関数fの算出およびマッピング関数fによる移動軌跡の修正は、短い計算時間で行うことができ、サイクルタイムに影響を与えることなくリアルタイムに実行することができる。また、動作中の移動軌跡の修正は、最初に最適化された初期の移動軌跡を修正する形で行われ、その後の修正も1つ前に生成された移動軌跡を元に行われるので、修正後の移動軌跡が最適化された移動軌跡に近似し、生産性を向上することができるという利点がある。
2 ロボット
5 特徴点位置検出部
6 移動軌跡算出部
7 マッピング関数導出部
8 軌跡修正部
f マッピング関数
x1,x2,x3,x4,x1′,x2′,x3′,x4′ 特徴点の位置
x0 始点
xh 終点
W 障害物
Claims (3)
- ロボットの動作範囲内において移動または変形する障害物の特徴点の位置を一定周期毎に検出する特徴点位置検出部と、
前記ロボットの動作前に、該ロボットの移動軌跡を算出する移動軌跡算出部と、
該移動軌跡算出部により算出された前記移動軌跡に沿って前記ロボットを動作させる制御装置と、
前記ロボットが動作する間に、時間間隔をあけて検出された前記特徴点の位置に基づいて、移動または変形前の前記障害物の特徴点の位置を移動または変形後の前記障害物の特徴点の位置にマッピングするマッピング関数を導出するマッピング関数導出部と、
導出された前記マッピング関数を用いて、前記ロボットの前記移動軌跡を動的に修正する軌跡修正部とを備え、
前記制御装置が、前記軌跡修正部によって前記移動軌跡が修正された場合に、修正後の前記移動軌跡に沿って前記ロボットを動作させるロボットシステム。 - 前記移動軌跡算出部が、前記ロボットの移動の始点および終点と、前記ロボットと前記障害物との距離とを制限条件として最適化された前記移動軌跡を算出する請求項1に記載のロボットシステム。
- 前記移動軌跡算出部が、前記ロボットの減速機寿命の最大化、移動軌跡、消費電力、軌跡精度あるいは振動の最小化の少なくとも1つを達成する前記移動軌跡を算出する請求項2に記載のロボットシステム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018134393A JP6823015B2 (ja) | 2018-07-17 | 2018-07-17 | ロボットシステム |
US16/503,865 US12030187B2 (en) | 2018-07-17 | 2019-07-05 | Robot system |
DE102019118202.6A DE102019118202B4 (de) | 2018-07-17 | 2019-07-05 | Robotersystem |
CN201910628389.7A CN110722550B (zh) | 2018-07-17 | 2019-07-12 | 机器人系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018134393A JP6823015B2 (ja) | 2018-07-17 | 2018-07-17 | ロボットシステム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020011326A JP2020011326A (ja) | 2020-01-23 |
JP6823015B2 true JP6823015B2 (ja) | 2021-01-27 |
Family
ID=69148430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018134393A Active JP6823015B2 (ja) | 2018-07-17 | 2018-07-17 | ロボットシステム |
Country Status (4)
Country | Link |
---|---|
US (1) | US12030187B2 (ja) |
JP (1) | JP6823015B2 (ja) |
CN (1) | CN110722550B (ja) |
DE (1) | DE102019118202B4 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113361739B (zh) * | 2020-03-06 | 2024-04-12 | 北京京东振世信息技术有限公司 | 一种生成拣货路径的方法和装置 |
US11707843B2 (en) * | 2020-04-03 | 2023-07-25 | Fanuc Corporation | Initial reference generation for robot optimization motion planning |
US11699239B2 (en) | 2020-04-21 | 2023-07-11 | The Board of Trustees of the University of Illinois (Urbana, IL) | Image processing method and apparatus |
WO2022009333A1 (ja) | 2020-07-08 | 2022-01-13 | 三菱電機株式会社 | ロボット制御装置、ロボット制御方法、およびロボット制御プログラム |
JP7553077B2 (ja) | 2020-08-27 | 2024-09-18 | 株式会社イシダ | 物品搬送装置の制御方法及び物品搬送装置 |
JP7567381B2 (ja) | 2020-11-11 | 2024-10-16 | 富士通株式会社 | 動作制御プログラム、動作制御方法、および動作制御装置 |
Family Cites Families (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07271415A (ja) | 1994-03-30 | 1995-10-20 | Nec Corp | 協調ロボット制御方法 |
US20040138780A1 (en) | 2002-11-15 | 2004-07-15 | Lewis Murray Anthony | Certain principles of biomorphic robots |
US9104197B2 (en) | 2004-06-15 | 2015-08-11 | Abb Ab | Method and system for off-line programming of multiple interacting robots |
US9390203B2 (en) | 2004-06-15 | 2016-07-12 | Abb Ab | Method and system for off-line programming of multiple interacting robots |
JP4348276B2 (ja) | 2004-11-02 | 2009-10-21 | 本田技研工業株式会社 | ロボット制御装置 |
JP4159577B2 (ja) * | 2005-12-13 | 2008-10-01 | ファナック株式会社 | 複数のロボット間のインターロック自動設定装置及び自動設定方法 |
JP4853068B2 (ja) | 2006-03-23 | 2012-01-11 | 日産自動車株式会社 | 車両用支援制御装置 |
JP4576445B2 (ja) * | 2007-04-12 | 2010-11-10 | パナソニック株式会社 | 自律移動型装置および自律移動型装置用プログラム |
US9144904B2 (en) | 2008-05-21 | 2015-09-29 | Fanuc Robotics America Corporation | Method and system for automatically preventing deadlock in multi-robot systems |
US8315738B2 (en) | 2008-05-21 | 2012-11-20 | Fanuc Robotics America, Inc. | Multi-arm robot system interference check via three dimensional automatic zones |
KR101503903B1 (ko) * | 2008-09-16 | 2015-03-19 | 삼성전자 주식회사 | 이동 로봇의 지도 구성 장치 및 방법 |
JP2010142910A (ja) | 2008-12-19 | 2010-07-01 | Yaskawa Electric Corp | ロボットシステム |
DE102010007458A1 (de) | 2010-02-10 | 2011-08-11 | KUKA Laboratories GmbH, 86165 | Verfahren für eine kollisionsfreie Bahnplanung eines Industrieroboters |
CN102792238A (zh) | 2010-03-08 | 2012-11-21 | 三菱电机株式会社 | 数控装置及数控装置的控制方法 |
JP5518579B2 (ja) | 2010-06-02 | 2014-06-11 | 本田技研工業株式会社 | 移動可能領域抽出装置および移動可能領域抽出方法 |
JP5615160B2 (ja) * | 2010-12-21 | 2014-10-29 | トヨタ自動車株式会社 | 移動体 |
JP5981215B2 (ja) | 2011-05-05 | 2016-08-31 | ファナック アメリカ コーポレイション | マルチロボットシステムのデッドロックを自動的に防止する方法及びシステム |
JP5776324B2 (ja) | 2011-05-17 | 2015-09-09 | 富士通株式会社 | 地図処理方法及びプログラム、並びにロボットシステム |
JP2013086234A (ja) | 2011-10-20 | 2013-05-13 | Panasonic Corp | 目的方向通知システム、目的方向通知方法、及び、目的方向通知プログラム |
JP5724919B2 (ja) | 2012-03-22 | 2015-05-27 | トヨタ自動車株式会社 | 軌道生成装置、移動体、軌道生成方法及びプログラム |
JP2014024162A (ja) | 2012-07-27 | 2014-02-06 | Seiko Epson Corp | ロボットシステム、ロボット制御装置、ロボット制御方法及びロボット制御プログラム |
JP5886502B2 (ja) | 2012-12-20 | 2016-03-16 | トヨタ自動車株式会社 | 移動体制御装置、移動体制御方法及び制御プログラム |
JP6282140B2 (ja) | 2014-02-26 | 2018-02-21 | キヤノン株式会社 | 軌道生成方法、ロボット装置、プログラム及び記録媒体 |
ES2773136T3 (es) | 2014-06-05 | 2020-07-09 | Softbank Robotics Europe | Robot humanoide con capacidades para evitar colisiones y de recuperación de trayectoria |
JP6576255B2 (ja) | 2016-01-25 | 2019-09-18 | キヤノン株式会社 | ロボット軌道生成方法、ロボット軌道生成装置、および製造方法 |
JP6514156B2 (ja) | 2016-08-17 | 2019-05-15 | ファナック株式会社 | ロボット制御装置 |
CN106325280B (zh) | 2016-10-20 | 2019-05-31 | 上海物景智能科技有限公司 | 一种多机器人防碰撞方法及系统 |
JP6879736B2 (ja) * | 2016-12-28 | 2021-06-02 | 川崎重工業株式会社 | ロボットシステム |
US10919153B2 (en) * | 2017-03-06 | 2021-02-16 | Canon Kabushiki Kaisha | Teaching method for teaching operations to a plurality of robots and teaching system used therefor |
CN107139171B (zh) | 2017-05-09 | 2019-10-22 | 浙江工业大学 | 一种基于力矩控制的工业机器人避障轨迹规划方法 |
CN110914024B (zh) * | 2017-07-05 | 2023-05-19 | 欧姆龙株式会社 | 路径输出方法、路径输出系统和路径输出程序 |
CN108255173A (zh) | 2017-12-20 | 2018-07-06 | 北京理工大学 | 机器人跟随避障方法及装置 |
-
2018
- 2018-07-17 JP JP2018134393A patent/JP6823015B2/ja active Active
-
2019
- 2019-07-05 DE DE102019118202.6A patent/DE102019118202B4/de active Active
- 2019-07-05 US US16/503,865 patent/US12030187B2/en active Active
- 2019-07-12 CN CN201910628389.7A patent/CN110722550B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110722550B (zh) | 2024-10-11 |
CN110722550A (zh) | 2020-01-24 |
JP2020011326A (ja) | 2020-01-23 |
US12030187B2 (en) | 2024-07-09 |
US20200023518A1 (en) | 2020-01-23 |
DE102019118202A1 (de) | 2020-01-23 |
DE102019118202B4 (de) | 2022-11-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6823015B2 (ja) | ロボットシステム | |
JP6333795B2 (ja) | 学習による教示作業の簡易化及び動作性能向上機能を備えたロボットシステム | |
JP5233601B2 (ja) | ロボットシステム、ロボット制御装置およびロボット制御方法 | |
JP6912415B2 (ja) | ハンド制御装置およびハンド制御システム | |
JP5523386B2 (ja) | 衝突回避装置 | |
JP2019188580A (ja) | 情報処理装置、制御方法、ロボットシステム、コンピュータプログラム、及び記憶媒体 | |
US7987021B2 (en) | Environment map generating method and mobile robot | |
JP6700669B2 (ja) | 制御方法、ロボット装置、プログラム、記録媒体、及び物品の製造方法 | |
JP2010120139A (ja) | 産業用ロボットの安全制御装置 | |
CN110065067A (zh) | 运动轨迹生成设备 | |
JP4665857B2 (ja) | アームを誘導可能な移動体およびアームを誘導する方法 | |
JP6317618B2 (ja) | 情報処理装置およびその方法、計測装置、並びに、作業装置 | |
US11331799B1 (en) | Determining final grasp pose of robot end effector after traversing to pre-grasp pose | |
JP6836544B2 (ja) | 制御システムおよび被駆動体の制御方法 | |
JP2018027580A (ja) | ロボット制御装置 | |
JP2008142841A (ja) | 移動ロボット | |
JP6489894B2 (ja) | 対象物の取出経路を補正する機能を有するロボットシステム | |
CN110303474B (zh) | 使用图像处理修正机器人的示教的机器人系统 | |
WO2020179416A1 (ja) | ロボット制御装置、ロボット制御方法、及びロボット制御プログラム | |
JP6420404B1 (ja) | 物体認識装置 | |
CN109542094A (zh) | 无期望图像的移动机器人视觉镇定控制 | |
WO2020255229A1 (ja) | 計測装置、計測方法、及び計測プログラム | |
JP2014144516A (ja) | ロボット制御装置、ロボットシステム、ロボット、制御方法及びプログラム | |
US20240342918A1 (en) | Robot control device, robot control system, and robot control method | |
JP2010238217A (ja) | 移動ロボットの自己位置同定方法及び移動ロボット |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20191209 |
|
A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20200325 |
|
A975 | Report on accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A971005 Effective date: 20200423 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20200707 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20200721 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200911 |
|
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: 20201208 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210107 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6823015 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |