JP2023075882A - 多軸ロボットアームのスマート障害物回避方法 - Google Patents

多軸ロボットアームのスマート障害物回避方法 Download PDF

Info

Publication number
JP2023075882A
JP2023075882A JP2022005352A JP2022005352A JP2023075882A JP 2023075882 A JP2023075882 A JP 2023075882A JP 2022005352 A JP2022005352 A JP 2022005352A JP 2022005352 A JP2022005352 A JP 2022005352A JP 2023075882 A JP2023075882 A JP 2023075882A
Authority
JP
Japan
Prior art keywords
robot arm
obstacle avoidance
axis
posture
smart
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.)
Pending
Application number
JP2022005352A
Other languages
English (en)
Inventor
林栢廷
Po Ting Lin
林士偉
Shih-Wei Lin
黎昆政
kun-cheng Li
楊長運
Chang-Yun Yang
呉佩芬
Pei-Fen Wu
藍順謙
Shun-Chien Lan
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Cheng Uei Precision Industry Co Ltd
Original Assignee
Cheng Uei Precision Industry Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Cheng Uei Precision Industry Co Ltd filed Critical Cheng Uei Precision Industry Co Ltd
Publication of JP2023075882A publication Critical patent/JP2023075882A/ja
Pending legal-status Critical Current

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
    • B25J13/089—Determining the position of the robot with reference to its environment
    • 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/06—Programme-controlled manipulators characterised by multi-articulated arms
    • 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/1651—Programme controls characterised by the control loop acceleration, rate control
    • 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/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • 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
    • 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/39091—Avoid collision with moving obstacles

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

【課題】多軸ロボットアームのスマート障害物回避方法を提供する。【解決手段】本発明に係る多軸ロボットアームのスマート障害物回避方法は、特に障害物回避方法を指し、データベースの作成工程と、障害物回避姿勢を探す工程と、パラメータ設定工程と、最適な障害物回避姿勢を探す工程と、を含む。本発明は予め作成したデータベースにより、ロボットアームがタスクを実行する際に衝突が発生するかどうか評価し、衝突が発生すると評価した場合、障害物回避動作を実行して障害物を回避する。パラメータの設定により、障害物回避姿勢を最適な方式で実行し、全体的な効率を高めている。【選択図】図１

Description

