JP5948932B2 - ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム - Google Patents

ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム Download PDF

Info

Publication number
JP5948932B2
JP5948932B2 JP2012031848A JP2012031848A JP5948932B2 JP 5948932 B2 JP5948932 B2 JP 5948932B2 JP 2012031848 A JP2012031848 A JP 2012031848A JP 2012031848 A JP2012031848 A JP 2012031848A JP 5948932 B2 JP5948932 B2 JP 5948932B2
Authority
JP
Japan
Prior art keywords
robot
vertical articulated
articulated robot
condition
axes
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.)
Expired - Fee Related
Application number
JP2012031848A
Other languages
English (en)
Other versions
JP2013166222A (ja
Inventor
高志 南本
高志 南本
一弘 小菅
一弘 小菅
健太郎 亀井
健太郎 亀井
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.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
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 Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2012031848A priority Critical patent/JP5948932B2/ja
Priority to US13/768,518 priority patent/US8977392B2/en
Priority to CN2013100513671A priority patent/CN103252779A/zh
Publication of JP2013166222A publication Critical patent/JP2013166222A/ja
Priority to US14/607,120 priority patent/US20150148950A1/en
Application granted granted Critical
Publication of JP5948932B2 publication Critical patent/JP5948932B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

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/1628—Programme controls characterised by the control loop
    • B25J9/1643—Programme controls characterised by the control loop redundant control
    • 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/39414—7-DOF
    • 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/40367—Redundant manipulator

Landscapes

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

Description

本発明は、ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステムに関する。
ロボットの手先を任意の位置および姿勢に制御するためには、ロボットは少なくとも６つの軸を含む必要がある。さらに、ロボットの手先を任意の位置および姿勢に制御した状態で、特異点や障害物の回避などをさせるためには、ロボットは少なくとも７つの軸を含む必要がある。
特許文献１には、７つの軸を含むロボットの制御方法として、特異点を回避するために回転させる冗長軸とその回転量を、反復法を用いて数値的に求める制御方法が開示されている（特許文献１参照。）。
特許文献２には、７つの軸を含むロボットの制御方法として、７つの軸のうちの少なくとも１つの軸を、特異点を回避するための軸として自動で選択することで、６軸のロボットと見なし、そして、手先の位置および姿勢に対応する関節角度を定義する逆運動学による解を解析的に求めることで、計算量を減らしてロボットを高速に動作させる制御方法が開示されている（特許文献２参照。）。
特開２００５−１９３３１１号公報 特開平７−１３２４７４号公報
しかしながら、特許文献１に記載されたロボットの制御方法では、反復法を用いているために、計算量が多く、高速に動作させることが難しいという問題があった。
また、特許文献２に記載されたロボットの制御方法では、肘に相当する位置を明示的に指定することができず、直感的に障害物を回避させる動作の指示を行うことができないという問題があった。また、特許文献２に記載されたロボットの制御方法では、例えば第１軸と第２軸との間などにオフセット構造を含むロボットにおいては、肩に相当する軸を定義することができないため、適用することができないという問題があった。
本発明は、前記の点に鑑みてなされたものであり、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能なロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステムを提供することを目的とする。
本発明は、上記の課題を解決するためになされたものであり、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部と、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、前記入力部にて入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、を備え、前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボット（以下、単に「ロボット」とも言う）について、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、前記肘の位置を含む前記垂直多関節ロボットの状態の条件は、前記垂直多関節ロボットにおける手先の位置および姿勢ならびに肘の位置を指定する条件である、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、手先の位置および姿勢ならびに肘の位置を指定する条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、前記制御情報は、前記垂直多関節ロボットの各回転軸および各旋回軸を制御する情報である、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように、前記垂直多関節ロボットの各回転軸および各旋回軸を制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、前記垂直多関節ロボットは、前記垂直多関節ロボットの第１軸と前記垂直多関節ロボットの第２軸との間に前記オフセット構造を含む、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、第１軸と第２軸との間にオフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、前記垂直多関節ロボットは、前記垂直多関節ロボットの第６軸と前記垂直多関節ロボットの第７軸との間に前記オフセット構造を含む、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、第６軸と第７軸との間にオフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部に記憶された前記制御情報を参照して、ロボット制御部が、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件に応じて、前記入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するステップを有し、前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボット制御方法である。
この方法により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部に記憶された前記制御情報を参照して、ロボット制御部が、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件に応じて、前記入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御する手順を、コンピューターに実行させるためのロボット制御プログラムであって、前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ロボット制御プログラムである。
このプログラムにより、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、オフセット構造を含み７つの軸を有する垂直多関節ロボットと、前記垂直多関節ロボットを制御するロボット制御装置と、を備え、前記ロボット制御装置は、前記垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部と、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、前記入力部にて入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、を備え、前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボットシステムである。
このシステムにより、ロボット制御装置のロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、前記入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、を備え、前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボット制御装置である。
この構成により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、ロボット制御部が、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するステップを有し、前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボット制御方法である。
この方法により、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、ロボット制御部が、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御する手順を、コンピューターに実行させるためのロボット制御プログラムであって、前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ロボット制御プログラムである。
このプログラムにより、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
また、本発明は、オフセット構造を含み７つの軸を有する垂直多関節ロボットと、前記垂直多関節ロボットを制御するロボット制御装置と、を備え、前記ロボット制御装置は、前記垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、前記入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、を備え、前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、ことを特徴とするロボットシステムである。
このシステムにより、ロボット制御部は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
以上のように、本発明によれば、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットについて、肘の位置を含む状態の条件の指示に応じて、その条件を満たすように前記垂直多関節ロボットを制御する。これにより、ロボット制御装置は、オフセット構造を含み７つの軸を有する垂直多関節ロボットを、肘の位置を明示的に指定して、制御することが可能である。
本発明の一実施形態に係るロボット制御装置を含むロボットシステムの構成例を示す概略ブロック図である。 第１実施形態に係るオフセット構造を有する７軸のロボットの構成例を示す概略ブロック図である。 変数であるオフセット角度値δを示す図である。 第２実施形態に係るオフセット構造を有する７軸のロボットの構成例を示す概略ブロック図である。 本発明の実施形態の変形例に係るロボットシステムの外観例を示す図である。 逆運動学における計算手順を説明するための図である。
［第１実施形態］
本発明の第１実施形態について図面を参照して詳細に説明する。
図１は、本発明の一実施形態に係るロボット制御装置１００１を含むロボットシステムの構成例を示す概略ブロック図である。
本実施形態に係るロボットシステムは、ロボット制御装置１００１と、ロボット１００２と、ケーブル１００３と、を備える。
ロボット制御装置１００１とロボット１００２とは、有線のケーブル１００３を介して、通信することが可能に接続されている。なお、有線のケーブル１００３の代わりに、無線の回線が用いられてもよい。
ロボット制御装置１００１は、制御部１０１１と、記憶部１０１２と、入力部１０１３と、出力部１０１４と、を備える。
制御部１０１１は、ロボット制御部１０２１を備える。
入力部１０１３は、例えば、ユーザー（人）により操作されるキーボードやマウスなどを用いて構成され、ユーザーにより操作された内容を受け付ける。
出力部１０１４は、例えば、情報を表示する液晶画面などを用いて構成され、ユーザーに対して各種の情報を表示出力する。
記憶部１０１２は、各種の情報を記憶する。記憶部１０１２は、例えば、制御部１０１１により使用されるプログラムの情報や、各種の処理で使用される数値などの情報を記憶する。
制御部１０１１は、例えば、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）などを用いて構成され、ロボット制御装置１００１における各種の処理を制御する。制御部１０１１は、例えば、入力部１０１３により受け付けられたユーザーによる操作の内容に応じた処理を実行する機能、各種の情報を出力部１０１２の画面に表示させる機能、記憶部１０１２に記憶された情報を読み取る機能および記憶部１０１２に情報を書き込む（記憶させる）機能を有する。
ロボット制御部１０２１は、制御部１０１１が有する機能の一部に相当する。
ロボット制御部１０２１は、ケーブル１００３を介して、制御のための信号（制御信号）をロボット１００２に送信することで、ロボット１００２を制御する。
また、ロボット制御部１０２１は、ロボット１００２から送信される信号を、ケーブル１００３を介して、受信することも可能である。
本実施形態では、ロボット１００２として、垂直多関節ロボットの一例であるマニピュレーターを用いている。
ロボット１００２は、ロボット制御装置１００１のロボット制御部１０２１から送信される制御信号を、ケーブル１００３を介して、受信し、受信した制御信号により制御される。
また、ロボット１００２は、自己の状態などを示す信号を、ケーブル１００３を介して、ロボット制御装置１００１のロボット制御部１０２１に送信する機能を有してもよい。
ここで、ロボット１００２としては、具体的には、様々なものに適用されてもよい。例えば、ロボット１００２として、産業用のロボットを構成することができるばかりでなく、宇宙用途や遊具など、様々な分野のロボットに適用することが可能である。
図２は、本実施形態に係るオフセット構造を有する７軸（７自由度）のロボット１００２の構成例を示す概略ブロック図である。
本実施形態に係るロボット１００２は、ベースａ０と、第１関節に相当する回転軸Ａ１と、第１のリンクａ１と、第２関節に相当する旋回軸Ａ２と、第２のリンクａ２と、第３関節に相当する回転軸Ａ３と、第３のリンクａ３と、第４関節に相当する旋回軸Ａ４と、第４のリンクａ４と、第５関節に相当する回転軸Ａ５と、第５のリンクａ５と、第６関節に相当する旋回軸Ａ６と、第６のリンクａ６と、第７関節に相当する回転軸Ａ７と、第７のリンクａ７と、手先１２と、を接続して構成される。
第１関節、第２関節および第３関節で、肩の部分が構成されている。
第４関節で、肘の部分が構成されている。
第５関節、第６関節および第７関節で、手首の部分が構成されている。
本実施形態では、肩の根元から手先１２までを含む部分を「アーム」とする。
ここで、ベースａ０および各リンクａ１〜ａ７は、固定的に設けられている。
また、ベースａ０、第２のリンクａ２、第３のリンクａ３、第４のリンクａ４、第５のリンクａ５、第６のリンクａ６、第７のリンクａ７は、直線状である。
また、本実施形態では、第１のリンクａ１は、１箇所で略９０度に折れ曲がった形状を有している。この部分が、オフセット構造を有するオフセット部１１である。オフセット構造とは、隣り合う回転軸と旋回軸の回転中心軸線が互いに交わらない構造のことである。上述した構成のように、９０度に折れ曲がった形状には限られない。
各回転軸Ａ１、Ａ３、Ａ５、Ａ７は、図２において上下に接続されるリンクを結ぶ直線を中心軸として、回転することが可能である。
各旋回軸Ａ２、Ａ４、Ａ６は、図２において表から裏への直線（または、裏から表への直線）を中心軸として、旋回（回転）することが可能である。
なお、各回転軸Ａ１、Ａ３、Ａ５、Ａ７の中心軸（回転軸）に対して、各旋回軸Ａ２、Ａ４、Ａ６の中心軸（旋回軸）は、直交する。
これら各回転軸Ａ１、Ａ３、Ａ５、Ａ７および各旋回軸Ａ２、Ａ４、Ａ６の角度（７つの角度）が全て決められると、ロボット１００２の全体的な状態が決められる。
ここで、ロボット１００２を制御する変数（パラメーター）としては、必ずしもこれら７つの角度でなくてもよく、これら７つの角度の全てを直接または間接に特定することができる任意の変数を用いることができる。
本実施形態では、ロボット１００２の手先１２の位置および姿勢（６つの変数）の指示と、肘に相当する位置（１つの変数）の指示とから、これらに合致するように、ロボット１００２の各回転軸Ａ１、Ａ３、Ａ５、Ａ７および各旋回軸Ａ２、Ａ４、Ａ６の角度を制御する制御方法を用いる。
ここで、本実施形態に係るオフセット構造を含む垂直多関節ロボットでは、人間と同じように７つの関節を有する。そして、第４関節で、肘の部分が構成されている。本実施形態では、このように垂直多関節ロボットにおいて人間の肘に相当する位置を、当該垂直多関節ロボットにおける肘の位置とみなす。
具体的には、ロボット制御装置１００１では、あらかじめ、記憶部１０１２に、ロボット１００２の手先１２の位置および姿勢の指示ならびに肘に相当する位置の指示に合う垂直多関節ロボットの状態の条件と、当該条件に合致するようにロボット１００２の各回転軸Ａ１、Ａ３、Ａ５、Ａ７および各旋回軸Ａ２、Ａ４、Ａ６の角度を制御する情報（制御情報）とが対応付けられて記憶されている。
ロボット制御部１０２１は、記憶部１０１２に記憶された前記制御情報に基づいて、ロボット１００２の手先１２の位置および姿勢の指示と、肘に相当する位置の指示に応じて、これらの指示に合う垂直多関節ロボットの状態の条件に合致するように、ロボット１００２の各回転軸Ａ１、Ａ３、Ａ５、Ａ７および各旋回軸Ａ２、Ａ４、Ａ６の角度を制御する。
なお、一例として、記憶部１０１２には、垂直多関節ロボットの複数の異なる状態のそれぞれについて、垂直多関節ロボットの状態の条件と、当該条件に合致するようにロボット１００２を制御する情報（制御情報）とが対応付けられて記憶される。そして、ロボット制御部１０２１は、記憶部１０１２に記憶された制御情報の群の中から、指示に応じた垂直多関節ロボットの状態の条件に合致する制御情報を選択して、選択した制御情報をロボット１００２の制御に使用する。
ここで、ロボット１００２の手先１２の位置および姿勢の指示と、肘に相当する位置の指示は、一例として、入力部１０１３によりユーザーから受け付ける。これにより、入力部１０１３は、このような指示に合う垂直多関節ロボットの状態の条件をユーザーから受け付けることになる。 このような指示は、例えば、数値を用いて受け付けてもよく、または、ロボット１００２を操作するためのハンドルなどを入力部１０１３に備えて、ユーザーにより操作される当該ハンドルなどの動きに基づいて受け付けてもよい。
また、他の例として、ロボット１００２の手先１２の位置および姿勢の指示と、肘に相当する位置の指示について、その一部または全部の指示をロボット制御装置１００１により自動的に取得してもよい。具体的には、ロボット制御装置１００１において、例えば、ロボット１００２により行われる作業の対象となる部品などの位置などをセンサーにより検出して、その検出結果に基づいて、ロボット１００２の手先１２の位置および姿勢の指示と、肘に相当する位置の指示のうちの一部または全部を生成することができる。
ここで、逆運動学により、ロボット１００２の手先１２の位置および姿勢と、肘に相当する位置とから、ロボット１００２の全体的な状態を解析的に計算して決定することができる。
このような逆運動学における計算の手順（逆運動学における計算手順１）〜（逆運動学における計算手順４）の概要を説明する。
本実施形態では、ベース座標は、直交右手座標系であるＸＹＺ座標系の座標（ｘ、ｙ、ｚ）で表される。また、手先１２の位置ベクトルｐ（ｐは図および数式ではベクトルを表す矢印を付してある、以下も同様）を、ベース座標におけるＸ軸、Ｙ軸およびＺ軸の位置で指定する。
手先１２の姿勢を、第７軸の回転軸と向きが等しい単位ベクトルｂ（ｂは図および数式ではベクトルを表す矢印を付してある、以下も同様）と、ベクトルｂと直交する単位ベクトルｎ（ｎは図および数式ではベクトルを表す矢印を付してある、以下も同様）と、ベクトルｂおよびベクトルｎと直交して、それらと右手座標系を構成する単位ベクトルｔ（ｔは図ではベクトルを表す矢印を付してある、以下も同様）とで表す。
さらに、ロボット１００２（本実施形態では、マニピュレーター）の全体の姿勢を指定する変数（角度の値）であるオフセット角度値δを指定する。このオフセット角度値δは、肘に相当する位置を指定するものである。
そして、手先１２の位置および姿勢と、オフセット角度値δとから、各関節の角度を計算する。
以下で図６を参照して計算手順を詳しく説明する。図６において、Ｌ０、Ｌ１、Ｌ２、Ｌ３、Ｌ４、Ｌ５、Ｌ６及びＬ７は関節と関節及び関節と手先を接続するリンクである。又、Ｊ１、Ｊ２、Ｊ３、Ｊ４、Ｊ５、Ｊ６及びＪ７は上記リンク回転を運動させる関節である。更に、ａ１は第１関節Ｊ１の回転軸の延長線から、第２関節Ｊ２の回転軸の中心に下ろした垂線の長さであり、ｄ１は第１関節Ｊ１の回転軸の延長線と、第２関節Ｊ２の回転軸の中心から第１関節Ｊ１の回転軸の延長線に下ろした垂線との交点と、原点との距離であり、ｄ３は第２関節Ｊ２と第４関節Ｊ４との距離であり、ｄ５は第４関節Ｊ４と第６関節Ｊ６との距離であり、ｄ７は第６関節Ｊ６から手先１２までの距離である。
ここで、図６に示したように手先１２の位置ベクトルｐが、式（１）で表されるものであって、ベクトルｎ、ベクトルｔおよびベクトルｂが所定の姿勢の時の各関節角度を０度とする。
Figure 0005948932
（逆運動学における計算手順１）
最初に、第６関節の中心を手首と定義し、指定された手先１２の位置と、手先１２と第６関節Ｊ６との相対的な位置及び姿勢から、ベース座標における手首の位置ベクトルｗ（ｗは図および数式ではベクトルを表す矢印を付してある、以下も同様）を式（２）により計算する。
Figure 0005948932
次に、計算した手首の位置のｘ成分、ｙ成分からＸ軸と成す角度を求め、それにオフセット角度値δを加えて第１関節の角度を式（３）により計算する。
ここで、幾何学的な対称性から、式（４）も第１関節Ｊ１の角度とすることが出来る。そこで、実際の制御においては、適宜選択してロボットへ指令する。
Figure 0005948932
Figure 0005948932
（逆運動学における計算手順２）
求めた第１関節の角度を用いて、第１関節Ｊ１の角度が０度で、第２関節Ｊ２の中心を原点とした場合における手首の位置ベクトルｗ’（ｗ’は図および数式ではベクトルを表す矢印を付してある、以下も同様）を式（５）により計算する。
Figure 0005948932
次に、計算した手首の位置ｗ’を再現するように、第２関節Ｊ２、第３関節Ｊ３および第４関節Ｊ４の角度を計算する。
まず第４関節Ｊ４の角度はベクトルｗ’とｄ３及びｄ５が三角形を形成することを条件として式（６）により求める。
Figure 0005948932
次に第２関節Ｊ２の角度は、式（７）として、第４関節Ｊ４の角度を用いて、式（８）と与えられる。
Figure 0005948932
Figure 0005948932
更に第３関節Ｊ３の角度は、第２関節Ｊ２の角度を用いて、式（９）と与えられる。
Figure 0005948932
又、θ２、θ３及びθ４について、幾何学的な対称性から式（１０）〜式（１２）、式（１３）〜式（１５）、式（１６）〜式（１８）も第２関節Ｊ２、第３関節Ｊ３及び第４関節Ｊ４の関節角度とすることが出来る。そこで、実際の制御においては、適宜選択してロボットへ指令する。
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
Figure 0005948932
（逆運動学における計算手順３）
求めた第１関節Ｊ１、第２関節Ｊ２、第３関節Ｊ３および第４関節Ｊ４の角度を用いて、第１関節Ｊ１、第２関節Ｊ２、第３関節Ｊ３および第４関節Ｊ４の角度が０度で、第６関節Ｊ６の中心を原点とした場合の手先１２の位置を式（１９）により計算する。
Figure 0005948932
次に、計算した手先１２のｙおよびｚ成分から第５関節Ｊ５の角度を式（２０）により計算し、ｘ、ｙおよびｚ成分から第６関節Ｊ６の角度を式（２１）により計算する。
Figure 0005948932
Figure 0005948932
又、θ５及びθ６について、幾何学的な対称性から式（２２）〜式（２３）も第５関節Ｊ５及び第６関節Ｊ６の関節角度とすることが出来る。そこで、実際の制御においては、適宜選択してロボットへ指令する。
Figure 0005948932
Figure 0005948932
（逆運動学における計算手順４）
求めた第１関節Ｊ１、第２関節Ｊ２、第３関節Ｊ３、第４関節Ｊ４、第５関節Ｊ５および第６関節Ｊ６の角度を用いて、第７関節Ｊ７が０度の時の単位ベクトルｎ０（ｎ０は数式ではベクトルを表す矢印を付してある、以下も同様）を式（２４）により計算する。
Figure 0005948932
式（２４）において、ｓ１はｓｉｎθ１、ｃ１はｃｏｓθ１、ｓ２はｓｉｎθ２、ｃ２はｃｏｓθ２、ｓ３はｓｉｎθ３、ｃ３はｃｏｓθ３、ｓ４はｓｉｎθ４、ｃ４はｃｏｓθ４、ｓ５はｓｉｎθ５、ｃ５はｃｏｓθ５、ｓ６はｓｉｎθ６、ｃ６はｃｏｓθ６の略記である。又、式（２４）は順運動学から求められる。
次に、計算したベクトルｎ０と、指定されたベクトルｎとの外積を式（２５）により求めて、それと指定されたベクトルｂとの式（２６）による内積の正負から、その回転方向を判別する。
Figure 0005948932
Figure 0005948932
最後に先ほど計算したベクトルｎ０と、指定されたベクトルｎとの式（２７）による内積からそれらの成す角を求めて、式（２８）により、第７関節Ｊ７の角度とする。
Figure 0005948932
Figure 0005948932
又、θ７について、幾何学的な対称性から式（２９）も第７関節Ｊ７の関節角度とすることが出来る。そこで、実際の制御においては、適宜選択してロボットへ指令する。
Figure 0005948932
以上のようにして、逆運動学により、ロボット１００２の手先１２の位置および姿勢と、肘に相当する位置（オフセット角度値δ）とから、表１に示す１６通りのロボット１００２の全体的な状態を解析的に計算して決定することができる。
Figure 0005948932
実際の制御においては、表１に示した１６通りの関節角度から、関節の可動範囲や障害物とロボットの位置関係等を考慮して適宜選択してロボットへ指令する。尚、ここで示した計算手順は一例であり、場合分けと三角関数の逆余弦、逆正弦、逆正接のいずれを用いて関節角度を求めるかは上述の手順に限られない。
なお、このような逆運動学による計算は、例えば、ロボット制御部１０２１がロボット１００２を制御するたびに行ってもよいが、通常は制御するたびに逆運動学計算を行うが、あらかじめ計算しておいてメモリーに記憶させておき、制御するたびにその結果を読み出しても良い。
一例として、逆運動学による解析式などをあらかじめオフラインで求めておいて記憶部１０１２に記憶させておき、ロボット制御部１０２１がその解析式などを使用して各関節の角度を計算することができる。
図３は、変数であるオフセット角度値δを示す図である。
図３に示されるＸＹＺ座標系は、ベース座標の座標系である。
図３において、点２０１（図３の例では、原点Ｏ）は、ロボット１００２を構成するベースａ０の根元の点を表す。
図３において、点２０２は、ロボット１００２を構成する手首を表す。
図３において、ロボットの状態１０１は、点２０１と点２０２を固定した場合に、オフセットがないとしたときにおけるロボットの状態を表す。このとき、第１関節の角度はθ１である。
図３において、ロボットの状態１０２は、点２０１と点２０２を固定した場合に、オフセット角度値δがあるとしたときにおけるロボットの状態を表す。このとき、第１関節の角度は（θ１＋δ）となる。
本実施形態では、原点と第４軸（旋回軸Ａ４）とを結ぶ直線をベース座標に射影した直線と、原点と第６軸（旋回軸Ａ６）とを結ぶ直線をベース座標に射影した直線とが成す角δを、肘に相当する第４軸（旋回軸Ａ４）の位置を明示的に指定する変数（オフセット角度値δ）として使用する。
なお、本実施形態では、肘に相当する位置（肘の位置）を指定する変数として、オフセット角度値δを用いるが、例えば、同様なものが間接的に特定されれば、他の方法で定義される変数が用いられてもよい。
以上のように、本実施形態に係るロボットシステムのロボット制御装置１００１では、第１軸（回転軸Ａ１）と第２軸（旋回軸Ａ２）との間にオフセット構造（オフセット部１１）を含む７軸のロボット１００２について、ロボット１００２の手先１２の位置および姿勢ならびに肘に相当する位置（オフセット角度値δ）の指示に合う垂直多関節ロボットの状態の条件と、当該条件に合致するようにロボット１００２の全体的な状態（本実施形態では、ロボット１００２の各回転軸Ａ１、Ａ３、Ａ５、Ａ７および各旋回軸Ａ２、Ａ４、Ａ６の角度）を制御する情報（制御情報）とを対応付けて記憶部１０１２に記憶しており、ロボット制御部１０２１が、記憶部１０１２に記憶された前記制御情報に基づいて、ロボット１００２の手先１２の位置および姿勢の指示と、肘に相当する位置（オフセット角度値δ）の指示に応じて、当該指示に合う垂直多関節ロボットの状態の条件に合致するように、ロボット１００２の全体的な状態を制御する。
このように、本実施形態に係るロボットシステムのロボット制御装置１００１では、オフセット構造を含み７つの軸を有する垂直多関節ロボットの、前記垂直多関節ロボットにおける肘の位置（1つの変数）を含む前記垂直多関節ロボットの状態の条件（全部で７つの変数）、および、前記条件を満たすように前記ロボット１００２を制御する制御情報を対応付けて記憶部１０１２により記憶し、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力部１０１３により入力され、ロボット制御部１０２１が、前記入力部１０１３にて入力された条件と同じ条件に対応付けられて前記記憶部１０１２に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記ロボット１００２を制御する。
本実施形態に係るロボットシステムのロボット制御装置１００１によれば、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を導入して使用することで、ロボット１００２の手先１２を任意の位置および姿勢に制御した状態で、広い可動域を確保し、特異点や障害物の回避を行い、高速に動作することを実現することができる。
本実施形態に係るロボットシステムのロボット制御装置１００１では、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を使用することで、例えば、ユーザーにより、直感的にロボット１００２の状態を指示することができ、制御のし易さを向上させることができる。
本実施形態に係るロボットシステムのロボット制御装置１００１では、人間と同じように７つの関節を有するロボット１００２を制御する。このため、本実施形態に係るロボットシステムのロボット制御装置１００１では、ロボット１００２について、例えば、手先１２と肩を止めたまま、肘の位置を変えることができ、これにより、肘の位置を調整して、障害物を回避させながら作業を実行させることなどが可能である。
本実施形態に係るロボットシステムのロボット制御装置１００１では、オフセット構造（オフセット部１１）を有するロボット１００２を制御する。このため、本実施形態に係るロボットシステムのロボット制御装置１００１では、ロボット１００２について、例えば、オフセット構造により作業領域を非対称化することで、特定の領域の作業性を高めることができ、また、アームの構造を設計する際の自由度を高めることができる。オフセット構造を有するロボット１００２では、一般的に、オフセット構造を有しないロボットと比べて、より遠くまで対象物を取りに行ける、肘を張って力を入れる姿勢を実現することができる、などの効果がある。
［第２実施形態］
本発明の第２実施形態について図面を参照して詳細に説明する。
第１実施形態では、図２に示されるように第１軸（回転軸Ａ１）と第２軸（旋回軸Ａ２）との間にオフセット構造（オフセット部１１）を有するロボットを制御する場合について説明したが、本実施形態では、図４に示されるように第６軸（旋回軸Ａ６）と第７軸（回転軸Ａ２）との間にオフセット構造（オフセット部２１）を有するロボットを制御する場合について説明する。
ここで、本実施形態に係るロボットシステムの概略的な構成や動作は、第１実施形態に係る図１に示されるロボットシステムの構成や動作と同様である。このため、本実施形態では、図１に示されるものと同じ符号を用いて説明する。
図４は、本実施形態に係るオフセット構造を有する７軸（７自由度）のロボット１００２の構成例を示す概略ブロック図である。
本実施形態に係るロボット１００２は、ベースｂ０と、第１関節に相当する回転軸Ｂ１と、第１のリンクｂ１と、第２関節に相当する旋回軸Ｂ２と、第２のリンクｂ２と、第３関節に相当する回転軸Ｂ３と、第３のリンクｂ３と、第４関節に相当する旋回軸Ｂ４と、第４のリンクｂ４と、第５関節に相当する回転軸Ｂ５と、第５のリンクｂ５と、第６関節に相当する旋回軸Ｂ６と、第６のリンクｂ６と、第７関節に相当する回転軸Ｂ７と、第７のリンクｂ７と、手先２２と、を接続して構成される。
第１関節、第２関節および第３関節で、肩の部分が構成されている。
第４関節で、肘の部分が構成されている。
第５関節、第６関節および第７関節で、手首の部分が構成されている。
ここで、ベースｂ０および各リンクｂ１〜ｂ７は、固定的に設けられている。
また、ベースｂ０、第１のリンクｂ１、第２のリンクｂ２、第３のリンクｂ３、第４のリンクｂ４、第５のリンクｂ５、第７のリンクｂ７は、直線状である。
また、本実施形態では、第６のリンクｂ１は、１箇所で略９０度に折れ曲がった形状を有している。この部分が、オフセット構造を有するオフセット部２１である。
各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７は、図４において上下に接続されるリンクを結ぶ直線を中心軸として、回転することが可能である。
各旋回軸Ｂ２、Ｂ４、Ｂ６は、図４において表から裏への直線（または、裏から表への直線）を中心軸として、旋回（回転）することが可能である。
なお、各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７の中心軸（回転軸）に対して、各旋回軸Ｂ２、Ｂ４、Ｂ６の中心軸（旋回軸）は、直交する。
これら各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７および各旋回軸Ｂ２、Ｂ４、Ｂ６の角度（７つの角度）が全て決められると、ロボット１００２の全体的な状態が決められる。
ここで、ロボット１００２を制御する変数（パラメーター）としては、必ずしもこれら７つの角度でなくてもよく、これら７つの角度の全てを直接または間接に特定することができる任意の変数を用いることができる。
本実施形態では、ロボット１００２の手先２２の位置および姿勢（６つの変数）の指示と、肘に相当する位置（１つの変数）の指示とから、これらに合致するように、ロボット１００２の各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７および各旋回軸Ｂ２、Ｂ４、Ｂ６の角度を制御する制御方法を用いる。
具体的には、ロボット制御装置１００１では、あらかじめ、記憶部１０１２に、ロボット１００２の手先２２の位置および姿勢の指示ならびに肘に相当する位置の指示に合う垂直多関節ロボットの状態の条件と、当該条件に合致するようにロボット１００２の各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７および各旋回軸Ｂ２、Ｂ４、Ｂ６の角度を制御する情報（制御情報）とが対応付けられて記憶されている。
ロボット制御部１０２１は、記憶部１０１２に記憶された前記制御情報に基づいて、ロボット１００２の手先２２の位置および姿勢の指示と、肘に相当する位置の指示に応じて、これらの指示に合う垂直多関節ロボットの状態の条件に合致するように、ロボット１００２の各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７および各旋回軸Ｂ２、Ｂ４、Ｂ６の角度を制御する。
なお、本実施形態では、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を、図４に示されるように、オフセット構造が手首側にあるロボット１００２について定義する。これについては、例えば、第１実施形態の場合と同様な手法を本実施形態の場合に適用して、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を定義することが可能である。なお、第２実施形態では、第１実施形態と肩と手首が入れ替わるため、オフセット角δも、肩に対する肘の位置ではなくて、手首に対する肘の位置に変わる。
また、本実施形態では、図４に示されるように、オフセット構造が手首側にあるロボット１００２について、逆運動学を適用する。これについては、例えば、第１実施形態の場合と同様な手法を本実施形態の場合に適用して、逆運動学による解を求めることが可能である。
具体的には、第１実施形態に係る図２に示されるように、肩側にオフセット構造（オフセット部１１）がある７軸のロボットの構造と、本実施形態に係る図４に示されるように、手首側にオフセット構造（オフセット部２１）がある７軸のロボットの構造とでは、概略的には、図２に示される第１関節〜第７関節と図４に示される第７関節〜第１関節がそれぞれ対応すると考えることができる。
以上のように、本実施形態に係るロボットシステムのロボット制御装置１００１では、第６軸（旋回軸Ｂ６）と第７軸（回転軸Ｂ７）との間にオフセット構造（オフセット部２１）を含む７軸のロボット１００２について、ロボット１００２の手先２２の位置および姿勢ならびに肘に相当する位置（オフセット角度値δ）の指示に合う垂直多関節ロボットの状態の条件と、当該条件に合致するようにロボット１００２の全体的な状態（本実施形態では、ロボット１００２の各回転軸Ｂ１、Ｂ３、Ｂ５、Ｂ７および各旋回軸Ｂ２、Ｂ４、Ｂ６の角度）を制御する情報（制御情報）とを対応付けて記憶部１０１２に記憶しており、ロボット制御部１０２１が、記憶部１０１２に記憶された前記制御情報に基づいて、ロボット１００２の手先２２の位置および姿勢の指示と、肘に相当する位置（オフセット角度値δ）の指示に応じて、当該指示に合う垂直多関節ロボットの状態の条件に合致するように、ロボット１００２の全体的な状態を制御する。
このように、本実施形態に係るロボットシステムのロボット制御装置１００１では、オフセット構造を含み７つの軸を有する垂直多関節ロボットの、前記垂直多関節ロボットにおける肘の位置（1つの変数）を含む前記垂直多関節ロボットの状態の条件（全部で７つの変数）、および、前記条件を満たすように前記ロボット１００２を制御する制御情報を対応付けて記憶部１０１２により記憶し、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力部１０１３により入力され、ロボット制御部１０２１が、前記入力部１０１３にて入力された条件と同じ条件に対応付けられて前記記憶部１０１２に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記ロボット１００２を制御する。
本実施形態に係るロボットシステムのロボット制御装置１００１によれば、手首側にオフセット構造を有するロボット１００２について、第１実施形態の場合と同様な効果を得ることができる。
例えば、本実施形態に係るロボットシステムのロボット制御装置１００１によれば、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を導入して使用することで、ロボット１００２の手先２２を任意の位置および姿勢に制御した状態で、広い可動域を確保し、特異点や障害物の回避を行い、高速に動作することを実現することができる。
また、本実施形態に係るロボットシステムのロボット制御装置１００１では、肘に相当する位置を明示的に指定する変数（オフセット角度値δ）を使用することで、例えば、ユーザーにより、直感的にロボット１００２の状態を指示することができ、制御のし易さを向上させることができる。
［以上の実施形態の変形例に係る実施形態］
図５は、本発明の実施形態の変形例に係るロボットシステムの外観例を示す図である。
図５は、本変形例に係るロボットシステムをその前方から見た外観例を示している。このため、図５における右側が本変形例に係るロボットシステムの左側に相当し、図５における左側が本変形例に係るロボットシステムの右側に相当する。
本変形例に係るロボットシステムは、ベースユニット２００１と、胴体を構成する部材（胴体部材）２００２、２００３、２００４と、腕（アーム）を構成するロボット２０１１、２０１２と、車輪２０２１、２０２２と、を備える。
本変形例に係るロボットシステムは、ベースユニット２００１の上面に胴体部材２００２、胴体部材２００３、胴体部材２００４が順に上側に取り付けられ、最も上部の胴体部材２００４の左側に左腕を構成するロボット２０１１が取り付けられ、当該最も上部の胴体部材２００４の右側に右腕を構成するロボット２０１２が取り付けられ、ベースユニット２００１の底面の左側に車輪２０２１が取り付けられ、ベースユニット２００１の底面の右側に車輪２０２２が取り付けられて、構成されている。
ここで、本変形例に係るロボットシステムは、左腕を構成するロボット２０１１と、右腕を構成するロボット２０１２とを備えており、このように双方の腕を備えている。
各腕を構成するロボット２０１１、２０１２は、それぞれ、例えば、図２に示される垂直多関節ロボットを有するロボット、または、図４に示される垂直多関節ロボットを有するロボットから構成される。
また、本変形例に係るロボットシステムは、左側の車輪２０２１と、右側の車輪２０２２とを備えており、このように双方の車輪を備えている。
そして、本変形例に係るロボットシステムは、人力により車輪２０２１、２０２２を回転させて、移動させられることが可能である。
本変形例に係るロボットシステムでは、ベースユニット２００１の内部に、ロボット制御装置を格納して備えている。
このロボット制御装置は、例えば、図１に示されるロボット制御装置１００１と同様な機能を有しており、図１に示されるロボット１００２に対応する左腕のロボット２０１１と、図１に示されるロボット１００２に対応する右腕のロボット２０１２を制御する。
ここで、このロボット制御装置は、例えば、左腕のロボット２０１１と右腕のロボット２０１２とを同時に関連付けて制御してもよく、または、左腕のロボット２０１１と右腕のロボット２０１２とをそれぞれ別個に制御してもよい。
以上のように、本変形例に係るロボットシステムでは、例えば、図１に示されるロボット制御装置１００１とロボット１００２に対応するもの（本変形例に係るロボットシステムでは、ベースユニット２００１に備えられるロボット制御装置と、２つのロボット２０１１、２０１２）が一体として構成されている。
なお、ベースユニット２００１に備えられるロボット制御装置と各ロボット２０１１、２０１２とは、例えば、有線のケーブルまたは無線を介して、制御信号などを通信することが可能に接続される。
ここで、他の構成例として、ベースユニット２００１に備えられるロボット制御装置の機能の一部を、図５に示されるロボットシステムとは別体のコントローラーに備えることも可能である。
具体例として、図１に示されるロボット制御装置１００１に備えられる入力部１０１３と出力部１０１４の機能と同様な機能を、図５に示されるロボットシステムとは別体のコントローラーに備え、ベースユニット２００１に備えられるロボット制御装置と当該コントローラーとに互いに無線により通信する機能を備えることで、図１に示されるロボット制御装置１００１に備えられる入力部１０１３と出力部１０１４の機能と同様な機能をリモートのコントローラーで実現することが可能である。
［以上の実施形態のまとめ］
以上、この発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の設計等も含まれる。
なお、以上に説明したロボット制御装置１００１における任意の構成部の機能を実現するためのプログラムを、コンピューター読み取り可能な記録媒体に記録し、そのプログラムをコンピューターシステムに読み込ませて実行するようにしてもよい。なお、ここで言う「コンピューターシステム」とは、ＯＳ（Ｏｐｅｒａｔｉｎｇ Ｓｙｓｔｅｍ）や周辺機器等のハードウェアを含むものとする。また、「コンピューター読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、ＣＤ（Ｃｏｍｐａｃｔ Ｄｉｓｋ）−ＲＯＭ等の可搬媒体、コンピューターシステムに内蔵されるハードディスク等の記憶装置のことを言う。さらに「コンピューター読み取り可能な記録媒体」とは、インターネット等のネットワークや電話回線等の通信回線を介してプログラムが送信された場合のサーバーやクライアントとなるコンピューターシステム内部の揮発性メモリー（ＲＡＭ：Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）のように、一定時間プログラムを保持しているものも含むものとする。
また、上記のプログラムは、このプログラムを記憶装置等に格納したコンピューターシステムから、伝送媒体を介して、あるいは、伝送媒体中の伝送波により他のコンピューターシステムに伝送されてもよい。ここで、プログラムを伝送する「伝送媒体」は、インターネット等のネットワーク（通信網）や電話回線等の通信回線（通信線）のように情報を伝送する機能を有する媒体のことを言う。
また、上記のプログラムは、前述した機能の一部を実現するためのものであってもよい。さらに、上記のプログラムは、前述した機能をコンピューターシステムにすでに記録されているプログラムとの組み合わせで実現できるもの、いわゆる差分ファイル（差分プログラム）であってもよい。
ａ０…ベース、ａ１〜ａ７…リンク、Ａ１、Ａ３、Ａ５、Ａ７…回転軸、Ａ２、Ａ４、Ａ６…旋回軸、１１…オフセット部、１２…手先、ｂ０…ベース、ｂ１〜ｂ７…リンク、Ｂ１、Ｂ３、Ｂ５、Ｂ７…回転軸、Ｂ２、Ｂ４、Ｂ６…旋回軸、２１…オフセット部、２２…手先、１０１、１０２…ロボットの状態、２０１、２０２…点、１００１…ロボット制御装置、１００２…ロボット、１００３…ケーブル、１０１１…制御部、１０１２…記憶部、１０１３…入力部、１０１４…出力部、１０２１…ロボット制御部、２００１…ベースユニット、２００２〜２００４…胴体部材、２０１１、２０１２…ロボット、２０２１、２０２２…車輪、Ｌ０〜Ｌ７…リンク、Ｊ１〜Ｊ７…関節

Claims (12)

  1. オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部と、
    前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、
    前記入力部にて入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、
    を備え、
    前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、
    前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボット制御装置。
  2. 前記肘の位置を含む前記垂直多関節ロボットの状態の条件は、前記垂直多関節ロボットにおける手先の位置および姿勢ならびに肘の位置を指定する条件である、
    ことを特徴とする請求項１に記載のロボット制御装置。
  3. 前記制御情報は、前記垂直多関節ロボットの各回転軸および各旋回軸を制御する情報である、
    ことを特徴とする請求項１または請求項２に記載のロボット制御装置。
  4. 前記垂直多関節ロボットは、前記垂直多関節ロボットの第１軸と前記垂直多関節ロボットの第２軸との間に前記オフセット構造を含む、
    ことを特徴とする請求項１から請求項３のいずれか１項に記載のロボット制御装置。
  5. 前記垂直多関節ロボットは、前記垂直多関節ロボットの第６軸と前記垂直多関節ロボットの第７軸との間に前記オフセット構造を含む、
    ことを特徴とする請求項１から請求項３のいずれか１項に記載のロボット制御装置。
  6. オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部に記憶された前記制御情報を参照して、ロボット制御部が、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件に応じて、前記入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するステップを有し、
    前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、
    前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボット制御方法。
  7. オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部に記憶された前記制御情報を参照して、ロボット制御部が、前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件に応じて、前記入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御する手順を、コンピューターに実行させるためのロボット制御プログラムであって、
    前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、
    前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ロボット制御プログラム。
  8. オフセット構造を含み７つの軸を有する垂直多関節ロボットと、
    前記垂直多関節ロボットを制御するロボット制御装置と、
    を備え、
    前記ロボット制御装置は、
    前記垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件、および、前記条件を満たすように前記垂直多関節ロボットを制御する制御情報を対応付けて記憶する記憶部と、
    前記肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、
    前記入力部にて入力された条件と同じ条件に対応付けられて前記記憶部に記憶された前記制御情報に基づいて、前記入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、
    を備え、
    前記制御情報は、前記７つの軸のそれぞれの角度の計算手段について、複数通りの前記計算手段の組み合わせの情報を含んでおり、
    前記ロボット制御部は、前記複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボットシステム。
  9. オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、
    前記入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、
    を備え、
    前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボット制御装置。
  10. ロボット制御部が、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するステップを有し、
    前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボット制御方法。
  11. ロボット制御部が、オフセット構造を含み７つの軸を有する垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御する手順を、コンピューターに実行させるためのロボット制御プログラムであって、
    前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ロボット制御プログラム。
  12. オフセット構造を含み７つの軸を有する垂直多関節ロボットと、
    前記垂直多関節ロボットを制御するロボット制御装置と、
    を備え、
    前記ロボット制御装置は、
    前記垂直多関節ロボットにおける肘の位置を含む前記垂直多関節ロボットの状態の条件が入力される入力部と、
    前記入力部にて入力された条件を満たすように前記垂直多関節ロボットを制御するロボット制御部と、を備え、
    前記ロボット制御部は、前記７つの軸のそれぞれの角度の計算手段に関する複数通りの前記計算手段の組み合わせのうちのいずれか１つの組み合わせを選択して前記垂直多関節ロボットを制御する、
    ことを特徴とするロボットシステム。
JP2012031848A 2012-02-16 2012-02-16 ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム Expired - Fee Related JP5948932B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2012031848A JP5948932B2 (ja) 2012-02-16 2012-02-16 ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム
US13/768,518 US8977392B2 (en) 2012-02-16 2013-02-15 Robot control device, robot control method, robot control program, and robot system
CN2013100513671A CN103252779A (zh) 2012-02-16 2013-02-16 机器人控制装置、机器人控制方法及程序以及机器人系统
US14/607,120 US20150148950A1 (en) 2012-02-16 2015-01-28 Robot control device, robot control method, robot control program, and robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012031848A JP5948932B2 (ja) 2012-02-16 2012-02-16 ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム

Publications (2)

Publication Number Publication Date
JP2013166222A JP2013166222A (ja) 2013-08-29
JP5948932B2 true JP5948932B2 (ja) 2016-07-06

Family

ID=48957161

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012031848A Expired - Fee Related JP5948932B2 (ja) 2012-02-16 2012-02-16 ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム

Country Status (3)

Country Link
US (2) US8977392B2 (ja)
JP (1) JP5948932B2 (ja)
CN (1) CN103252779A (ja)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014018912A (ja) * 2012-07-18 2014-02-03 Seiko Epson Corp ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム
GB2523831B (en) * 2014-03-07 2020-09-30 Cmr Surgical Ltd Surgical arm
JP6247260B2 (ja) * 2015-08-24 2017-12-13 ファナック株式会社 様々な面の加工が可能なワイヤ放電加工機
CN105250026B (zh) * 2015-11-16 2017-05-31 哈尔滨理工大学 一种两自由度姿态调整装置
CN108472813A (zh) * 2015-12-18 2018-08-31 夏普株式会社 机器人、机器人的控制方法以及程序
JP6348141B2 (ja) * 2016-04-28 2018-06-27 ファナック株式会社 付加軸の状態が含まれる動作プログラムを表示するロボットの制御装置
JP6464205B2 (ja) * 2017-01-17 2019-02-06 ファナック株式会社 ロボット制御装置
US11213952B2 (en) * 2017-04-26 2022-01-04 Nidec Corporation Articulated robot and articulated robot system
JP6891774B2 (ja) * 2017-11-24 2021-06-18 株式会社デンソーウェーブ ロボットの制御装置及びロボットの逆変換処理方法
JP6897520B2 (ja) * 2017-11-24 2021-06-30 株式会社デンソーウェーブ ロボットの制御装置及びロボットの逆変換処理方法
JP6891773B2 (ja) * 2017-11-24 2021-06-18 株式会社デンソーウェーブ ロボットの制御装置及びロボットの逆変換処理方法
US10807246B2 (en) * 2018-01-08 2020-10-20 Beijing Jingdong Shangke Information Technology Co., Ltd. Mobile robotic device and method of controlling the same manipulator for locomotion and manipulation
JP7249735B2 (ja) * 2018-03-05 2023-03-31 日本電産株式会社 ロボット制御装置、バックアップファイルの保存方法およびプログラム
JP2019177436A (ja) * 2018-03-30 2019-10-17 日本電産株式会社 ロボット制御装置、ロボットの関節の角度を求める方法、プログラム
CN114952859B (zh) * 2022-06-20 2024-02-23 成都飞机工业（集团）有限责任公司 机器人逆解方法、装置、设备及介质
CN116587289B (zh) * 2023-07-17 2024-03-29 西北工业大学太仓长三角研究院 一种七自由度腕关节偏置机械臂逆解方法、系统及介质

Family Cites Families (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4973215A (en) * 1986-02-18 1990-11-27 Robotics Research Corporation Industrial robot with servo
CA1279678C (en) * 1986-02-18 1991-01-29 James P. Karlen Industrial robot with servo
JPS6416389A (en) * 1987-07-11 1989-01-19 Agency Ind Science Techn Control system of multi-joint type arm robot having redundancy
JPH01177980A (ja) * 1988-01-09 1989-07-14 Fanuc Ltd 設置姿勢に応じた動作条件自動設定機能を備えた産業用ロボット
JPH0550386A (ja) * 1991-08-16 1993-03-02 Fanuc Ltd ７自由度マニプレータの位置教示方式
JPH05233042A (ja) * 1992-02-25 1993-09-10 Fanuc Ltd 冗長自由度ロボットの姿勢制御方式
JPH06143172A (ja) * 1992-10-30 1994-05-24 Fujitsu Ltd 冗長マニピュレータの制御方式
JP3331674B2 (ja) * 1993-05-07 2002-10-07 株式会社安川電機 ７軸多関節ロボットマニピュレータの肘回転方法
JPH07132474A (ja) 1993-11-02 1995-05-23 Fujitsu Ltd マニピュレータ制御装置
JP3207728B2 (ja) * 1995-10-11 2001-09-10 三菱重工業株式会社 冗長マニピュレータの制御方法
US7386364B2 (en) * 2002-03-15 2008-06-10 Sony Corporation Operation control device for leg-type mobile robot and operation control method, and robot device
US7072740B2 (en) * 2002-12-16 2006-07-04 Sony Corporation Legged mobile robot
WO2004082900A1 (ja) * 2003-03-23 2004-09-30 Sony Corporation ロボット装置及びその制御方法
JP4735795B2 (ja) 2003-12-26 2011-07-27 独立行政法人 宇宙航空研究開発機構 冗長マニピュレータの制御方法
WO2005075156A1 (ja) * 2004-02-06 2005-08-18 Honda Motor Co., Ltd. 移動ロボットの歩容生成装置
DE102005054575B3 (de) * 2005-11-16 2007-04-26 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Regelung eines Roboterarms sowie Roboter zur Durchführung des Verfahrens
JP4481291B2 (ja) * 2006-12-01 2010-06-16 本田技研工業株式会社 ロボット、ならびにその制御方法および制御プログラム
JP4316630B2 (ja) * 2007-03-29 2009-08-19 本田技研工業株式会社 ロボット、ロボットの制御方法およびロボットの制御プログラム
JP5109098B2 (ja) * 2007-06-14 2012-12-26 本田技研工業株式会社 運動制御システム、運動制御方法および運動制御プログラム
JP4552037B2 (ja) * 2007-12-10 2010-09-29 本田技研工業株式会社 ロボット
WO2010060475A1 (en) * 2008-11-26 2010-06-03 Abb Research Ltd. Industrial robot
KR20110041950A (ko) * 2009-10-16 2011-04-22 삼성전자주식회사 여유자유도 제어를 이용한 로봇의 교시 및 재현 방법
JP5499647B2 (ja) * 2009-11-10 2014-05-21 株式会社安川電機 ロボット及びロボットシステム
JP5371733B2 (ja) * 2009-12-25 2013-12-18 川崎重工業株式会社 ７軸多関節ロボットの制御方法及び制御プログラム
JP5701055B2 (ja) * 2010-12-28 2015-04-15 川崎重工業株式会社 ７軸多関節ロボットの制御方法、制御プログラム及びロボット制御装置

Also Published As

Publication number Publication date
US20150148950A1 (en) 2015-05-28
US20130218331A1 (en) 2013-08-22
JP2013166222A (ja) 2013-08-29
US8977392B2 (en) 2015-03-10
CN103252779A (zh) 2013-08-21

Similar Documents

Publication Publication Date Title
JP5948932B2 (ja) ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム
JP2014018912A (ja) ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム
US9149931B2 (en) Robot system, robot control device and method for controlling robot
WO2018090323A1 (zh) 一种坐标系标定方法、系统及装置
JP3655083B2 (ja) ロボットの位置決めを行うインタフェース装置
Zha Optimal pose trajectory planning for robot manipulators
US9193072B2 (en) Robot and control method thereof
KR101498835B1 (ko) 7축 다관절 로봇의 제어방법, 제어 프로그램 및 로봇 제어장치
JP2013505147A (ja) 人間型ロボット
EP2709802A2 (en) Haptic device for manipulator and vehicle control
US9014854B2 (en) Robot and control method thereof
Lambert et al. A 7-DOF redundantly actuated parallel haptic device combining 6-DOF manipulation and 1-DOF grasping
JP2012139754A (ja) ７軸多関節ロボットの制御装置および教示方法
Li et al. Optimization of dynamic load distribution of a serial-parallel hybrid humanoid arm
KR102168774B1 (ko) 로봇의 마스터 장치 및 이를 구비하는 로봇 제어 시스템
JP5948914B2 (ja) ロボット制御装置、ロボット制御方法、ロボット制御プログラムおよびロボットシステム
CN109311158B (zh) 连杆促动装置的操作装置和连杆促动系统
JP2012192518A (ja) 冗長関節部を有する冗長ロボットの制御装置および制御方法
Gienger et al. Exploiting task intervals for whole body robot control
Li et al. A novel orientability index and the kinematic design of the RemoT-ARM: A haptic master with large and dexterous workspace
JP4230196B2 (ja) 位置決め演算方法および位置決め演算装置
KR102116119B1 (ko) 마스터 로봇 및 그 제어 방법
JP5755715B2 (ja) ロボットの制御方法
Lai A fast task planning system for 6R articulated robots based on inverse kinematics
JP2013208671A (ja) ロボット制御方法、ロボット制御装置、及びロボット制御システム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150203

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20151215

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20151216

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160126

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: 20160510

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160523

R150 Certificate of patent or registration of utility model

Ref document number: 5948932

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees