JP5404519B2 - ロボット、制御システムおよび制御プログラム - Google Patents
ロボット、制御システムおよび制御プログラム Download PDFInfo
- Publication number
- JP5404519B2 JP5404519B2 JP2010101491A JP2010101491A JP5404519B2 JP 5404519 B2 JP5404519 B2 JP 5404519B2 JP 2010101491 A JP2010101491 A JP 2010101491A JP 2010101491 A JP2010101491 A JP 2010101491A JP 5404519 B2 JP5404519 B2 JP 5404519B2
- Authority
- JP
- Japan
- Prior art keywords
- line segment
- control system
- robot
- point
- control
- 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
-
- 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/34—Director, elements to supervisory
- G05B2219/34141—B-spline, NURBS non uniform rational b-spline
-
- 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/34—Director, elements to supervisory
- G05B2219/34175—Overlap, between two blocks, continuous, smooth speed change, movement
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40428—Using rapidly exploring random trees algorithm RRT-algorithm
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40449—Continuous, smooth robot motion
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40476—Collision, planning for collision free path
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40512—Real time path planning, trajectory generation
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40519—Motion, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Description
まず、本発明の制御対象の一実施形態としてのロボットの構成について説明する。
図2に示されている制御システム1は、ロボットRに搭載されているコンピュータにより構成されている。制御システム1は、後述する演算処理を実行するように構成されている第1演算処理要素11および第2演算処理要素12を備えている。
前記構成のロボットRおよび制御システム1の機能について説明する。ここで、たとえば、図6に示されているようにロボットRが腕体B2を動かすことにより、ハンドHおよびコップが、テーブルに置かれている他のコップと接触しないようにハンドHで把持しているコップを動かし、このテーブルに置くというタスクを実行する際の動作が制御される場合について説明する。
Bi,k(t)={(t−ti)/(ti+k-1−ti)}Bi,k-1(t)+{(ti+k−t)/(ti+k−ti+1)}Bi+1,k-1(t) ..(02)。
前記機能を発揮する制御システム1によれば、空間補間用の基底関数を結合係数とする、モデル空間に配置された点列の線形結合により表現される線分を生成する補間処理が実行されることにより、目標位置軌道またはその候補が生成される(式(01)、図4(a)(b)参照)。このため、モデル空間に配置された複数の点のそれぞれを通る折れ線(図5(b)参照)ではなく、当該複数の点(制御点)の線形結合により表わされる、始点および終点を連続的にまたは滑らかに接続する線分が制御対象の目標位置軌道またはその候補として生成される(図4(b)、図5(a)。これにより、目標位置軌道にしたがった制御対象の動作の連続性または円滑性の維持が図られうる。
第1判定処理および第2判定処理が省略され、接続処理が終了した段階において生成された位置軌道が指定条件を満たすか否かが判定され、当該判定結果が肯定的であったことを要件としてこの位置軌道が目標位置軌道として設定されてもよい。
Claims (5)
- 実空間を表わすモデル空間において定義される目標位置軌道にしたがって、制御対象またはその指定部分が変位するように前記制御対象の動作を制御するシステムであって、
前記モデル空間において、相互に離れて配置されている点列に基づき、空間補間用の基底関数を結合係数とする、前記点列の線形結合として表現される線分を生成する補間処理を実行するとともに、前記補間処理により生成された一の線分の基礎である前記点列に点を加えて新たな点列を定義した上で、前記新たな点列を基礎として前記補間処理を実行することにより、当該一の線分が延長線分によって延長された新たな線分を生成する延長処理を実行するように構成されている第1演算処理要素と、
前記第1演算処理要素により延長処理が実行されることにより最近に延長された前記一の線分の基礎である前記新たな点列と、前記補間処理により生成された他の線分の基礎である他の点列とを基礎として前記補間処理を実行することにより、前記一の線分および前記他の線分が接続線分によって接続された形の線分を、前記目標位置軌道またはその候補として生成する接続処理を実行するように構成されている第2演算処理要素とを備えていることを特徴とする制御システム。 - 請求項1記載の制御システムにおいて、
前記第1演算処理要素が、前記モデル空間において、前記延長線分が実空間における物体を表わす物体領域から外れていることを含む指定条件を満たしているか否かを判定する第1判定処理を実行するように構成され、前記第1判定処理の結果が否定的であることを要件として、前記一の線分を棄却した上で前記延長処理を実行するように構成されていることを特徴とする制御システム。 - 請求項1または2記載の制御システムにおいて、
前記第2演算処理要素が、前記モデル空間において、前記接続線分が実空間における物体を表わす物体領域から外れていることを含む指定条件を満たしているか否かを判定する第2判定処理を実行するように構成され、前記第2判定処理の結果が否定的であることを要件として、前記第1演算処理要素が、前記新たな点列を再定義した上で前記延長処理を実行するように構成されていることを特徴とする制御システム。 - 制御対象に搭載されているコンピュータを請求項1〜3のうちいずれか1つに記載の制御システムとして機能させることを特徴とする制御プログラム。
- 基体と、前記基体から延設されている肢体とを備え、前記肢体を動かすことによりタスクを実行するように構成されている前記制御対象としてのロボットであって、請求項1〜3のうちいずれか1つに記載の制御システムを備えていることを特徴とするロボット。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010101491A JP5404519B2 (ja) | 2010-04-26 | 2010-04-26 | ロボット、制御システムおよび制御プログラム |
US13/086,850 US9193070B2 (en) | 2010-04-26 | 2011-04-14 | Robot, control system for controlling motion of a controlled object, and recording medium for control program for controlling motion of a controlled object |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010101491A JP5404519B2 (ja) | 2010-04-26 | 2010-04-26 | ロボット、制御システムおよび制御プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011230212A JP2011230212A (ja) | 2011-11-17 |
JP5404519B2 true JP5404519B2 (ja) | 2014-02-05 |
Family
ID=44816473
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010101491A Active JP5404519B2 (ja) | 2010-04-26 | 2010-04-26 | ロボット、制御システムおよび制御プログラム |
Country Status (2)
Country | Link |
---|---|
US (1) | US9193070B2 (ja) |
JP (1) | JP5404519B2 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8423328B2 (en) * | 2009-09-30 | 2013-04-16 | International Business Machines Corporation | Method of distributing a random variable using statistically correct spatial interpolation continuously with spatially inhomogeneous statistical correlation versus distance, standard deviation, and mean |
JP5724919B2 (ja) | 2012-03-22 | 2015-05-27 | トヨタ自動車株式会社 | 軌道生成装置、移動体、軌道生成方法及びプログラム |
KR101339480B1 (ko) | 2012-12-14 | 2013-12-10 | 고려대학교 산학협력단 | Rrt 기반의 듀얼 트리 구조를 이용한 이동 로봇의 궤적 계획 방법 |
GB201307550D0 (en) | 2013-04-26 | 2013-06-12 | Tomtom Dev Germany Gmbh | Methods and systems of providing information indicative of a recommended navigable stretch |
JP6833777B2 (ja) * | 2018-09-10 | 2021-02-24 | 株式会社東芝 | 物体ハンドリング装置及びプログラム |
US10766141B1 (en) * | 2019-05-09 | 2020-09-08 | Mujin, Inc. | Robotic system with a coordinated transfer mechanism |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09146622A (ja) * | 1995-11-16 | 1997-06-06 | Matsushita Electric Ind Co Ltd | ロボットの軌道生成方法と軌道生成装置 |
JPH09265311A (ja) * | 1996-03-29 | 1997-10-07 | Mitsubishi Electric Corp | 位置決めプログラム装置 |
US6216058B1 (en) * | 1999-05-28 | 2001-04-10 | Brooks Automation, Inc. | System of trajectory planning for robotic manipulators based on pre-defined time-optimum trajectory shapes |
JP2007054906A (ja) * | 2005-08-23 | 2007-03-08 | Koyama:Kk | 多関節型ロボット |
JP4412329B2 (ja) * | 2007-01-31 | 2010-02-10 | 株式会社デンソーウェーブ | ロボット制御装置及びロボットの位置指令値修正方法 |
-
2010
- 2010-04-26 JP JP2010101491A patent/JP5404519B2/ja active Active
-
2011
- 2011-04-14 US US13/086,850 patent/US9193070B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
US20110264265A1 (en) | 2011-10-27 |
JP2011230212A (ja) | 2011-11-17 |
US9193070B2 (en) | 2015-11-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5404519B2 (ja) | ロボット、制御システムおよび制御プログラム | |
JP4645601B2 (ja) | 環境地図の生成方法及び移動ロボット | |
JP5261495B2 (ja) | 重み行列を用いたリアルタイム自己衝突および障害物回避 | |
US12128560B2 (en) | Information processing device, control method, and program | |
US9193072B2 (en) | Robot and control method thereof | |
JP5480799B2 (ja) | 移動装置およびロボットならびにこれらの制御システム | |
US9827675B2 (en) | Collision avoidance method, control device, and program | |
JP4908020B2 (ja) | ハンド制御システム | |
US9014854B2 (en) | Robot and control method thereof | |
KR102015307B1 (ko) | 로봇 및 그 제어 방법 | |
WO2011016280A1 (ja) | ロボットおよび制御システム | |
Luo et al. | Real time human motion imitation of anthropomorphic dual arm robot based on Cartesian impedance control | |
JP2008246607A (ja) | ロボット、ロボットの制御方法およびロボットの制御プログラム | |
JP2010134907A (ja) | 強化学習システム | |
JP2011240475A (ja) | ロボットおよび制御システム | |
JP6322949B2 (ja) | ロボット制御装置、ロボットシステム、ロボット、ロボット制御方法及びロボット制御プログラム | |
US8805583B2 (en) | Robot and control method thereof | |
JP5456557B2 (ja) | ロボット、制御システムおよび制御プログラム | |
JP5306934B2 (ja) | ロボットおよび制御システム | |
TWI781708B (zh) | 學習裝置、學習方法、學習程式、控制裝置、控制方法及控制程式 | |
JP2015104788A (ja) | 移動装置 | |
JP6158665B2 (ja) | ロボット、ロボット制御方法、およびロボット制御プログラム | |
JP5306933B2 (ja) | ロボットおよび制御システム | |
JP2011235380A (ja) | 制御装置 | |
JP5450218B2 (ja) | ロボットおよび制御システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20121127 |
|
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: 20131008 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131029 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5404519 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |