JP2020011326A - ロボットシステム - Google Patents
ロボットシステム Download PDFInfo
- Publication number
- JP2020011326A JP2020011326A JP2018134393A JP2018134393A JP2020011326A JP 2020011326 A JP2020011326 A JP 2020011326A JP 2018134393 A JP2018134393 A JP 2018134393A JP 2018134393 A JP2018134393 A JP 2018134393A JP 2020011326 A JP2020011326 A JP 2020011326A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- mapping function
- trajectory
- movement trajectory
- obstacle
- 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.)
- Granted
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)
Abstract
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 | ロボットシステム |
DE102019118202.6A DE102019118202B4 (de) | 2018-07-17 | 2019-07-05 | Robotersystem |
US16/503,865 US12030187B2 (en) | 2018-07-17 | 2019-07-05 | Robot system |
CN201910628389.7A CN110722550A (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 true JP2020011326A (ja) | 2020-01-23 |
JP6823015B2 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) | CN110722550A (ja) |
DE (1) | DE102019118202B4 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3961331A1 (en) | 2020-08-27 | 2022-03-02 | ISHIDA CO., Ltd. | Article conveyance apparatus and method of controlling the same |
US11699239B2 (en) | 2020-04-21 | 2023-07-11 | The Board of Trustees of the University of Illinois (Urbana, IL) | Image processing method and apparatus |
Families Citing this family (2)
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 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007164417A (ja) * | 2005-12-13 | 2007-06-28 | Fanuc Ltd | 複数のロボット間のインターロック自動設定装置及び自動設定方法 |
JP2012130986A (ja) * | 2010-12-21 | 2012-07-12 | Toyota Motor Corp | 移動体 |
JP2017131973A (ja) * | 2016-01-25 | 2017-08-03 | キヤノン株式会社 | ロボット軌道生成方法、およびロボット軌道生成装置 |
JP2018103345A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボットシステム |
Family Cites Families (28)
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 |
US9390203B2 (en) | 2004-06-15 | 2016-07-12 | Abb Ab | Method and system for off-line programming of multiple interacting robots |
EP1756684B1 (en) | 2004-06-15 | 2008-04-16 | Abb Ab | Method and system for off-line programming of multiple interacting robots |
JP4348276B2 (ja) | 2004-11-02 | 2009-10-21 | 本田技研工業株式会社 | ロボット制御装置 |
JP4853068B2 (ja) | 2006-03-23 | 2012-01-11 | 日産自動車株式会社 | 車両用支援制御装置 |
JP4576445B2 (ja) * | 2007-04-12 | 2010-11-10 | パナソニック株式会社 | 自律移動型装置および自律移動型装置用プログラム |
US8315738B2 (en) | 2008-05-21 | 2012-11-20 | Fanuc Robotics America, Inc. | Multi-arm robot system interference check via three dimensional automatic zones |
US9144904B2 (en) | 2008-05-21 | 2015-09-29 | Fanuc Robotics America Corporation | Method and system for automatically preventing deadlock in multi-robot systems |
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 |
WO2011111088A1 (ja) | 2010-03-08 | 2011-09-15 | 三菱電機株式会社 | 数値制御装置及び数値制御装置の制御方法 |
JP5518579B2 (ja) | 2010-06-02 | 2014-06-11 | 本田技研工業株式会社 | 移動可能領域抽出装置および移動可能領域抽出方法 |
DE102012103830B4 (de) | 2011-05-05 | 2022-05-25 | Fanuc Robotics America Corp. | Verfahren und computerlesbare Medien zur automatischen Verbindung von gegenseitiger Blockierung in Mehrfachrobotersytemen |
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 |
JP6514156B2 (ja) | 2016-08-17 | 2019-05-15 | ファナック株式会社 | ロボット制御装置 |
CN106325280B (zh) | 2016-10-20 | 2019-05-31 | 上海物景智能科技有限公司 | 一种多机器人防碰撞方法及*** |
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 | 浙江工业大学 | 一种基于力矩控制的工业机器人避障轨迹规划方法 |
US20200139545A1 (en) * | 2017-07-05 | 2020-05-07 | Omron Corporation | Route Outputting Method, Route Outputting System and Route Outputting Program |
CN108255173A (zh) | 2017-12-20 | 2018-07-06 | 北京理工大学 | 机器人跟随避障方法及装置 |
-
2018
- 2018-07-17 JP JP2018134393A patent/JP6823015B2/ja active Active
-
2019
- 2019-07-05 US US16/503,865 patent/US12030187B2/en active Active
- 2019-07-05 DE DE102019118202.6A patent/DE102019118202B4/de active Active
- 2019-07-12 CN CN201910628389.7A patent/CN110722550A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007164417A (ja) * | 2005-12-13 | 2007-06-28 | Fanuc Ltd | 複数のロボット間のインターロック自動設定装置及び自動設定方法 |
JP2012130986A (ja) * | 2010-12-21 | 2012-07-12 | Toyota Motor Corp | 移動体 |
JP2017131973A (ja) * | 2016-01-25 | 2017-08-03 | キヤノン株式会社 | ロボット軌道生成方法、およびロボット軌道生成装置 |
JP2018103345A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボットシステム |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11699239B2 (en) | 2020-04-21 | 2023-07-11 | The Board of Trustees of the University of Illinois (Urbana, IL) | Image processing method and apparatus |
EP3961331A1 (en) | 2020-08-27 | 2022-03-02 | ISHIDA CO., Ltd. | Article conveyance apparatus and method of controlling the same |
US11643280B2 (en) | 2020-08-27 | 2023-05-09 | Ishida Co., Ltd. | Article conveyance apparatus and method of controlling the same |
Also Published As
Publication number | Publication date |
---|---|
DE102019118202B4 (de) | 2022-11-03 |
JP6823015B2 (ja) | 2021-01-27 |
CN110722550A (zh) | 2020-01-24 |
US20200023518A1 (en) | 2020-01-23 |
US12030187B2 (en) | 2024-07-09 |
DE102019118202A1 (de) | 2020-01-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2020011326A (ja) | ロボットシステム | |
CN107901041A (zh) | 一种基于图像混合矩的机器人视觉伺服控制方法 | |
CN110065067A (zh) | 运动轨迹生成设备 | |
JP7111114B2 (ja) | 情報処理装置、情報処理方法及び情報処理システム | |
CN109421047B (zh) | 机器人*** | |
JP2010120139A (ja) | 産業用ロボットの安全制御装置 | |
US11331799B1 (en) | Determining final grasp pose of robot end effector after traversing to pre-grasp pose | |
JP6317618B2 (ja) | 情報処理装置およびその方法、計測装置、並びに、作業装置 | |
EP3988254A1 (en) | Robot hand-eye calibration method and apparatus, computing device, medium and product | |
JP6836544B2 (ja) | 制御システムおよび被駆動体の制御方法 | |
JP2008142841A (ja) | 移動ロボット | |
JP2018027580A (ja) | ロボット制御装置 | |
JP6564433B2 (ja) | ロボットシステム | |
KR20190079322A (ko) | 로봇 제어 시스템 | |
JP2020028957A (ja) | 干渉回避装置およびロボットシステム | |
KR20090126414A (ko) | 로봇 및 그 경로생성방법 | |
JP2008183690A (ja) | ロボット制御装置及びロボット制御システム | |
JP2012128585A (ja) | 移動装置およびロボットならびにこれらの制御システム | |
JP2018012159A (ja) | ロボットシステム、ロボットシステムの制御方法、プログラム | |
JP6420404B1 (ja) | 物体認識装置 | |
JP2010238217A (ja) | 移動ロボットの自己位置同定方法及び移動ロボット | |
JP6260509B2 (ja) | ロボット | |
JP7134413B2 (ja) | 計測装置、計測方法、及び計測プログラム | |
JP5057224B2 (ja) | 移動ロボット制御装置 | |
KR102288886B1 (ko) | 착용식 로봇의 구동 제어 방법 및 시스템 |
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 |