JP2022086241A - モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法 - Google Patents

モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法 Download PDF

Info

Publication number
JP2022086241A
JP2022086241A JP2020198146A JP2020198146A JP2022086241A JP 2022086241 A JP2022086241 A JP 2022086241A JP 2020198146 A JP2020198146 A JP 2020198146A JP 2020198146 A JP2020198146 A JP 2020198146A JP 2022086241 A JP2022086241 A JP 2022086241A
Authority
JP
Japan
Prior art keywords
operation history
storage unit
motor
information data
position information
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
JP2020198146A
Other languages
English (en)
Inventor
涼介 今井
Ryosuke Imai
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 JP2020198146A priority Critical patent/JP2022086241A/ja
Priority to CN202111435239.8A priority patent/CN114577143A/zh
Priority to US17/536,264 priority patent/US11789426B2/en
Publication of JP2022086241A publication Critical patent/JP2022086241A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • 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
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/402—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for positioning, e.g. centring a tool relative to a hole in the workpiece, additional detection means to correct position
    • 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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G01B11/26—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
    • 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • 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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/30—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
    • H02P29/02—Providing protection against overload without automatic interruption of supply
    • H02P29/024—Detecting a fault condition, e.g. short circuit, locked rotor, open circuit or loss of load
    • 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/34465—Safety, control of correct operation, abnormal states
    • 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/39001—Robot, manipulator 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/39412—Diagnostic of robot, estimation of parameters
    • 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/50—Machine tool, machine tool null till machine tool work handling
    • G05B2219/50102—Store history of operation, after power failure, restart from history, journal

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Automation & Control Theory (AREA)
  • Power Engineering (AREA)
  • Manipulator (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
  • Control Of Electric Motors In General (AREA)

Abstract

【課題】解析のための搬送コストの低減や解析の柔軟性向上を図ることができるモーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法を提供すること。【解決手段】モーター制御用角度センサーは、モーターの駆動に応じた信号を出力するセンサーと、演算処理部と、動作履歴一時記憶部と、動作履歴保存部と、を有し、前記演算処理部は、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または外部装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存する。【選択図】図４

Description

本発明は、モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法に関する。
特許文献１には、ロボットの動作に異常が発生したときに、制御装置内の故障履歴メモリー部にエラー時の動作履歴を残し、その後のエラー発生原因の解析を容易にするロボット制御装置が記載されている。
特開平４－１３０５０３号公報
しかしながら、このような構成では、エラー発生原因の解析を行うためには故障履歴メモリー部を持つロボット制御装置を解析する必要がある。そのため、例えば、ロボットの駆動に用いられるモーターの回転量を検出する角度センサーに異常が生じた場合でも、角度センサーではなくロボット制御装置を解析する必要がある。ロボット制御装置は、角度センサーよりもサイズが大きく、解析のための搬送コストの増加や、解析の柔軟性低下に繋がるという課題があった。
本発明のモーター制御用角度センサーは、モーターの駆動に応じた信号を出力するセンサーと、
演算処理部と、
動作履歴一時記憶部と、
動作履歴保存部と、を有し、
前記演算処理部は、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または外部装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存する。
本発明のモーター制御システムは、モーターと、
前記モーターの駆動に応じた信号を出力するセンサーと、
演算処理部と、
動作履歴一時記憶部と、
動作履歴保存部と、
前記モーターの駆動を制御する制御装置と、を有し、
前記演算処理部は、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または前記制御装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存する。
本発明のモーター制御用角度センサーの制御方法は、モーターと、
前記モーターの駆動に応じた信号を出力するセンサーと、
演算処理部と、
動作履歴一時記憶部と、
動作履歴保存部と、
前記モーターの駆動を制御する制御装置と、を有するモーター制御用角度センサーの制御方法であって、
前記演算処理部は、前記制御装置からリクエスト信号を受信する度に、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または前記制御装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存する。
本発明の実施形態に係るロボットシステムを示す全体図である。 駆動装置の断面図である。 駆動装置の断面図である。 駆動装置のブロック図である。 駆動装置が有する演算処理部が生成する位置情報データの一例を示す図である。 駆動装置が有する演算処理部の処理工程を示すフローチャートである。 駆動装置が有する演算処理部の異常検出方法を説明するためのグラフである。 駆動装置が有する演算処理部の異常検出方法を説明するためのグラフである。 駆動装置が有する演算処理部の異常検出方法を説明するためのグラフである。 駆動装置が有する演算処理部の異常検出方法を説明するためのグラフである。 駆動装置の変形例を示すブロック図である。 駆動装置の変形例を示すブロック図である。 駆動装置の変形例を示すブロック図である。
以下、本発明のモーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法を添付図面に示す好適な実施形態に基づいて詳細に説明する。
図１は、本発明の実施形態に係るロボットシステムを示す全体図である。図２および図３は、それぞれ、駆動装置の断面図である。図４は、駆動装置のブロック図である。図５は、駆動装置が有する演算処理部が生成する位置情報データの一例を示す図である。図６は、駆動装置が有する演算処理部の処理工程を示すフローチャートである。図７ないし図１０は、それぞれ、駆動装置が有する演算処理部の異常検出方法を説明するためのグラフである。
なお、図２および図３には互いに直交する３軸であるＸ軸、Ｙ軸およびＺ軸を図示している。また、Ｘ軸、Ｙ軸およびＺ軸を示す各矢印の先端側を「＋」、基端側を「－」とする。また、Ｘ軸に平行な方向を「Ｘ軸方向」といい、Ｙ軸に平行な方向を「Ｙ軸方向」といい、Ｚ軸に平行な方向を「Ｚ軸方向」という。また、＋Ｚ軸方向側を「上」、－Ｚ軸方向側を「下」ともいう。図３は、図２をＺ軸まわりに９０°回転させた断面図である。
図１に示すロボットシステム１は、精密機器やこれを構成する部品の給材、除材、搬送および組立等の作業を行うことができる。ロボットシステム１は、所定の作業を実行するロボット２と、ロボット２の駆動を制御する外部装置としてのロボット制御装置３と、を有する。
ロボット２は、６軸ロボットである。ロボット２は、床、壁、天井等に固定されるベース２０と、ベース２０に支持されたロボットアーム２１と、ロボットアーム２１の先端に装着されたエンドエフェクター２２と、を有する。また、ロボットアーム２１は、ベース２０に回動自在に連結されたアーム２１１と、アーム２１１に回動自在に連結されたアーム２１２と、アーム２１２に回動自在に連結されたアーム２１３と、アーム２１３に回動自在に連結されたアーム２１４と、アーム２１４に回動自在に連結されたアーム２１５と、アーム２１５に回動自在に連結されたアーム２１６と、を有する。そして、アーム２１６にエンドエフェクター２２が装着されている。
ただし、ロボット２の構成は、特に限定されず、例えば、アームの数は、１本以上５本以下であってもよいし７本以上であってもよい。また、例えば、ロボット２は、スカラーロボット、双腕ロボット等であってもよい。
ロボット２は、ベース２０に対してアーム２１１を回動させる駆動装置４１と、アーム２１１に対してアーム２１２を回動させる駆動装置４２と、アーム２１２に対してアーム２１３を回動させる駆動装置４３と、アーム２１３に対してアーム２１４を回動させる駆動装置４４と、アーム２１４に対してアーム２１５を回動させる駆動装置４５と、アーム２１５に対してアーム２１６を回動させる駆動装置４６と、を有する。これら駆動装置４１～４６は、それぞれ、ロボット制御装置３によって独立して制御される。
ロボット制御装置３は、図示しないホストコンピューターからの位置指令を受けて、各アーム２１１～２１６が前記位置指令に応じた位置となるように駆動装置４１～４６の駆動を独立して制御する。ロボット制御装置３は、例えば、コンピューターから構成され、情報を処理するプロセッサー（ＣＰＵ）と、プロセッサーに通信可能に接続されたメモリーと、外部インターフェースと、を有する。また、メモリーにはプロセッサーにより実行可能な各種プログラムが保存され、プロセッサーは、メモリーに記憶された各種プログラム等を読み込んで実行することができる。
次に、駆動装置４１～４６について説明するが、これらは互いに同様の構成であるため、以下では、駆動装置４１について代表して説明し、その他の駆動装置４２～４６についてはその説明を省略する。駆動装置４１は、モーター制御システムであり、図２に示すように、モーター５と、モーター５の回転軸の回転状態を検出するモーター制御用角度センサー６と、を有する。
モーター５は、２相ＡＣブラシレスモーター、３相ＡＣブラシレスモーター、３相同期モーター等の各種モーターである。モーター５は、Ｚ軸に平行な軸線ａＺに沿って配置された回転軸５１と、回転軸５１に固定されたローター５２と、ローター５２の周囲に配置されたステーター５３と、これらを収納すると共にステーター５３を支持する筒状のハウジング５４と、回転軸５１をハウジング５４に対して軸線ａＺまわりに回転可能に支持する軸受５５、５６と、を有する。また、ハウジング５４は、ベース２０に固定されている。また、回転軸５１のモーター制御用角度センサー６とは反対側の端部にはアーム２１１が接続されている。これにより、モーター５の出力がベース２０からアーム２１１に伝達され、ベース２０に対してアーム２１１が回動する。なお、回転軸５１は、必要に応じて減速機等の歯車装置を介してアーム２１１に接続されていてもよい。
モーター制御用角度センサー６は、エンコーダーユニットであり、モーター５の上側すなわち＋Ｚ軸側に配置されている。モーター制御用角度センサー６は、回転角度検出型の光学式エンコーダー６１と、多回転検出型の磁気式エンコーダー６２と、基板６３と、を有する。これら各部は、ハウジング５４に固定されたハウジング６８内に収納されている。
光学式エンコーダー６１は、反射型の光学式エンコーダーであり、モーター５の回転軸５１に固定された光学スケール６１１と、光学スケール６１１の回転状態を検出する光学センサー６１２と、を有する。光学スケール６１１は、回転軸５１と共に軸線ａＺまわりに回転する。光学スケール６１１は、モーター５の回転軸５１に固定されたハブ６１１ａと、ハブ６１１ａに固定されたディスク６１１ｂと、を有する。ディスク６１１ｂの上面には、ディスク６１１ｂの回転角度や回転速度を検出し得る図示しない検出用パターンが形成されている。検出用パターンとしては、特に限定されず、例えば、軸線ａＺを中心とする周方向に沿って、光の反射率の異なる２つの領域つまり反射領域と非反射領域とを交互に並べたパターンが挙げられる。
光学センサー６１２は、ディスク６１１ｂの上側にディスク６１１ｂと離間して配置されている。光学センサー６１２は、ディスク６１１ｂ上の検出用パターンに向けて光Ｌを出射する発光素子６１２ａと、検出用パターンで反射した光Ｌを受光する受光素子６１２ｂと、を有する。発光素子６１２ａは、例えば、レーザダイオード、発光ダイオードであり、受光素子６１２ｂは、例えば、フォトダイオードである。このような構成の光学式エンコーダー６１では、ディスク６１１ｂの軸線ａＺまわりの回転に伴って受光素子６１２ｂからの出力信号の波形が変化する。そのため、この出力信号に基づいて、ディスク６１１ｂの３６０°範囲内での回転角度θを検出することができる。ただし、光学式エンコーダー６１の構成は、特に限定されない。
磁気式エンコーダー６２は、光学センサー６１２の上側すなわち＋Ｚ軸側に配置されている。磁気式エンコーダー６２は、回転軸５１に固定された主歯車６２１と、主歯車６２１に噛合する２つの副歯車６２２ａ、６２２ｂと、副歯車６２２ａ、６２２ｂに固定された磁石６２３ａ、６２３ｂと、磁石６２３ａ、６２３ｂの回転状態を検出する磁気センサー６２４ａ、６２４ｂと、を有する。
主歯車６２１は、回転軸５１と共に軸線ａＺまわりに回転する。副歯車６２２ａは、軸線ａＺに平行な軸線ａＺ１まわりに回転可能に軸支され、主歯車６２１に従動して主歯車６２１との歯車比に応じた回転量で回転する。同様に、副歯車６２２ｂは、軸線ａＺに平行な軸線ａＺ２まわりに回転可能に軸支され、主歯車６２１に従動して主歯車６２１との歯車比に応じた回転量で回転する。主歯車６２１、副歯車６２２ａおよび副歯車６２２ｂの歯数は、互いに異なっており、特に本実施形態では互いに素の関係となっている。
磁石６２３ａは、副歯車６２２ａに固定されている。そのため、磁石６２３ａは、副歯車６２２ａと共に軸線ａＺ１まわりに回転する。同様に、磁石６２３ｂは、副歯車６２２ｂに固定されている。そのため、磁石６２３ｂは、副歯車６２２ｂと共に軸線ａＺ２まわりに回転する。磁石６２３ａ、６２３ｂは、例えば、ネオジム磁石、フェライト磁石、サマリウムコバルト磁石、アルニコ磁石、ボンド磁石等の永久磁石であり、軸線ａＺ１、ａＺ２まわりの回転に伴って磁界の方向が変化するように配置されている。
磁気センサー６２４ａ、６２４ｂは、磁石６２３ａ、６２３ｂの下側すなわち－Ｚ軸側に配置されている。このうち、磁気センサー６２４ａは、磁石６２３ａと対向して配置され、磁石６２３ａの磁界の方向つまり副歯車６２２ａの３６０°範囲内での回転角度に応じた信号を出力する。一方、磁気センサー６２４ｂは、磁石６２３ｂに対向して配置され、磁石６２３ｂの磁界の方向つまり副歯車６２２ｂの３６０°範囲内での回転角度に応じた信号を出力する。このような構成の磁気式エンコーダー６２では、磁気センサー６２４ａ、６２４ｂからの信号の値の組み合わせにより回転軸５１の回転数ｎを検出することができる。ただし、磁気式エンコーダー６２の構成は、特に限定されない。
基板６３は、光学式エンコーダー６１と磁気式エンコーダー６２との間に配置されている。基板６３は、配線基板であり、ハウジング６８に固定されている。基板６３の下面６３１には、光学スケール６１１と対向して光学センサー６１２が実装されており、上面６３２には、磁石６２３ａ、６２３ｂと対向して磁気センサー６２４ａ、６２４ｂが実装されている。
また、基板６３の下面６３１の光学センサー６１２と重ならない位置には、光学センサー６１２および磁気センサー６２４ａ、６２４ｂと電気的に接続された半導体素子６４が実装されている。半導体素子６４は、例えば、コンピューターで構成され、情報を処理するプロセッサー（ＣＰＵ）と、プロセッサーに通信可能に接続されたメモリーと、外部インターフェースと、を有する。また、メモリーにはプロセッサーにより実行可能な各種プログラムが保存され、プロセッサーは、メモリーに記憶された各種プログラム等を読み込んで実行することができる。
また、図３に示すように、基板６３の上面６３２にはコネクター６５が実装されている。そして、コネクター６５に接続された配線６６を介して半導体素子６４とロボット制御装置３とが電気的に接続されている。
以上、駆動装置４１の構成について説明した。なお、以下では、光学センサー６１２および磁気センサー６２４ａ、６２４ｂをセンサー６０とも言う。次に、駆動装置４１に含まれている半導体素子６４について詳細に説明する。図４に示すように、半導体素子６４は、演算処理部６４１と、動作履歴一時記憶部６４２と、動作履歴保存部６４３と、タイマー６４４と、温度センサー６９と、を有する。このように、演算処理部６４１と、動作履歴一時記憶部６４２と、動作履歴保存部６４３と、タイマー６４４と、温度センサー６９と、を１つの半導体装置６４に設けることにより、駆動装置４１の小型化を図ることができる。ただし、これに限定されず、これらのうちの少なくとも１つは、半導体素子６４外に設けられていてもよい。
動作履歴一時記憶部６４２は、ＲＡＭ（ランダムアクセスメモリー）であり、動作履歴保存部６４３は、ＲＯＭ（ロードオンリーメモリー）である。そのため、動作履歴一時記憶部６４２に記憶されたデータは、駆動装置４１の電源が落とされると消去され、動作履歴保存部６４３に保存されたデータは、駆動装置４１の電源が落とされてもそのまま保存される。また、温度センサー６９は、モーター５の温度を検出する。
演算処理部６４１は、センサー６０からの出力に基づいて回転軸５１の回転量Ｒを検出する。具体的には、電源投入時に磁気センサー６２４ａ、６２４ｂの出力に基づいてモーター５の回転軸５１の回転数ｎを検出し、その後は、検出した回転数ｎに対して光学センサー６１２の出力（パルス信号）に基づいて検出した回転軸５１の回転角度θを加減することにより回転量Ｒを検出する。ただし、回転量Ｒの検出方法としては、特に限定されない。
図５に示すように、演算処理部６４１は、回転量Ｒと、回転量Ｒを取得した時刻Ｔｉと、回転量Ｒを取得した時刻Ｔｉにおけるモーター５の温度Ｔｅと、を含む位置情報データＤｒを生成する。そして、演算処理部６４１は、生成した位置情報データＤｒを動作履歴一時記憶部６４２に一時的に記憶する処理を行うと共に、ロボット制御装置３に送信する処理を行う。なお、時刻Ｔｉは、タイマー６４４で生成されるクロックに基づいた時刻であり、カウント数で示される。また、モーター５の温度Ｔｅは、温度センサー６９により検出された温度である。
図６に示すように、演算処理部６４１は、ロボット制御装置３から定期的に送信されるリクエスト信号Ｓｒを受信する毎に位置情報データＤｒを生成し、生成した位置情報データＤｒを動作履歴一時記憶部６４２に一時的に記憶すると共にロボット制御装置３に送信する。これにより、不必要な位置情報データＤｒの生成や送信を防止することができ、処理負担を軽減することができる。このような処理を繰り返し行う中で、演算処理部６４１は、駆動装置４１の異常を検知したり、ロボット制御装置３から異常を知らせる信号であるエラーフラグＦｅを受信したりした場合、リクエスト信号Ｓｒを受信する毎に動作履歴一時記憶部６４２に記憶し続けた多数の位置情報データＤｒの中から必要な位置情報データＤｒを選択し、異常発生日時を紐付けて動作履歴保存部６４３に保存する。
図６に示す例では、演算処理部６４１は、ｎ回目のリクエスト信号Ｓｒに対応する位置情報データＤｒに基づいて駆動装置４１の異常を検知したため、電源投入からｎ回目のリクエスト信号Ｓｒまでに生成され、動作履歴一時記憶部６４２に記憶された多数の位置情報データＤｒのうち、直近５つの位置情報データＤｒつまりｎ－４回目のリクエスト信号Ｓｒに対応する位置情報データＤｒからｎ回目のリクエスト信号Ｓｒに対応する位置情報データＤｒを選択し、これらと異常発生日時すなわちｎ回目のリクエスト信号Ｓｒに対応する時刻Ｔｉに相当する日時とを紐付けて、動作履歴保存部６４３に保存する。
これにより、駆動装置４１の異常を検知した回を含む直近複数回の位置情報データＤｒは、電源が落とされても保存される。そのため、その後、動作履歴保存部６４３に保存された位置情報データＤｒを解析することにより、異常の原因を解析することが可能となる。駆動装置４１は、ロボット制御装置３よりもサイズが小さいため、従来と比べて異常の解析のための搬送コストの削減や、解析の柔軟性向上を図ることができる。また、異常発生の再現が不要となり、異常の解析が容易となる。また、位置情報データＤｒに温度Ｔｅが含まれているため、異常時のモーター５の状態を確認することもでき、異常の解析をより精度よく行うことができる。
ここで、動作履歴一時記憶部６４２は、リングバッファで構成されている。これにより、最新の位置情報データＤｒを逐次記憶することができる。また、動作履歴一時記憶部６４２の容量を小さくすることができるため、つまり、上記の例で言えば少なくとも５回分の位置情報データＤｒを保存できる容量があればよいため、駆動装置４１の低コスト化を図ることもできる。
動作履歴保存部６４３に保存する位置情報データＤｒの数は、５つに限定されず、適宜設定することができる。また、例えば、動作履歴一時記憶部６４２に一時的に記憶された全ての位置情報データＤｒを動作履歴保存部６４３に保存してもよい。つまり、電源投入後から異常を検知するまでの間に生成された全ての位置情報データＤｒを動作履歴保存部６４３に保存してもよい。また、異常検知前だけでなく、検知後の位置情報データＤｒについても併せて動作履歴保存部６４３に保存してもよい。例えば、ｎ回目のリクエスト信号Ｓｒに対応する位置情報データＤｒの異常を検知した場合、ｎ－４回目のリクエスト信号Ｓｒに対応する位置情報データＤｒからｎ＋４回目のリクエスト信号Ｓｒに対応する位置情報データＤｒを動作履歴保存部６４３に保存してもよい。これにより、その異常が突発的なものなのか、慢性的なものなのかを解析し易くなる。
なお、前記「駆動装置４１の異常」としては、特に限定されないが、例えば、以下のような例が挙げる。例えば、図７に示すように、ｎ－１回目のリクエスト信号Ｓｒに対応する回転量Ｒに対して直後のｎ回目のリクエスト信号Ｓｒに対応する回転量Ｒの出力が急増した場合、演算処理部６４１は、光学式エンコーダー６１の異常を検知する。また、例えば、図８に示すように、ｎ－１回目のリクエスト信号Ｓｒに対応する時刻Ｔｉを示すカウント数に対して直後のｎ回目のリクエスト信号Ｓｒに対応する時刻Ｔｉを示すカウント数が急増した場合、演算処理部６４１は、リクエスト信号Ｓｒの受信失敗を疑い、配線６６の断線、ノイズの発生等の異常を検知する。また、例えば、図９に示すように、ｎ－１回目のリクエスト信号Ｓｒに対応する温度Ｔｅに対して直後のｎ回目のリクエスト信号Ｓｒに対応する温度Ｔｅが急増した場合、演算処理部６４１は、温度センサー６９の異常を検知する。また、例えば、図１０に示すように、温度Ｔｅが閾値ＳＨを超えた場合、演算処理部６４１は、モーター５の異常を検知する。このように、駆動装置４１によれば、急変するパラメータに基づいて、異常がどの要素に起因したものであるかを推定することもできる。そのため、その後の異常の解析がより容易となる。
また、「ロボット制御装置３がエラーフラグＦｅを送信する場合」としては、特に限定されないが、例えば、リクエスト信号Ｓｒに応じた位置情報データＤｒの送信がない場合、位置情報データＤｒに含まれる回転量Ｒが位置指令から大きく乖離している場合、駆動装置４１以外の要素で異常が発生した場合等が挙げられる。
以上、ロボットシステム１について説明した。このようなロボットシステム１に含まれるモーター制御用角度センサー６は、前述したように、モーター５の駆動に応じた信号を出力するセンサー６０と、演算処理部６４１と、動作履歴一時記憶部６４２と、動作履歴保存部６４３と、を有する。そして、演算処理部６４１は、センサー６０から出力される信号に基づいて取得したモーター５の位置としての回転量Ｒおよび回転量Ｒを取得した時刻Ｔｉを含む位置情報データＤｒを生成し、生成した位置情報データＤｒを動作履歴一時記憶部６４２に記憶する処理を繰り返し、異常を検知した場合または外部装置としてのロボット制御装置３から異常を知らせる信号を受信した場合に、動作履歴一時記憶部６４２に記憶されている位置情報データＤｒを動作履歴保存部６４３に保存する。このような構成によれば、異常を検知した回またはロボット制御装置３から異常を知らせる信号を受信した回を含む直近複数回の位置情報データＤｒについては電源が落とされても保存される。そのため、その後、動作履歴保存部６４３に保存された位置情報データＤｒを解析することにより、異常の原因を解析することが可能となる。ここで、モーター制御用角度センサー６は、ロボット制御装置３よりもサイズが小さいため、従来と比べて異常解析のための搬送コストの削減や、解析の柔軟性向上を図ることができる。特に、位置情報データＤｒに時刻Ｔｉが含まれているため、例えば、異常がセンサー６０の異常なのか、あるいは、ロボット制御装置３との通信異常なのかを容易に判断できるようにもなる。
また、前述したように、演算処理部６４１は、ロボット制御装置３からのリクエスト信号Ｓｒに応じて位置情報データＤｒを生成し、生成した位置情報データＤｒを動作履歴一時記憶部６４２に記憶する。これにより、不必要な位置情報データＤｒの生成や、動作履歴一時記憶部６４２への記憶を抑えることができる。
また、前述したように、演算処理部６４１は、ロボット制御装置３からのリクエスト信号Ｓｒに応じて位置情報データＤｒを生成し、生成した位置情報データＤｒをロボット制御装置３に送信する。これにより、不必要な位置情報データＤｒの生成や、ロボット制御装置３への送信を抑えることができる。
また、前述したように、動作履歴一時記憶部６４２は、リングバッファで構成されている。これにより、最新の位置情報データＤｒを逐次記憶することができる。また、動作履歴一時記憶部６４２の容量を小さくすることができるため、モーター制御用角度センサー６の低コスト化を図ることもできる。
また、前述したように、モーター制御用角度センサー６は、モーター５の温度Ｔｅを検出する温度センサー６９を有する。そして、演算処理部６４１は、回転量Ｒおよび時刻Ｔｉに加えて、時刻Ｔｉにおけるモーター５の温度Ｔｅを含む位置情報データＤｒを生成する。これにより、モーター制御用角度センサー６は、センサー６０の異常だけではなく、モーター５の異常を検知することができる。
また、前述したように、演算処理部６４１、動作履歴一時記憶部６４２および動作履歴保存部６４３は、１つの半導体素子６４に含まれている。これにより、モーター制御用角度センサー６の小型化を図ることができる。
また、前述したように、モーター制御システムとしての駆動装置４１は、モーター５と、モーター５の駆動に応じた信号を出力するセンサー６０と、演算処理部６４１と、動作履歴一時記憶部６４２と、動作履歴保存部６４３と、モーター５の駆動を制御する制御装置としてのロボット制御装置３、を有する。そして、演算処理部６４１は、センサー６０から出力される信号に基づいて取得したモーター５の位置である回転量Ｒおよび回転量Ｒを取得した時刻Ｔｉを含む位置情報データＤｒを生成し、生成した位置情報データＤｒを動作履歴一時記憶部６４２に記憶する処理を繰り返し、異常を検知した場合またはロボット制御装置３から異常を知らせる信号を受信した場合に、動作履歴一時記憶部６４２に記憶されている位置情報データＤｒを動作履歴保存部６４３に保存する。このような構成によれば、異常を検知した回またはロボット制御装置３から異常を知らせる信号を受信した回を含む直近複数回の位置情報データＤｒについては電源が落とされても保存される。そのため、その後、動作履歴保存部６４３に保存された位置情報データＤｒを解析することにより、異常の原因を解析することが可能となる。ここで、駆動装置４１は、ロボット制御装置３よりもサイズが小さいため、従来と比べて異常解析のための搬送コストの削減や、解析の柔軟性向上を図ることができる。
また、前述したように、モーター５と、モーター５の駆動に応じた信号を出力するセンサー６０と、演算処理部６４１と、動作履歴一時記憶部６４２と、動作履歴保存部６４３と、モーター５の駆動を制御するロボット制御装置３、を有するモーター制御システムとしての駆動装置４１の制御方法では、演算処理部６４１は、ロボット制御装置３からリクエスト信号を受信する度に、センサー６０から出力される信号に基づいて取得したモーター５の回転量Ｒおよび回転量Ｒを取得した時刻Ｔｉを含む位置情報データＤｒを生成し、生成した位置情報データＤｒを動作履歴一時記憶部６４２に記憶する処理を繰り返し、異常を検知した場合またはロボット制御装置３から異常を知らせる信号を受信した場合に、動作履歴一時記憶部６４２に記憶されている位置情報データＤｒを動作履歴保存部６４３に保存する。このような方法によれば、異常を検知した回またはロボット制御装置３から異常を知らせる信号を受信した回を含む直近複数回の位置情報データＤｒについては電源が落とされても保存される。そのため、その後、動作履歴保存部６４３に保存された位置情報データＤｒを解析することにより、異常の原因を解析することが可能となる。ここで、駆動装置４１は、ロボット制御装置３よりもサイズが小さいため、従来と比べて異常解析のための搬送コストの削減や、解析の柔軟性向上を図ることができる。
以上、本発明のモーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法を図示の実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置換することができる。また、本発明に、他の任意の構成物が付加されていてもよい。また、前述した実施形態では、モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法をロボットシステムに適用した例について説明したが、モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法は、ロボットシステム以外の各種電子機器にも適用することができる。
また、前述した実施形態では、温度センサー６９が半導体素子６４内に配置されているが、これに限定されず、例えば、図１１および図１２に示すように、半導体素子６４外に配置されていてもよい。また、前述した実施形態では、動作履歴保存部６４３が半導体素子６４内に配置されているが、これに限定されず、図１３に示すように、半導体素子６４外に配置されていてもよい。
１…ロボットシステム、２…ロボット、２０…ベース、２１…ロボットアーム、２１１…アーム、２１２…アーム、２１３…アーム、２１４…アーム、２１５…アーム、２１６…アーム、２２…エンドエフェクター、３…ロボット制御装置、４１…駆動装置、４２…駆動装置、４３…駆動装置、４４…駆動装置、４５…駆動装置、４６…駆動装置、５…モーター、５１…回転軸、５２…ローター、５３…ステーター、５４…ハウジング、５５…軸受、５６…軸受、６…モーター制御用角度センサー、６０…センサー、６１…光学式エンコーダー、６１１…光学スケール、６１１ａ…ハブ、６１１ｂ…ディスク、６１２…光学センサー、６１２ａ…発光素子、６１２ｂ…受光素子、６２…磁気式エンコーダー、６２１…主歯車、６２２ａ…副歯車、６２２ｂ…副歯車、６２３ａ…磁石、６２３ｂ…磁石、６２４ａ…磁気センサー、６２４ｂ…磁気センサー、６３…基板、６３１…下面、６３２…上面、６４…半導体素子、６４１…演算処理部、６４２…動作履歴一時記憶部、６４３…動作履歴保存部、６４４…タイマー、６５…コネクター、６６…配線、６８…ハウジング、６９…温度センサー、Ｄｒ…位置情報データ、Ｆｅ…エラーフラグ、Ｌ…光、Ｒ…回転量、ＳＨ…閾値、Ｓｒ…リクエスト信号、Ｔｅ…温度、Ｔｉ…時刻、ａＺ…軸線、ａＺ１…軸線、ａＺ２…軸線、ｎ…回転数

Claims (8)

  1. モーターの駆動に応じた信号を出力するセンサーと、
    演算処理部と、
    動作履歴一時記憶部と、
    動作履歴保存部と、を有し、
    前記演算処理部は、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または外部装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存することを特徴とするモーター制御用角度センサー。
  2. 前記演算処理部は、前記外部装置からのリクエスト信号に応じて前記位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する請求項１に記載のモーター制御用角度センサー。
  3. 前記演算処理部は、前記外部装置からのリクエスト信号に応じて前記位置情報データを生成し、生成した前記位置情報データを前記外部装置に送信する請求項１または２に記載のモーター制御用角度センサー。
  4. 前記動作履歴一時記憶部は、リングバッファで構成されている請求項１ないし３のいずれか１項に記載のモーター制御用角度センサー。
  5. 前記モーターの温度を検出する温度センサーを有し、
    前記演算処理部は、前記位置および前記時刻に加えて、前記時刻における前記モーターの温度を含む前記位置情報データを生成する請求項１ないし４のいずれか１項に記載のモーター制御用角度センサー。
  6. 前記演算処理部、前記動作履歴一時記憶部および前記動作履歴保存部は、１つの半導体素子に含まれている請求項１ないし５のいずれか１項に記載のモーター制御用角度センサー。
  7. モーターと、
    前記モーターの駆動に応じた信号を出力するセンサーと、
    演算処理部と、
    動作履歴一時記憶部と、
    動作履歴保存部と、
    前記モーターの駆動を制御する制御装置と、を有し、
    前記演算処理部は、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または前記制御装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存することを特徴とするモーター制御システム。
  8. モーターと、
    前記モーターの駆動に応じた信号を出力するセンサーと、
    演算処理部と、
    動作履歴一時記憶部と、
    動作履歴保存部と、
    前記モーターの駆動を制御する制御装置と、を有するモーター制御用角度センサーの制御方法であって、
    前記演算処理部は、前記制御装置からリクエスト信号を受信する度に、前記センサーから出力される信号に基づいて取得した前記モーターの位置および前記位置を取得した時刻を含む位置情報データを生成し、生成した前記位置情報データを前記動作履歴一時記憶部に記憶する処理を繰り返し、異常を検知した場合または前記制御装置から異常を知らせる信号を受信した場合に、前記動作履歴一時記憶部に記憶されている前記位置情報データを動作履歴保存部に保存することを特徴とするモーター制御用角度センサーの制御方法。
JP2020198146A 2020-11-30 2020-11-30 モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法 Pending JP2022086241A (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020198146A JP2022086241A (ja) 2020-11-30 2020-11-30 モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法
CN202111435239.8A CN114577143A (zh) 2020-11-30 2021-11-29 电机控制用角度传感器及其控制方法、电机控制系统
US17/536,264 US11789426B2 (en) 2020-11-30 2021-11-29 Motor control angle sensor, motor control system, and control method for motor control angle sensor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020198146A JP2022086241A (ja) 2020-11-30 2020-11-30 モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法

Publications (1)

Publication Number Publication Date
JP2022086241A true JP2022086241A (ja) 2022-06-09

Family

ID=81752452

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020198146A Pending JP2022086241A (ja) 2020-11-30 2020-11-30 モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法

Country Status (3)

Country Link
US (1) US11789426B2 (ja)
JP (1) JP2022086241A (ja)
CN (1) CN114577143A (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7480687B2 (ja) * 2020-11-26 2024-05-10 セイコーエプソン株式会社 エンコーダーユニット、駆動装置およびロボット

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4467436A (en) * 1981-10-26 1984-08-21 United States Robots, Inc. Robot arm controller with common bus memory
JP2633983B2 (ja) 1990-09-20 1997-07-23 株式会社三協精機製作所 ロボット制御装置
JP5336042B2 (ja) * 2006-12-18 2013-11-06 オークマ株式会社 工作機械における温度センサの異常検知方法
US9162444B2 (en) * 2012-11-30 2015-10-20 Seiko Epson Corporation Printing apparatus
JP5945973B2 (ja) * 2013-11-05 2016-07-05 株式会社安川電機 エンコーダ、エンコーダ付きモータ、サーボシステム、エンコーダの信号処理方法
KR101616682B1 (ko) * 2014-04-02 2016-04-29 미쓰비시덴키 가부시키가이샤 모터 제어 장치 및 모터 제어 시스템
DE102014213262A1 (de) * 2014-07-08 2016-01-14 Kuka Roboter Gmbh Maschine und Verfahren zum Betreiben einer Maschine
JP7118628B2 (ja) * 2017-12-01 2022-08-16 キヤノン株式会社 ロボット装置、およびロボット装置の制御方法

Also Published As

Publication number Publication date
US11789426B2 (en) 2023-10-17
CN114577143A (zh) 2022-06-03
US20220171362A1 (en) 2022-06-02

Similar Documents

Publication Publication Date Title
US9348331B2 (en) Robot apparatus and speed reducer state diagnosing method
EP3067164B1 (en) Joint driving apparatus and robot apparatus
US11413759B2 (en) Robot apparatus, control method for controlling the same, non-transitory computer-readable recording medium, manufacturing system, and method for manufacturing an article
CA2671803C (en) Method and system for low speed control of a video surveillance system motor
US20160114483A1 (en) Robot control method, robot apparatus, program, recording medium, and manufacturing method of assembly part
JP2019056564A (ja) 角度検出装置、回転量特定ユニットおよび回転駆動ユニット
EP1696216A1 (en) Method and device for measuring torque in a robot
JP2017159425A (ja) ロボット
CN114543846A (zh) 编码器单元、驱动装置以及机器人
JP2022086241A (ja) モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法
JP2005513979A (ja) 反作用を釣合わせた回転駆動機構
US11660746B2 (en) Separate moving and positioning modes for a robot, method providing separate moving and positioning modes for the robot, method of manufacturing a product, and a recording medium
JP2003070284A (ja) サーボ・アクチュエータ並びにその位置検出装置
JP7185495B2 (ja) 減速機システム、駆動ユニットへの指令値の補正方法、補正データの生成方法、及び減速機システムの製造方法
JP3370845B2 (ja) アブソリュートエンコーダ
CN116480769A (zh) 传动设备、调试方法、机器人及存储介质
WO2021153613A1 (ja) アブソリュートエンコーダ、アブソリュートエンコーダの角度誤差情報出力プログラム、アブソリュートエンコーダの角度誤差情報出力方法
US20220161439A1 (en) Information processing apparatus, information processing method, robot system, measurement system, method of manufacturing article with robot system, and recording medium
JP2023146062A (ja) エンコーダーユニットの状態検出方法、エンコーダーユニットおよびロボットシステム
JP6977363B2 (ja) トルク検出用モジュール、駆動装置、ステージ装置、ロボット装置、及び制御装置
JP2020062730A (ja) ロボット制御方法、ロボット装置、プログラム、記録媒体および物品の製造方法
JP2021085755A (ja) 検出装置、駆動装置、ロボット装置、検出方法、ロボット装置を用いた物品の製造方法、制御プログラムおよび記録媒体
JP2019035641A (ja) 位置検出器及び位置検出器を備えた検出システム
KR102578130B1 (ko) 자가 진단 기능을 갖는 엔코더
JP2023082269A (ja) エンコーダー、駆動装置、及びエンコーダーの組立方法

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20210915

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20211102

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20231013