本発明は、オートメーション機器の分野に関し、より詳しくは、多軸ロボットアームを使用して多種類の障害物を回避する方法において、最適な方法を選択する障害物回避方法に関する。
オートメーション技術の発展により、各業界でロボットアームにより工場の生産効率を向上する割合が増加している。但し、ロボットアームの動作中に、突発的な状況や他の要因により、ロボットアームの作業範囲内に人や他の障害物が存在する場合、衝突して人を怪我させること、またロボットアームや他の物品が衝突により損壊するのを回避するため、接触式及び非接触式の衝突防止技術がある。
接触式では、抵抗力及びモーターの動作電流を利用して制限する。ロボットアームが抵抗を受けて動作電流が制限を超えた場合、ロボットアームの動作を停止する。或いは、ロボットアームに圧力センサーを設置し、ロボットアームが障害物に衝突した場合、圧力センサーが信号を発し、ロボットアームの動作を停止する。
非接触式では、従来の特許文献では、例えば、下記特許文献１の「ロボットアーム障害物回避方法とロボットアーム障害物回避システム」という記載がある。前記発明は予め作成したデータベースにより、ロボットアームがタスクを実行する際に、衝突が発生するかどうか評価し、衝突が発生すると評価した場合、前記障害物回避姿勢を探す工程を実行して障害物を回避する。
台湾特許出願公開第１１０１３１９１５号明細書
接触式では障害物にぶつかった後に動作を停止するが、停止する前に作業員が怪我してしまう、またロボットアームや製品が損傷してしまう場合がある。非接触式では、障害物の回避において、障害物を回避可能な多くの路線があるため、選択した路線が最適解ではなく、時間を浪費し、理想的ではない方式を実行することがあった。
そこで、本発明者は上記の欠点が改善可能と考え、鋭意検討を重ねた結果、合理的設計で上記の課題を効果的に改善する本発明の提案に至った。
本発明はこうした状況に鑑みてなされたものであり、その目的は、非接触式でロボットアームの障害物回避効率を高め、または理想な方式で動作を実行する方法を提供することにある。
上記課題を解決するために、本発明のある態様の多軸ロボットアームのスマート障害物回避方法は、特に障害物回避方法を指し、
多軸ロボットアームの作業姿勢及び制御変量等のデータを含むデータベースの作成工程Ａと、
工程Ａの前記データベースに基づいて実行可能な複数の障害物回避姿勢を算出し、この工程の後に工程Ｄを実行する障害物回避姿勢を探す工程Ｂと、
各軸制御ロボットアームの動作の関連パラメータを設定し、この工程の後に工程Ｂと共に工程Ｄを実行するパラメータ設定工程Ｃと、
工程Ｂで算出した複数の前記障害物回避路線に基づいて、且つ前記パラメータ設定中の各軸制御ロボットアームの動作のパラメータにより、前記最適な障害物回避姿勢を算出する最適な障害物回避姿勢を探す工程Ｄと、を含む。
このように、本発明によれば、次のような効果がある。
ロボットアームに採用する姿勢を予めデータベースに保存し、ロボットアームの動作時に運動中に衝突が発生するかどうか高速に評価し、衝突が発生すると評価した場合、各障害物の回避姿勢を判断し、且つ最適な障害物回避姿勢により最も理想的な方式で障害物を回避する。
本発明の他の特徴については、本明細書及び添付図面の記載により明らかにする。
本発明の一実施形態に係る多軸ロボットアームのスマート障害物回避方法を示したフローチャートである。 本発明の一実施形態に係る８軸ロボットアームが移動経路に沿って移動し、障害物に遭遇する概略図である。 本発明の障害物回避システムが障害物を回避する経路ように８軸ロボットアームを計算する概略図である。 本発明の一実施形態に係る８軸ロボットアームが障害物を回避するように制御伸縮シャフトを制御することを選択する概略図である。 本発明の一実施形態に係る８軸ロボットアームが障害物を回避するように他の回転軸を制御することを選択する概略図である。
以下、図面を参照しつつ、本発明に係る多軸ロボットアームのスマート障害物回避方法について具体的に説明する。
本発明に係る多軸ロボットアームのスマート障害物回避方法は自由度が高い多軸ロボットアーム、及び多軸ロボットアームに電気的に接続されているホストコンピューターに適用する。本実施例では、ロボットアームはベースに固定され、ロボットアームは複数の関節及び異なる関節にそれぞれ連結されている複数の接続アームを備えている。ホストコンピューターは互いに電気的に接続されているデータベース（ｄａｔａｂａｓｅ）、演算制御モジュール、信号受信モジュール等の部材を含み、前記演算制御モジュールはプロセッサ（ｐｒｏｃｅｓｓｏｒ）を備え、前記受信モジュールは受信機（ｒｅｃｅｉｖｅｒ）及び発信機（ｅｍｉｔｔｅｒ）を備えている。実際の応用では、ホストコンピューターはロボットアーム制御器（Ｒｏｂｏｔ Ｃｏｎｔｒｏｌｌｅｒ）、サーバー（ｓｅｖｅｒ）、デスクトップパソコン（ｄｅｓｋ ｃｏｍｐｕｔｅｒ）、またはノートバソコン（ｌａｐｔｏｐ）等でもよい。ホストコンピューター及びロボットアームの電気的接続方式は、信号受信モジュールによる信号ワイヤレス伝送方式に限らず、信号有線伝送方式でもよい。
本発明に係る多軸ロボットアームのスマート障害物回避方法は下記工程Ｓ１０１～工程Ｓ１０４を少なくとも含む。
＜データベースの作成工程Ｓ１０（図１参照）＞
ロボットアームモデルを過酷な条件でモデル化し、ロボットアームと障害物との間に十分な緩衝空間を有するようにする。ロボットアームは各作業範囲内に各種の作業姿勢を有し、これらをサンプリング点として標記する。各サンプリング点には各自の評価座標を有し、複数の評価座標により評価座標とロボットアームの作業姿勢との相対関係を構築する。移動経路上でのロボットアームの作業姿勢の制御変量を取得し、この制御変量は制御器により直接設定するか、既知の作業姿勢から、逆運動学に基づいて各軸がそれぞれ対応する制御変量を算出する。ロボットアームの作業範囲内の空間の座標を部分的に前記ロボットアームが占領するかどうか判断し、占領されると判断した場合は障害物に接触することを示し、反対であれば、障害物に接触しないことを示す。以上のデータを予め作成し、後続の障害物の回避に使用する。
＜障害物回避姿勢を探す工程Ｓ１０２（図１参照）＞
下記方程式に基づく。
Ｍｉｎ（Ｘｉ ｎｅｗ－Ｘｉ）２ｓ．ｔ．Ｏ（Ｘｉ ｎｅｗ）≦ＯＴ...（１）
障害物回避姿勢を取得し、Ｘｉ ｎｅｗは障害物回避姿勢が対応する制御変量であり、制御変量Ｘｉは、例えば、各関節が各モーターにより制御される改変量でもよく、ＯＴは障害物に接触するかどうかを評価するための閾値でもよい。ＯＴ値が小さいほど、ロボットアームと障害物との間の距離が離れており、ロボットアームが障害物に接触する確率が低くなる。最小制御変量Ｘｉの改変量及び閾値ＯＴの大きさにより、ロボットアームが障害物を回避する姿勢を推定する。
＜パラメータ設定工程Ｓ１０（図１を参照）＞
各軸制御ロボットアームの動作のパラメータを順番に設定する。設定するパラメータは、例えば、各軸モーターの回転速度、減速機の減速比、速度％、加減速の時間等であり、これらのパラメータ設定により、各軸の動作に必要な時間を取得する。
＜最適な障害物回避姿勢を探す工程Ｓ１０４（図１を参照）＞
前述の障害物回避姿勢に基づいて、複数の実行可能な障害物回避路線を取得し、パラメータ設定により各軸の運転速度を取得し、各障害物回避路線の動作に必要な時間を割り出し、最短時間の障害物回避路線を最適な障害物回避姿勢とする。
一例を挙げると、八軸ロボットアームが特定の経路に沿ってタスクを実行し、例えば、２点でピックアンドプレース作業を行う際に、経路の途中で突然障害物ａが侵入した場合（図２参照）、障害物回避システムを起動し、幾つかの実行可能な障害物回避路線を計算し（図３参照）、パラメータ設定により伸縮軸の動作時に、タスク実行にかかる時間が他の軸より長いことが分かったら（図４を参照）、伸縮軸を固定することを選択し、他の軸は角度変化が最小の経路を選択し（図５を参照）、ロボットアームが最適な障害物回避経路で障害物の回避タスクを完遂するようにする。
本発明はロボットアームをタスク実行中に、障害物に接触してタスクが中断することがなくなるのみならず、パラメータの設定により、障害物回避経路及び姿勢がより最適化され、タスクを高速に達成可能になる。
以上を総合すると、本発明に係る多軸ロボットアームのスマート障害物回避方法は、本発明の目的を確実に達成する。
本発明が掲示する技術内容は上述の実施例に限られず、本発明が掲示する発明の概念及び原則と同じであるものは全て本発明の特許請求の範囲に含まれる。ちなみに、部材の定義は、例えば、「第一」及び「第二」は限定するための用語ではなく、区別するための用語である。本願に用いる「含む」または「備える」は、「包括する」及び「有する」という概念を含み、部材、操作工程及び／または組或いは上述の組み合せを示すものであり、排除または増加を示すものではない。また、特に説明がない限り、操作工程の順序は絶対的な順序ではない。なお、特に説明のない限り、単数形式で部材に言及していても（例えば、冠詞の「一」または「１つ」を使用する）、「１つ且つ１つのみ」を意味するものではなく、「１つまたは複数」を意味するものである。本願に使用する「及び／または」とは、「及び」或いは「または」、及び「及び」並びに「または」を意味する。本願に使用する範囲に関連した用語は全ての範囲及び／または限定した範囲を含み、例えば、「少なくとも」、 「超」、「未満」、「超ではない」等は、範囲の上限または下限を示す。
本発明は上述した各実施形態に限定されるものではなく、請求項に示した範囲で種々の変更が可能であり、異なる実施形態にそれぞれ開示された技術的手段を適宜組み合わせて得られる実施形態についても本発明の技術的範囲に含まれる。
Ｓ１０１ データベースの作成
Ｓ１０２ 障害物回避姿勢を探す
Ｓ１０３ パラメータ設定
Ｓ１０４ 最適な障害物回避姿勢を探す
ａ 障害物
ｂ 障害物回避経路ｂ
ｃ 障害物回避経路ｃ

Claims (5)

  1. 特に障害物回避方法を指す多軸ロボットアームのスマート障害物回避方法であって、
    多軸ロボットアームの作業姿勢及び制御変量等のデータを含むデータベースの作成工程Ａと、
    工程Ａの前記データベースに基づいて実行可能な複数の障害物回避姿勢を算出し、この工程の後に工程Ｄを実行する障害物回避姿勢を探す工程Ｂと、
    各軸制御ロボットアームの動作の関連パラメータを設定し、この工程の後に工程Ｂと共に工程Ｄを実行するパラメータ設定工程Ｃと、
    工程Ｂで算出した複数の前記障害物回避路線に基づいて、且つ前記パラメータ設定中の各軸制御ロボットアームの動作のパラメータにより、前記最適な障害物回避姿勢を算出する最適な障害物回避姿勢を探す工程Ｄと、を含むことを特徴とする多軸ロボットアームのスマート障害物回避方法。
  2. 各作業範囲内でのロボットアームの異なる前記作業姿勢をサンプリング点として標記し、各サンプリング点が全て各自の評価座標を有し、複数の評価座標により、評価座標とロボットアームの前記作業姿勢との相対関係を構築することを特徴とする請求項１に記載の多軸ロボットアームのスマート障害物回避方法。
  3. 工程Ａにおいて、前記制御変量は制御器により直接設定するか、または既知の前記作業姿勢から、逆運動学に基づいて各軸がそれぞれ対応する制御変量を算出することを特徴とする請求項１に記載の多軸ロボットアームのスマート障害物回避方法。
  4. 工程Ｃのパラメータ設定において、ロボットアームの各軸モーターの回転速度、減速機の減速比、速度％、及び加減速の時間等のパラメータ設定を含むことを特徴とする請求項１に記載の多軸ロボットアームのスマート障害物回避方法。
  5. 前記最適な障害物回避姿勢は動作時間が最少となる障害物回避姿勢であることを特徴とする請求項１に記載の多軸ロボットアームのスマート障害物回避方法。
JP2022005352A 2021-11-19 2022-01-17 多軸ロボットアームのスマート障害物回避方法 Pending JP2023075882A (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
TW110143284 2021-11-19
TW110143284A TW202321002A (zh) 2021-11-19 2021-11-19 多軸機械手臂智慧避障方法

Publications (1)

Publication Number Publication Date
JP2023075882A true JP2023075882A (ja) 2023-05-31

Family

ID=86384966

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022005352A Pending JP2023075882A (ja) 2021-11-19 2022-01-17 多軸ロボットアームのスマート障害物回避方法

Country Status (3)

Country Link
US (1) US20230158671A1 (ja)
JP (1) JP2023075882A (ja)
TW (1) TW202321002A (ja)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63150183A (ja) * 1986-12-15 1988-06-22 富士通株式会社 ロボツトの運動制御方法
JP2015160277A (ja) * 2014-02-27 2015-09-07 ファナック株式会社 ロボットの動作経路を生成するロボットシミュレーション装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63150183A (ja) * 1986-12-15 1988-06-22 富士通株式会社 ロボツトの運動制御方法
JP2015160277A (ja) * 2014-02-27 2015-09-07 ファナック株式会社 ロボットの動作経路を生成するロボットシミュレーション装置

Also Published As

Publication number Publication date
US20230158671A1 (en) 2023-05-25
TW202321002A (zh) 2023-06-01

Similar Documents

Publication Publication Date Title
KR101818858B1 (ko) 수동 안내-작동모드로의 로봇의 제어기의 전환
JP6364096B2 (ja) ロボットシステム
CN107116553B (zh) 一种机械臂的操作方法及装置
CN108638055B (zh) 一种七自由度空间机械臂自主避障规划方法
JP5261495B2 (ja) 重み行列を用いたリアルタイム自己衝突および障害物回避
JP2019098410A (ja) ロボットの速度を制限する制御装置
US10105842B2 (en) Operation program creating method and control method of robot
CN108803592B (zh) 用于避免机器人碰撞的方法、装置和系统
JP2023075882A (ja) 多軸ロボットアームのスマート障害物回避方法
US10717192B2 (en) Robot motion program generating apparatus
CN111496798A (zh) 机器人传送带跟踪方法、设备及存储装置
CN111026033B (zh) 圆弧加工装置及应用其的圆弧加工方法
JP5195181B2 (ja) 工作機械のｎｃデータ作成装置
CN113084797B (zh) 一种基于任务分解的双臂冗余机械臂动态协同控制方法
US20240083031A1 (en) Method of Controlling Mechanical Impedance of Robot, Control System and Robot
CN114074323B (zh) 一种确保机器人速度和动量边界限制的安全系统
CN116160437A (zh) 多轴机械手臂智能避障方法
Somasundar et al. Singularity analysis of Kuka 6 DOF robot for motion simulation
CN113021345A (zh) 机械臂逆运动学控制方法、装置、设备及可读存储介质
JP7307776B2 (ja) ロボットアームの障害物回避方法及びロボットアームの障害物回避システム
CN109070357B (zh) 工业机器人系统、控制系统及方法、控制器及计算设备
Cho et al. Hybrid position and force control of a robot arm equipped with joint torque sensors
TW202308815A (zh) 機械手臂避障方法及機械手臂避障系統
CN114074324B (zh) 一种新颖的确保机器人速度和动量边界限制的安全系统
WO2023026589A1 (ja) 制御装置、制御方法および制御プログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220117

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221206

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230301

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230509

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20231205