JP6303888B2 - Actuator device - Google Patents

Actuator device Download PDF

Info

Publication number
JP6303888B2
JP6303888B2 JP2014147770A JP2014147770A JP6303888B2 JP 6303888 B2 JP6303888 B2 JP 6303888B2 JP 2014147770 A JP2014147770 A JP 2014147770A JP 2014147770 A JP2014147770 A JP 2014147770A JP 6303888 B2 JP6303888 B2 JP 6303888B2
Authority
JP
Japan
Prior art keywords
shaft portion
rotation
angle sensor
rotation number
theoretical value
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
Application number
JP2014147770A
Other languages
Japanese (ja)
Other versions
JP2016024025A (en
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.)
Denso Wave Inc
Original Assignee
Denso Wave Inc
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 Denso Wave Inc filed Critical Denso Wave Inc
Priority to JP2014147770A priority Critical patent/JP6303888B2/en
Publication of JP2016024025A publication Critical patent/JP2016024025A/en
Application granted granted Critical
Publication of JP6303888B2 publication Critical patent/JP6303888B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)

Description

本発明は、アクチュエータの装置に関する。   The present invention relates to an actuator device.

ロボットなどに用いられるアクチュエータ装置は、アーム部などを駆動する軸部の位置を高い精度で検出することが求められる。一般に、アクチュエータ装置は、動力源で生成した力を出力軸部へ伝達するために、入力軸部と出力軸部との間に駆動力を減速して伝達する駆動力伝達部を備えている。このように駆動力伝達部を備えるアクチュエータ装置の場合、出力軸部の角度を取得するためには、入力軸部の1回転以上の回転が必要となる。すなわち、駆動力伝達部を備えるアクチュエータ装置の場合、多回転を検出する手段が求められる。   An actuator device used for a robot or the like is required to detect the position of a shaft portion that drives an arm portion or the like with high accuracy. Generally, an actuator device includes a driving force transmission unit that decelerates and transmits a driving force between an input shaft unit and an output shaft unit in order to transmit a force generated by a power source to an output shaft unit. Thus, in the case of an actuator device provided with a driving force transmission part, in order to acquire the angle of an output shaft part, one or more rotations of an input shaft part are needed. That is, in the case of an actuator device including a driving force transmission unit, means for detecting multiple rotations is required.

回転軸の回転位置を検出する一般的なアブソリュート型のエンコーダは、電力の供給が停止したとき、多回転数が喪失される。そのため、このようなエンコーダを用いるアクチュエータ装置は、バックアップのための電源を付加したり、入力軸に噛み合う複数の歯車の噛み合いパターンから物理的に位置情報を保持することにより、多回転数の保存している。しかし、バックアップ電源を付加しても、電力の供給が長時間停止すれば、多回転数が喪失されるとともに、バックアップ電源の定期的な交換も必要となる。また、物理的に位置情報を保持する場合、機械的な部品点数が増加し、小型化も困難である。   In a general absolute encoder that detects the rotational position of the rotary shaft, the number of rotations is lost when power supply is stopped. For this reason, an actuator device using such an encoder can store a large number of revolutions by adding a power source for backup or by physically holding position information from a meshing pattern of a plurality of gears meshing with an input shaft. ing. However, even if a backup power supply is added, if the power supply is stopped for a long time, the multi-rotation speed is lost and the backup power supply needs to be periodically replaced. In addition, when the position information is physically held, the number of mechanical parts is increased, and downsizing is difficult.

そこで、例えば特許文献1では、駆動力伝達部の中間軸部を含む2か所の軸部に設けたセンサによって、出力軸部の多回転を検出することが提案されている。しかし、特許文献1の構成の場合、中間軸部および出力軸部の回転位置を用いており、入力軸部の多回転数の取得は考慮されていない。また、特許文献1の場合、多回転数を取得するために、2か所のセンサで取得した角度の組み合わせのすべてをテーブルとして予め用意する必要がある。そのため、検出精度を高めるためにセンサの解像度を高めると、テーブルのデータ量が増大し、大容量の記憶手段が必要となる。また、例えば、入力軸部側と出力軸部側との歯数の最小公倍数が小さいとき、入力軸部が数回転すると、入力軸部側と出力軸部側との位置関係は初期の位置に戻る。これに対し、アクチュエータ装置の小型化を進める場合、ギア比によっては、入力軸部側が数十回転したとき、入力軸部と出力軸部側との関係が初期位置へ戻ることもある。このように、初期の位置関係に戻る際に、入力軸部側の回転数が増大する場合、テーブルデータの量はセンサの解像度に応じて膨大になるという問題がある。   Therefore, for example, Patent Document 1 proposes that multiple rotations of the output shaft portion are detected by sensors provided at two shaft portions including the intermediate shaft portion of the driving force transmission portion. However, in the case of the configuration of Patent Document 1, the rotational positions of the intermediate shaft portion and the output shaft portion are used, and acquisition of the multi-rotation number of the input shaft portion is not considered. Further, in the case of Patent Document 1, in order to acquire the multi-rotation number, it is necessary to prepare in advance as a table all combinations of angles acquired by the two sensors. Therefore, if the resolution of the sensor is increased in order to increase the detection accuracy, the amount of data in the table increases and a large capacity storage means is required. Also, for example, when the least common multiple of the number of teeth on the input shaft side and the output shaft portion side is small, if the input shaft portion rotates several times, the positional relationship between the input shaft portion side and the output shaft portion side will be at the initial position. Return. On the other hand, when the miniaturization of the actuator device is promoted, the relationship between the input shaft portion and the output shaft portion side may return to the initial position when the input shaft portion side rotates several tens depending on the gear ratio. As described above, when the rotational speed on the input shaft portion side increases when returning to the initial positional relationship, there is a problem that the amount of table data becomes enormous according to the resolution of the sensor.

特開2007−85890号公報JP 2007-85890 A

そこで、本発明の目的は、入力軸部および出力軸部へ角度センサの取り付けが困難であっても、中間軸部に設けた角度センサから、簡単な構造で体格の大型化を招くことなく、バックアップや大容量の記憶手段を必要とすることなく多回転数を取得するアクチュエータ装置を提供することにある。   Therefore, even if it is difficult to attach the angle sensor to the input shaft portion and the output shaft portion, the object of the present invention is from the angle sensor provided on the intermediate shaft portion without causing an increase in size with a simple structure, It is an object of the present invention to provide an actuator device that acquires a multi-rotation speed without requiring a backup or a large-capacity storage means.

請求項1記載の発明では、駆動力伝達部は、第一軸部および第二軸部の少なくとも2本の中間軸部を有している。第一軸部と第二軸部とは互いに噛み合っており、第一軸部は第二軸部よりも入力軸部に近い。これら第一軸部および第二軸部には、それぞれ第一角度センサおよび第二角度センサが設けられている。すなわち、第一角度センサおよび第二角度センサは、いずれも入力軸部または出力軸部のいずれでもない中間軸部に設けられている。多回転数算出手段は、これら第一角度センサで検出した第一軸部の回転角度から、第一軸部の多回転数を算出する。すなわち、多回転数算出手段は、検出した第一軸部の回転角度から、多回転数に応じて第二軸部に想定される回転角度の理論値を理論値群として算出する。そして、多回転数算出手段は、算出した理論値群と、第二角度センサで検出した第二軸部の回転角度の実測値とを対比して第一軸部の多回転数を算出する。また、入力軸部および出力軸部へ角度センサの取り付けが困難であっても、中間軸部に設けた角度センサによって第一軸部の多回転数が取得される。さらに、第一軸部の多回転数は、第二軸部で想定される理論値と、第二角度センサで検出した実測値とを対比して算出される。そのため、第一軸部の位置を保持するための電気的なバックアップや複数のセンサで取得した角度の組み合わせのデータを記憶するための記憶手段も不要である。したがって、簡単な構造で体格の大型化を招くことなく、バックアップや大容量の記憶手段を必要とすることなく多回転数を取得することができる。   In the first aspect of the present invention, the driving force transmission portion has at least two intermediate shaft portions of the first shaft portion and the second shaft portion. The first shaft portion and the second shaft portion mesh with each other, and the first shaft portion is closer to the input shaft portion than the second shaft portion. A first angle sensor and a second angle sensor are provided on the first shaft portion and the second shaft portion, respectively. That is, the first angle sensor and the second angle sensor are provided on the intermediate shaft portion that is neither the input shaft portion nor the output shaft portion. The multi-rotation speed calculating means calculates the multi-rotation speed of the first shaft portion from the rotation angle of the first shaft portion detected by the first angle sensor. That is, the multi-rotation number calculating means calculates the theoretical value of the rotation angle assumed for the second shaft part according to the multi-rotation number from the detected rotation angle of the first shaft part as a theoretical value group. Then, the multi-rotation speed calculating means calculates the multi-rotation speed of the first shaft portion by comparing the calculated theoretical value group with the actual measured value of the rotation angle of the second shaft portion detected by the second angle sensor. Even if it is difficult to attach the angle sensor to the input shaft portion and the output shaft portion, the multi-rotation speed of the first shaft portion is acquired by the angle sensor provided in the intermediate shaft portion. Furthermore, the multiple rotation speed of the first shaft portion is calculated by comparing the theoretical value assumed for the second shaft portion with the actual measurement value detected by the second angle sensor. Therefore, an electrical backup for holding the position of the first shaft portion and a storage means for storing data of a combination of angles acquired by a plurality of sensors are unnecessary. Therefore, the number of rotations can be acquired without requiring a backup or a large-capacity storage means without causing an increase in size with a simple structure.

請求項2記載の発明では、多回転数算出手段の具体的な多回転数の算出を規定している。すなわち、第一回転位置算出手段は、第一角度センサで検出した第一軸部の回転角度r11から第一軸部の原点位置である第一軸原点r10を減じる。これにより、第一回転位置算出手段は、検出時における第一軸部の回転位置を第一回転位置R1として算出する。同様に、第二回転位置算出手段は、第二軸部の回転位置を第二回転位置R2として算出する。ここで、第一軸原点r10および第二軸原点r20は、既知の値である。理論値算出手段は、算出された第一回転位置R1から、第一軸部がn回転したとき、第二角度センサで想定される理論的な位置を理論値Rt2として算出する。そして、多回転数決定手段は、この理論値Rt2と実測値である第二回転位置R2との差分Kを算出する。ここで、多回転数決定手段は、第一軸部の多回転数nが検出可能最大多回転数Lになるまで差分Kを算出する。多回転数決定手段は、検出可能最大多回転数Lに到達するまで算出した差分Kのうち最小となる最小差分Ktempに対応する第一軸部の多回転数nを第一軸部の多回転数Nminとして決定する。このように、多回転数算出手段は、第一角度センサで検出した第一軸部の回転角度および第二角度センサで検出した第二軸部の回転角度から、第一軸部の多回転数を算出する。したがって、入力軸部および出力軸部へ角度センサの取り付けが困難であっても、中間軸部に設けた角度センサによって第一軸部の多回転数を取得することができる。   According to the second aspect of the invention, the specific calculation of the multi-rotation number of the multi-rotation number calculating means is defined. That is, the first rotation position calculation means subtracts the first axis origin r10 that is the origin position of the first axis from the rotation angle r11 of the first axis detected by the first angle sensor. Thereby, a 1st rotation position calculation means calculates the rotation position of the 1st axial part at the time of detection as 1st rotation position R1. Similarly, the second rotational position calculation means calculates the rotational position of the second shaft portion as the second rotational position R2. Here, the first axis origin r10 and the second axis origin r20 are known values. The theoretical value calculating means calculates a theoretical position assumed by the second angle sensor as the theoretical value Rt2 when the first shaft portion rotates n times from the calculated first rotational position R1. Then, the multi-rotation number determination means calculates a difference K between the theoretical value Rt2 and the second rotation position R2 that is an actual measurement value. Here, the multi-rotation speed determining means calculates the difference K until the multi-rotation speed n of the first shaft portion reaches a detectable maximum multi-rotation speed L. The multi-rotation number determining means calculates the multi-rotation number n of the first shaft portion corresponding to the minimum difference Ktemp which is the smallest among the differences K calculated until the maximum detectable multi-rotation number L is reached. It is determined as a number Nmin. As described above, the multi-rotation speed calculating means calculates the multi-rotation speed of the first shaft portion from the rotation angle of the first shaft portion detected by the first angle sensor and the rotation angle of the second shaft portion detected by the second angle sensor. Is calculated. Therefore, even if it is difficult to attach the angle sensor to the input shaft portion and the output shaft portion, the multi-rotation speed of the first shaft portion can be acquired by the angle sensor provided on the intermediate shaft portion.

請求項3記載の発明では、第一軸部の歯数と第二軸部の歯数とは、互いに素となる関係である。第一軸部および第二軸部の歯数が互いに素となることにより、歯数の設定すなわちギヤ比の設定への制限が低減される。これにより、任意の歯数の組み合わせが容易となることから、第二軸部の歯数の設定が容易になり、かつ第二軸部の設計自由度も向上する。したがって、データ量の増大を招くことがないだけでなく、設計の自由度の向上にともない第二軸部の小型化が促され、機器全体の小型化を図ることができる。   In the invention according to claim 3, the number of teeth of the first shaft portion and the number of teeth of the second shaft portion have a prime relationship. Since the number of teeth of the first shaft portion and the second shaft portion is relatively prime, the restriction on the setting of the number of teeth, that is, the setting of the gear ratio is reduced. Thereby, any number of teeth can be easily combined, so the number of teeth of the second shaft portion can be easily set, and the design freedom of the second shaft portion can be improved. Therefore, not only does the data amount not increase, but also the second shaft portion is reduced in size as the degree of freedom in design is improved, and the entire device can be reduced in size.

請求項4記載の発明では、出力軸部は中空の筒状に形成されている。これにより、配線を出力軸部の内部に収容することができ、配線の絡まりを低減し、美感を高めることができる。また、中空の出力軸部によって、軽量化を図ることができる。ここで、出力軸部が中空の場合、角度センサを設けることができず、出力軸部の回転角度を取得することは難しい。しかし、中間軸部から多回転数を取得することにより、出力軸部の形状に関わらず、多回転数を取得することができ、回転位置および姿勢を取得することができる。   In the invention according to claim 4, the output shaft portion is formed in a hollow cylindrical shape. Thereby, wiring can be accommodated in the inside of an output shaft part, the tangle of wiring can be reduced, and aesthetics can be improved. Further, the hollow output shaft portion can reduce the weight. Here, when the output shaft portion is hollow, an angle sensor cannot be provided, and it is difficult to obtain the rotation angle of the output shaft portion. However, by acquiring the multi-rotation number from the intermediate shaft part, the multi-rotation number can be acquired regardless of the shape of the output shaft part, and the rotational position and orientation can be acquired.

請求項5記載の発明では、第一軸部および第二軸部は、入力軸部に近い2本の中間軸部である。入力軸部から出力軸部までの駆動力伝達部に複数の中間軸部があるとき、バックラッシュなどの誤差の影響を受けやすい。そして、この誤差は、出力軸部に近い側ほど大きくなる傾向にある。そこで、入力軸部に近い2本の中間軸部を第一軸部および第二軸部とすることにより、検出される多回転数および角度の精度は向上する。したがって、検出精度を高めることができるとともに、検出した値をフィードバック制御にも用いることができる。   In the invention according to claim 5, the first shaft portion and the second shaft portion are two intermediate shaft portions close to the input shaft portion. When there are a plurality of intermediate shaft portions in the driving force transmission portion from the input shaft portion to the output shaft portion, they are easily affected by errors such as backlash. This error tends to increase as the side is closer to the output shaft portion. Therefore, by using the two intermediate shaft portions close to the input shaft portion as the first shaft portion and the second shaft portion, the accuracy of the detected multiple rotation speed and angle is improved. Therefore, the detection accuracy can be increased and the detected value can also be used for feedback control.

一実施形態によるアクチュエータ装置の構成を示す模式図The schematic diagram which shows the structure of the actuator apparatus by one Embodiment. 一実施形態によるアクチュエータ装置を示す概略斜視図The schematic perspective view which shows the actuator apparatus by one Embodiment 一実施形態によるアクチュエータ装置の主要部の構成を示す模式図The schematic diagram which shows the structure of the principal part of the actuator apparatus by one Embodiment. 一実施形態によるアクチュエータ装置の構成を示すブロック図The block diagram which shows the structure of the actuator apparatus by one Embodiment. 第一軸の多回転数と第二軸の回転角度との関係の一例を示す概略図Schematic showing an example of the relationship between the number of rotations of the first axis and the rotation angle of the second axis 一実施形態によるアクチュエータ装置の処理の流れを示す概略図Schematic which shows the flow of a process of the actuator apparatus by one Embodiment.

以下、一実施形態によるアクチュエータ装置を図面に基づいて説明する。
図2に示すように、アクチュエータ装置10は、動力源11、出力軸部12および駆動力伝達部13を備えている。アクチュエータ装置10は、例えばロボットの図示しないアームを駆動する駆動装置である。動力源11は、電力で作動するモータ14を有している。モータ14は、入力軸部15を有している。すなわち、入力軸部15は、モータ14と一体に構成されている。これにより、モータ14に電力を供給すると、入力軸部15は回転する。入力軸部15は、入力ギア16を有している。
Hereinafter, an actuator device according to an embodiment will be described with reference to the drawings.
As shown in FIG. 2, the actuator device 10 includes a power source 11, an output shaft portion 12, and a driving force transmission portion 13. The actuator device 10 is, for example, a drive device that drives an arm (not shown) of the robot. The power source 11 has a motor 14 that operates with electric power. The motor 14 has an input shaft portion 15. That is, the input shaft portion 15 is configured integrally with the motor 14. Thereby, when electric power is supplied to the motor 14, the input shaft portion 15 rotates. The input shaft portion 15 has an input gear 16.

駆動力伝達部13は、この動力源11と出力軸部12との間に設けられている。出力軸部12は、入力軸部15から入力された駆動力を出力する。出力軸部12は、出力ギア17を有している。また、本実施形態の場合、出力軸部12は、中空の筒状に形成されている。これにより、出力軸部12の軽量化が図られている。駆動力伝達部13は、入力軸部15に入力された駆動力を減速して出力軸部12へ伝達する。図2に示す例の場合、駆動力伝達部13は、中間軸部20として第一軸部21、第二軸部22および第三軸部23を有している。   The driving force transmission unit 13 is provided between the power source 11 and the output shaft unit 12. The output shaft portion 12 outputs the driving force input from the input shaft portion 15. The output shaft portion 12 has an output gear 17. In the present embodiment, the output shaft portion 12 is formed in a hollow cylindrical shape. Thereby, weight reduction of the output shaft part 12 is achieved. The driving force transmission unit 13 decelerates and transmits the driving force input to the input shaft unit 15 to the output shaft unit 12. In the case of the example illustrated in FIG. 2, the driving force transmission unit 13 includes a first shaft portion 21, a second shaft portion 22, and a third shaft portion 23 as the intermediate shaft portion 20.

以下、説明の簡単のために、図1に示すように中間軸部30として第一軸部31および第二軸部32の2本を有する例を用いて説明する。すなわち、図1に示す例の場合、駆動力伝達部13は、入力軸部15に近い側から第一軸部31および第二軸部32の2本の中間軸部30を有している。第一軸部31は、第一ギア33を有している。同様に、第二軸部32は、第二ギア34を有している。入力軸部15の入力ギア16は、第一軸部31の第一ギア33と噛み合っている。また、第一軸部31の第一ギア33は、入力ギア16とともに第二軸部32の第二ギア34とも噛み合っている。第二軸部32の第二ギア34は、第一軸部31の第一ギア33とともに、出力軸部12の出力ギア17とも噛み合っている。このように、駆動力伝達部13は、入力軸部15に近い側の第一軸部31と、この第一軸部31と噛み合って出力軸部12に近い側の第二軸部32とを有している。なお、図1では、説明の簡単のために第一ギア33が入力ギア16と第二ギア34、第二ギア34が第一ギア33と出力ギア17に直接噛み合う状態を図示している。しかし、第一軸部31および第二軸部32は、要求されるギア比に応じて、軸方向の異なる位置に他の軸部のギアと噛み合う複数のギアを設けてもよい。   Hereinafter, for the sake of simplicity of explanation, an example in which the intermediate shaft portion 30 has two of a first shaft portion 31 and a second shaft portion 32 as shown in FIG. 1 will be described. That is, in the example shown in FIG. 1, the driving force transmission unit 13 has two intermediate shaft portions 30, that is, a first shaft portion 31 and a second shaft portion 32 from the side close to the input shaft portion 15. The first shaft portion 31 has a first gear 33. Similarly, the second shaft portion 32 has a second gear 34. The input gear 16 of the input shaft portion 15 is in mesh with the first gear 33 of the first shaft portion 31. Further, the first gear 33 of the first shaft portion 31 meshes with the second gear 34 of the second shaft portion 32 together with the input gear 16. The second gear 34 of the second shaft portion 32 meshes with the output gear 17 of the output shaft portion 12 together with the first gear 33 of the first shaft portion 31. Thus, the driving force transmission unit 13 includes the first shaft portion 31 on the side close to the input shaft portion 15 and the second shaft portion 32 on the side close to the output shaft portion 12 that meshes with the first shaft portion 31. Have. For the sake of simplicity, FIG. 1 shows a state in which the first gear 33 directly meshes with the input gear 16 and the second gear 34, and the second gear 34 meshes directly with the first gear 33 and the output gear 17. However, the first shaft portion 31 and the second shaft portion 32 may be provided with a plurality of gears that mesh with the gears of other shaft portions at different positions in the axial direction according to the required gear ratio.

アクチュエータ装置10は、上記の構成に加え、第一角度センサ41および第二角度センサ42を備えている。第一角度センサ41は、第一軸部31に設けられ、第一軸部31の回転角度の絶対値を検出する。同様に、第二角度センサ42は、第二軸部32に設けられ、第二軸部32の回転角度の絶対値を検出する。図3に示すように第一角度センサ41は、磁性体43および磁気エンコーダ44を有している。磁性体43は、第一軸部31に取り付けられ、径方向に着磁されている。磁気エンコーダ44は、磁性体43と対向して設けられ、第一軸部31の回転にともなう磁界の変化から第一軸部31の回転角度の絶対値を検出する。同様に、第二角度センサ42は、磁性体45および磁気エンコーダ46を有している。磁性体45は、第二軸部32に取り付けられ、径方向に着磁されている。磁気エンコーダ46は、磁性体45と対向して設けられ、第二軸部32の回転にともなう磁界の変化から第二軸部32の回転角度の絶対値を検出する。なお、第一角度センサ41および第二角度センサ42は、回転角度の絶対値が検出可能であれば上記の例に限らず用いることができる。   The actuator device 10 includes a first angle sensor 41 and a second angle sensor 42 in addition to the above configuration. The first angle sensor 41 is provided on the first shaft portion 31 and detects the absolute value of the rotation angle of the first shaft portion 31. Similarly, the second angle sensor 42 is provided on the second shaft portion 32 and detects the absolute value of the rotation angle of the second shaft portion 32. As shown in FIG. 3, the first angle sensor 41 has a magnetic body 43 and a magnetic encoder 44. The magnetic body 43 is attached to the first shaft portion 31 and is magnetized in the radial direction. The magnetic encoder 44 is provided opposite to the magnetic body 43 and detects the absolute value of the rotation angle of the first shaft portion 31 from the change in the magnetic field accompanying the rotation of the first shaft portion 31. Similarly, the second angle sensor 42 has a magnetic body 45 and a magnetic encoder 46. The magnetic body 45 is attached to the second shaft portion 32 and is magnetized in the radial direction. The magnetic encoder 46 is provided to face the magnetic body 45 and detects the absolute value of the rotation angle of the second shaft portion 32 from the change of the magnetic field accompanying the rotation of the second shaft portion 32. The first angle sensor 41 and the second angle sensor 42 can be used without being limited to the above example as long as the absolute value of the rotation angle can be detected.

アクチュエータ装置10は、図1に示すように制御部50を備えている。制御部50は、動力源11のモータ14、第一角度センサ41および第二角度センサ42と電気的に接続している。第一角度センサ41および第二角度センサ42は、いずれも検出した回転角度を電気信号として制御部50へ出力する。制御部50は、図4に示すように制御ユニット51を有している。制御ユニット51は、図示しないCPU、ROMおよびRAMを有するマイクロコンピュータで構成されている。制御部50は、制御ユニット51でROMに記憶されているコンピュータプログラムを実行することにより、アクチュエータ装置10の全体を制御する。また、制御部50は、ROMに記憶されているコンピュータプログラムを実行することにより、第一軸部31の多回転数を算出する多回転数算出部52をソフトウェア的に実現している。詳細には、制御部50は、第一回転位置算出部61、第二回転位置算出部62、理論値算出部63および多回転数決定部64から構成される多回転数算出部52をソフトウェア的に実現している。   The actuator device 10 includes a control unit 50 as shown in FIG. The controller 50 is electrically connected to the motor 14, the first angle sensor 41, and the second angle sensor 42 of the power source 11. Both the first angle sensor 41 and the second angle sensor 42 output the detected rotation angle as an electrical signal to the control unit 50. The control unit 50 includes a control unit 51 as shown in FIG. The control unit 51 is composed of a microcomputer having a CPU, ROM and RAM (not shown). The control unit 50 controls the entire actuator device 10 by executing a computer program stored in the ROM by the control unit 51. In addition, the control unit 50 implements a multi-rotation number calculation unit 52 that calculates the multi-rotation number of the first shaft unit 31 by software by executing a computer program stored in the ROM. More specifically, the control unit 50 includes a multi-rotation number calculation unit 52 configured by a first rotation position calculation unit 61, a second rotation position calculation unit 62, a theoretical value calculation unit 63, and a multi-rotation number determination unit 64 in a software manner. Has been realized.

多回転数算出部52は、第二軸部32に設けられた第二角度センサ42で想定される理論値と実測値との差分から第一軸部31の多回転数を算出する。ここで、第二角度センサ42で想定される理論値は、第一角度センサ41で検出した第一軸部31の回転角度に基づいて算出される。多回転数算出部52を構成する第一回転位置算出部61、第二回転位置算出部62、理論値算出部63および多回転数決定部64は、詳細には次のような処理を実行する。   The multi-rotation number calculation unit 52 calculates the multi-rotation number of the first shaft part 31 from the difference between the theoretical value assumed by the second angle sensor 42 provided in the second shaft part 32 and the actual measurement value. Here, the theoretical value assumed by the second angle sensor 42 is calculated based on the rotation angle of the first shaft portion 31 detected by the first angle sensor 41. The first rotation position calculation unit 61, the second rotation position calculation unit 62, the theoretical value calculation unit 63, and the multi-rotation number determination unit 64 constituting the multi-rotation number calculation unit 52 execute the following processing in detail. .

第一回転位置算出部61は、第一回転位置R1を算出する。具体的には、第一回転位置算出部61は、第一角度センサ41から第一軸部31の回転角度r11を検出する。第一回転位置算出部61は、検出した回転角度r11から第一軸原点r10を減じることにより、第一回転位置R1をR1=r11−r10として算出する。ここで、第一軸原点r10は、文字通り第一軸部31の回転の基準となる原点であり、既知の値として定義され、制御ユニット51のROMに記憶されている。   The first rotational position calculation unit 61 calculates a first rotational position R1. Specifically, the first rotation position calculation unit 61 detects the rotation angle r <b> 11 of the first shaft portion 31 from the first angle sensor 41. The first rotation position calculation unit 61 calculates the first rotation position R1 as R1 = r11−r10 by subtracting the first axis origin r10 from the detected rotation angle r11. Here, the first axis origin r10 is literally the origin that serves as a reference for the rotation of the first axis portion 31, is defined as a known value, and is stored in the ROM of the control unit 51.

第二回転位置算出部62は、第二回転位置R2を算出する。具体的には、第二回転位置算出部62は、第二角度センサ42から第二軸部32の回転角度r21を検出する。第二回転位置算出部62は、検出した回転角度r21から第二軸原点r20を減じることにより、第二回転位置R2をR2=r21−r20として算出する。ここで、第二軸原点r20は、文字通り第二軸部32の回転の基準となる原点であり、既知の値として定義され、制御ユニット51のROMに記憶されている。   The second rotational position calculation unit 62 calculates the second rotational position R2. Specifically, the second rotation position calculation unit 62 detects the rotation angle r <b> 21 of the second shaft portion 32 from the second angle sensor 42. The second rotation position calculation unit 62 calculates the second rotation position R2 as R2 = r21−r20 by subtracting the second axis origin r20 from the detected rotation angle r21. Here, the second axis origin r <b> 20 is literally an origin serving as a reference for rotation of the second axis portion 32, is defined as a known value, and is stored in the ROM of the control unit 51.

理論値算出部63は、第一回転位置算出部61で算出された第一回転位置R1から、第一軸部31が多回転数nにあるときに想定される第二角度センサ42の理論値Rt2を、多回転数nごとの理論値群として算出する。例えば、理論値算出部63は、第一回転位置R1を基に、多回転数n=1のときの理論値Rt2、多回転数n=2のときの理論値Rt2、多回転数n=3のときの理論値Rt2、・・・というように各多回転数nごとの理論値Rt2を理論値群として算出する。第一回転位置算出部61で第一回転位置R1が算出されれば、第一軸部31が多回転数nであるとき、この第一軸部31と噛み合う第二軸部32の第二角度センサ42で想定される理論値Rt2は多回転数nごとに算出可能である。つまり、第一軸部31の第一ギア33と第二軸部32の第二ギア34のギア比が既知であれば、多回転数nに対応する第二角度センサ42の理論値Rt2は、第一軸部31の第一回転位置R1に基づいて多回転数nに対応する理論値群として算出可能である。   The theoretical value calculation unit 63 calculates the theoretical value of the second angle sensor 42 that is assumed when the first shaft portion 31 is at the multi-rotation number n from the first rotation position R1 calculated by the first rotation position calculation unit 61. Rt2 is calculated as a theoretical value group for each multi-rotation number n. For example, the theoretical value calculation unit 63 is based on the first rotational position R1, the theoretical value Rt2 when the multi-rotation number n = 1, the theoretical value Rt2 when the multi-rotation number n = 2, and the multi-rotation number n = 3. The theoretical value Rt2 for each multi-rotation number n is calculated as a theoretical value group, such as the theoretical value Rt2 at the time of. If the first rotational position R1 is calculated by the first rotational position calculator 61, the second angle of the second shaft portion 32 that meshes with the first shaft portion 31 when the first shaft portion 31 has a multi-rotation number n. The theoretical value Rt2 assumed by the sensor 42 can be calculated for each multi-rotation number n. That is, if the gear ratio between the first gear 33 of the first shaft portion 31 and the second gear 34 of the second shaft portion 32 is known, the theoretical value Rt2 of the second angle sensor 42 corresponding to the multi-rotation speed n is Based on the first rotational position R1 of the first shaft portion 31, it can be calculated as a theoretical value group corresponding to the multi-rotation number n.

多回転数決定部64は、第一軸部31の多回転数Nminを決定する。具体的には、多回転数決定部64は、理論値算出部63で算出した多回転数nごとの理論値Rt2である理論値群と第二回転位置算出部62で算出した第二回転位置R2との差分Kを、理論値群に含まれる理論値Rt2ごとにK=|R2−Rt2|として算出する。すなわち、多回転数決定部64は、各理論値Rt2と実測値である第二回転位置R2との差分をKとして算出する。そして、多回転数決定部64は、この差分Kを、検出可能最大多回転数Lを最大値として第一軸部31の多回転数nごとに算出する。すなわち、多回転数決定部64は、第一軸部31で想定される多回転数n(0≦n≦L)ごとに、算出した理論値Rt2の理論値群を用いて差分Kを算出する。   The multi-rotation number determination unit 64 determines the multi-rotation number Nmin of the first shaft portion 31. Specifically, the multi-rotation number determination unit 64 includes a theoretical value group that is the theoretical value Rt2 for each multi-rotation number n calculated by the theoretical value calculation unit 63 and the second rotation position calculated by the second rotation position calculation unit 62. The difference K from R2 is calculated as K = | R2-Rt2 | for each theoretical value Rt2 included in the theoretical value group. That is, the multi-rotation number determination unit 64 calculates the difference between each theoretical value Rt2 and the second rotation position R2 that is an actual measurement value as K. Then, the multi-rotation number determination unit 64 calculates the difference K for each multi-rotation number n of the first shaft portion 31 with the maximum detectable multi-rotation number L as the maximum value. That is, the multi-rotation number determination unit 64 calculates the difference K for each multi-rotation number n (0 ≦ n ≦ L) assumed in the first shaft unit 31 using the calculated theoretical value group of the theoretical values Rt2. .

ここで、検出可能最大多回転数Lは、第一軸部31と第二軸部32との歯数、すなわち第一ギア33と第二ギア34との歯数によって決定される。第一ギア33の歯数は歯数T1とし、第二ギア34の歯数は歯数T2とする。このとき、検出可能最大多回転数Lは、第二ギア34の歯数T2を、歯数T1と歯数T2との最大公約数で除した値と等しくなる。例えば、第一ギア33の歯数T1はT1=11、第二ギア34の歯数T2はT2=50とする。これら歯数T1と歯数T2とは最大公約数をもたない互いに素の関係であるため、検出可能最大多回転数Lは、初期の回転数を0とすると、L=50−1=49である。そのため、図5に示すように第一軸部31の多回転数と第二軸部32の回転角度との関係は、L=49、つまり0回点目から49回転目までの50回転を識別することができる。   Here, the maximum detectable number of rotations L is determined by the number of teeth of the first shaft portion 31 and the second shaft portion 32, that is, the number of teeth of the first gear 33 and the second gear 34. The number of teeth of the first gear 33 is the number of teeth T1, and the number of teeth of the second gear 34 is the number of teeth T2. At this time, the maximum detectable number of rotations L is equal to a value obtained by dividing the number of teeth T2 of the second gear 34 by the greatest common divisor of the number of teeth T1 and the number of teeth T2. For example, the number of teeth T1 of the first gear 33 is T1 = 11, and the number of teeth T2 of the second gear 34 is T2 = 50. Since the number of teeth T1 and the number of teeth T2 are relatively prime and have no greatest common divisor, the detectable maximum multi-rotation speed L is L = 50-1 = 49 when the initial rotation speed is 0. It is. Therefore, as shown in FIG. 5, the relationship between the number of rotations of the first shaft portion 31 and the rotation angle of the second shaft portion 32 is L = 49, that is, identifies 50 rotations from the 0th point to the 49th rotation. can do.

一方、例えば第一ギア33の歯数T1はT1=11、第二ギア34の歯数T2はT2=55であるとき、最大公約数は11である。そのため、検出可能最大多回転数Lは、L=55/11−1=4となる。その結果、第一軸部31の多回転数は、最大で0回点目から4回点目までの5回転を識別することができる。したがって、検出可能な第一軸部31の多回転数を増加させるためには、第一ギア33の歯数T1と第二ギア34の歯数T2とは、できる限り互いに素となる関係または最大公約数が大きくなるように設定することが望ましい。このように、検出可能最大多回転数Lは、第一軸部31の第一ギア33および第二軸部32の第二ギア34の各歯数によって既知の値として決定され、制御ユニット51のROMに記憶されている。   On the other hand, for example, when the number of teeth T1 of the first gear 33 is T1 = 11 and the number of teeth T2 of the second gear 34 is T2 = 55, the greatest common divisor is 11. Therefore, the maximum detectable number of rotations L is L = 55 / 11−1 = 4. As a result, the maximum number of rotations of the first shaft portion 31 can identify five rotations from the 0th point to the 4th point. Therefore, in order to increase the multi-rotation number of the first shaft portion 31 that can be detected, the number of teeth T1 of the first gear 33 and the number of teeth T2 of the second gear 34 are as close to each other as possible. It is desirable to set the common divisor to be large. Thus, the maximum detectable multi-rotation speed L is determined as a known value by the number of teeth of the first gear 33 of the first shaft portion 31 and the second gear 34 of the second shaft portion 32, and the control unit 51 Stored in ROM.

多回転数決定部64は、検出可能最大多回転数Lを最大値として多回転数nごとに差分Kを算出する。多回転数決定部64は、算出した差分Kから、最小となる最小差分Ktempを抽出する。多回転数決定部64は、この抽出した最小差分Ktempに対応する第一軸部31の多回転数nを、第一軸部31の多回転数Nminとして決定する。   The multi-rotation number determination unit 64 calculates the difference K for each multi-rotation number n with the maximum detectable multi-rotation number L as the maximum value. The multi-rotation number determination unit 64 extracts the minimum difference Ktemp that is the minimum from the calculated difference K. The multi-rotation number determination unit 64 determines the multi-rotation number n of the first shaft part 31 corresponding to the extracted minimum difference Ktemp as the multi-rotation number Nmin of the first shaft part 31.

次に、上記の構成によるアクチュエータ装置10の多回転数を決定する処理の流れを図6に基づいて説明する。
多回転数算出部52は、例えばアクチュエータ装置10の起動時や電源の復帰時などに多回転数の算出を実行する。多回転数算出の処理が開始されると、第一回転位置算出部61は第一軸部31の回転角度r11を取得する(S101)。第一回転位置算出部61は、第一角度センサ41から第一軸部31の回転角度r11を取得する。同様に、第二回転位置算出部62は、第二角度センサ42から第二軸部32の回転角度r21を取得する(S102)。
Next, the flow of processing for determining the multi-rotation speed of the actuator device 10 having the above-described configuration will be described with reference to FIG.
The multi-rotation speed calculation unit 52 calculates the multi-rotation speed when, for example, the actuator device 10 is activated or when the power is restored. When the multi-rotation number calculation process is started, the first rotation position calculation unit 61 acquires the rotation angle r11 of the first shaft portion 31 (S101). The first rotation position calculation unit 61 acquires the rotation angle r11 of the first shaft portion 31 from the first angle sensor 41. Similarly, the second rotation position calculation unit 62 acquires the rotation angle r21 of the second shaft portion 32 from the second angle sensor 42 (S102).

第一回転位置算出部61は、第一回転位置R1を算出する(S103)。すなわち、第一回転位置算出部61は、S101で取得した第一軸部31の回転角度r11、および制御ユニット51のROMに記憶している第一軸原点r10から、第一回転位置R1=r11−r10を算出する。また、第二回転位置算出部62は、第二回転位置R2を算出する(S104)。すなわち、第二回転位置算出部62は、S102で取得した第二軸部32の回転角度r21、および制御ユニット51のROMに記憶している第二軸原点r20から、第二回転位置R2=r21−r20を算出する。   The first rotational position calculation unit 61 calculates the first rotational position R1 (S103). That is, the first rotation position calculation unit 61 calculates the first rotation position R1 = r11 from the rotation angle r11 of the first shaft part 31 acquired in S101 and the first axis origin r10 stored in the ROM of the control unit 51. -R10 is calculated. The second rotational position calculation unit 62 calculates the second rotational position R2 (S104). That is, the second rotational position calculation unit 62 calculates the second rotational position R2 = r21 from the rotational angle r21 of the second shaft part 32 acquired in S102 and the second axis origin r20 stored in the ROM of the control unit 51. -R20 is calculated.

多回転数決定部64は、多回転数nおよび最小差分Ktempを初期化する(S105)。すなわち、多回転数決定部64は、多回転数nをn=0に設定し、最小差分Ktempを第二角度センサ42で検出可能な最大値Xに設定する。ここで、第二角度センサ42で検出可能な最大値Xは、第二軸部32に設けられている第二ギア34の歯数T2によって決定される一回転当たりの解像度に相当する。つまり、最大値Xは、一回転360°を第二ギア34の歯数T2で除したX=360/T2で求められる。例えば、第二ギア34の歯数T2が55であれば、最大値XはX=360/55の既知の値として制御ユニット51のROMに記憶されている。   The multi-rotation number determination unit 64 initializes the multi-rotation number n and the minimum difference Ktemp (S105). That is, the multi-rotation number determination unit 64 sets the multi-rotation number n to n = 0, and sets the minimum difference Ktemp to the maximum value X that can be detected by the second angle sensor 42. Here, the maximum value X that can be detected by the second angle sensor 42 corresponds to the resolution per rotation determined by the number of teeth T <b> 2 of the second gear 34 provided in the second shaft portion 32. That is, the maximum value X is obtained by X = 360 / T2 obtained by dividing one rotation 360 ° by the number of teeth T2 of the second gear 34. For example, if the number of teeth T2 of the second gear 34 is 55, the maximum value X is stored in the ROM of the control unit 51 as a known value of X = 360/55.

多回転数決定部64で多回転数nおよび最小差分Ktempが初期化されると、理論値算出部63は理論値Rt2を算出する(S106)。すなわち、理論値算出部63は、S103で算出した第一回転位置R1から、第一軸部31が多回転数nにあるとき第二軸部32の回転角度として想定される第二角度センサ42の理論値Rt2を多回転数nごとに理論値群の中の一つの値として算出する。   When the multi-rotation number n and the minimum difference Ktemp are initialized by the multi-rotation number determination unit 64, the theoretical value calculation unit 63 calculates the theoretical value Rt2 (S106). That is, the theoretical value calculation unit 63 uses the second angle sensor 42 that is assumed as the rotation angle of the second shaft portion 32 when the first shaft portion 31 is at the multi-rotation speed n from the first rotation position R1 calculated in S103. Is calculated as one value in the theoretical value group for each multi-rotation number n.

多回転数決定部64は、理論値算出部63で理論値Rt2が算出されると、差分Kが最小差分Ktempより小さいか否かを判断する(S107)。すなわち、多回転数決定部64は、S104で算出された第二回転位置R2の実測値と、S106で算出された理論値群に含まれる理論値Rt2とから、差分K=|R2−Rt2|を算出する。そして、多回転数決定部64は、算出した差分Kが多回転数nごとに最小差分Ktempより小さいか否かを判断する。例えばS105で最小差分Ktempを最大値Xとして設定した後、最初にS107の処理を行なう場合、算出した差分Kが最大値Xよりも小さいか否かが判断される。   When the theoretical value Rt2 is calculated by the theoretical value calculator 63, the multi-rotation speed determination unit 64 determines whether or not the difference K is smaller than the minimum difference Ktemp (S107). That is, the multi-rotation number determination unit 64 calculates the difference K = | R2-Rt2 | from the measured value of the second rotational position R2 calculated in S104 and the theoretical value Rt2 included in the theoretical value group calculated in S106. Is calculated. Then, the multi-rotation number determination unit 64 determines whether or not the calculated difference K is smaller than the minimum difference Ktemp for each multi-rotation number n. For example, after the minimum difference Ktemp is set as the maximum value X in S105, when the process of S107 is first performed, it is determined whether or not the calculated difference K is smaller than the maximum value X.

多回転数決定部64は、差分Kが最小差分Ktempより小さいと判断すると(S107:Yes)、判断に用いた差分Kを最小差分Ktempに更新し、このときの第一軸部31の多回転数nを第一軸部31の多回転数Nminに設定する(S108)。多回転数決定部64は、S108における最小差分Ktempの更新および多回転数Nminの設定が完了、または差分Kが最小差分Ktemp以上であると判断すると(S107:No)、第一軸部31の多回転数nが検出可能最大多回転数Lに到達したか否か、すなわちn=Lであるか否かを判断する(S109)。   When determining that the difference K is smaller than the minimum difference Ktemp (S107: Yes), the multi-rotation number determination unit 64 updates the difference K used for the determination to the minimum difference Ktemp, and the multiple rotation of the first shaft portion 31 at this time The number n is set to the multi-rotation number Nmin of the first shaft portion 31 (S108). If the multi-rotation number determination unit 64 determines that the update of the minimum difference Ktemp and the setting of the multi-rotation number Nmin are complete in S108 or the difference K is equal to or greater than the minimum difference Ktemp (S107: No), It is determined whether or not the multi-rotation number n has reached the maximum detectable multi-rotation number L, i.e., n = L (S109).

多回転数決定部64は、第一軸部31の多回転数nが検出可能最大多回転数Lに到達したと判断すると(S109:Yes)、S108で設定した多回転数Nminを第一軸部31の多回転数Nminとして決定する(S110)。一方、多回転数決定部64は、第一軸部31の多回転数nが検出可能最大多回転数Lに到達していないと判断すると(S109:No)、多回転数nをn+1にインクリメントすなわちn=n+1として(S111)、S106へリターンする。これにより、多回転数決定部64は、第一軸部31の多回転数nが検出可能最大多回転数Lに到達するまでS106以降の処理を繰り返す。   When the multi-rotation number determination unit 64 determines that the multi-rotation number n of the first shaft portion 31 has reached the maximum detectable multi-rotation number L (S109: Yes), the multi-rotation number Nmin set in S108 is determined as the first axis. The multi-rotation speed Nmin of the unit 31 is determined (S110). On the other hand, when the multi-rotation number determination unit 64 determines that the multi-rotation number n of the first shaft portion 31 has not reached the maximum detectable multi-rotation number L (S109: No), the multi-rotation number n is incremented to n + 1. That is, n = n + 1 is set (S111), and the process returns to S106. As a result, the multi-rotation number determination unit 64 repeats the processing from S106 onward until the multi-rotation number n of the first shaft portion 31 reaches the maximum detectable multi-rotation number L.

以上の処理により、多回転数決定部64は、差分Kが最小となる最小差分Ktempに対応する第一軸部31の多回転数nを第一軸部31の多回転数Nminとして決定する。すなわち、多回転数算出部52は、第一軸部31の回転位置の実測値である第一回転位置R1から第二軸部32の回転位置の理論値Rt2を算出する。ここで、多回転数算出部52は、この第二軸部32の理論値Rt2を、第一軸部31の多回転数nに対して、0≦n≦Lまで多回転数nごとに算出する。多回転数算出部52は、多回転数nに応じて0からLまで算出した理論値Rt2のそれぞれと、第二軸部32の実測値R2との差分Kが最小である最小差分Ktempとなる多回転数nを、第一軸部31の多回転数Nminとして決定する。これにより、多回転数算出部52は、第一軸部31の実測値を取得し、第二軸部32の実測値R2と、算出した多回転数nごとの第二軸部32の理論値Rt2とを対比するだけで、第一軸部31の多回転数Nminを決定する。その結果、大量のデータは不要であり、第一軸部31および第二軸部32の回転位置の実測値だけで第一軸部31の多回転数nが求められる。   With the above processing, the multi-rotation number determination unit 64 determines the multi-rotation number n of the first shaft part 31 corresponding to the minimum difference Ktemp that minimizes the difference K as the multi-rotation number Nmin of the first shaft part 31. That is, the multi-rotation number calculation unit 52 calculates the theoretical value Rt2 of the rotation position of the second shaft portion 32 from the first rotation position R1 that is an actual measurement value of the rotation position of the first shaft portion 31. Here, the multiple rotation speed calculation unit 52 calculates the theoretical value Rt2 of the second shaft portion 32 for each multiple rotation speed n until 0 ≦ n ≦ L with respect to the multiple rotation speed n of the first shaft portion 31. To do. The multi-rotation number calculation unit 52 becomes the minimum difference Ktemp in which the difference K between the theoretical value Rt2 calculated from 0 to L according to the multi-rotation number n and the actual measurement value R2 of the second shaft part 32 is the minimum. The multi-rotation number n is determined as the multi-rotation number Nmin of the first shaft portion 31. Thereby, the multi-rotation speed calculation unit 52 acquires the actual measurement value of the first shaft part 31, and the actual measurement value R2 of the second shaft part 32 and the theoretical value of the second shaft part 32 for each calculated multi-rotation number n. The multi-rotation speed Nmin of the first shaft portion 31 is determined only by comparing with Rt2. As a result, a large amount of data is unnecessary, and the multi-rotation number n of the first shaft portion 31 is obtained only from the actual measurement values of the rotational positions of the first shaft portion 31 and the second shaft portion 32.

以上説明した一実施形態では、第一軸部31と第二軸部32とは第一ギア33と第二ギア34とで互いに噛み合っており、第一軸部31は第二軸部32よりも入力軸部15に近い。これら第一軸部31および第二軸部32には、それぞれ第一角度センサ41および第二角度センサ42が設けられている。すなわち、第一角度センサ41および第二角度センサ42は、いずれも入力軸部15または出力軸部12のいずれでもない中間軸部30に設けられている。多回転数算出部52は、これら第一角度センサ41で検出した第一軸部31の回転角度から、第一軸部31の多回転数を算出する。すなわち、多回転数算出部52は、検出した第一軸部31の回転角度の回転角度から、多回転数nに応じて第二軸部32に想定される回転角度の理論値Rt2を理論値群として算出する。そして、多回転数算出部52は、算出した理論値Rt2の理論値群と、第二角度センサ42で検出した第二軸部32の回転角度の実測値に基づく第二回転位置R2とを対比して第一軸部31の多回転数を算出する。このような多回転数nの算出により、一実施形態では、第一軸部31の歯数T1と第二軸部32の歯数T2とは、互いに素としてもよい。このように歯数T1と歯数T2とが互いに素となる関係によって、第一軸部31および第二軸部32の設計自由度が向上する。その結果、第二軸部32で設定する歯数T2および第二ギア34を含む第二軸部32の小型化が容易になる。また、入力軸部15および出力軸部12へ角度センサの取り付けが困難であっても、中間軸部30に設けた第一角度センサ41および第二角度センサ42によって第一軸部31の多回転数nが取得される。さらに、第一軸部31の多回転数nは、第二軸部32で想定される理論値Rt2と、第二角度センサ42で検出した実測値に基づく第二回転位置R2とを対比して算出される。そのため、第一軸部31の位置を保持するための電気的なバックアップも不要であるとともに、データ量の大きなデータテーブルを記憶するための大容量の記憶手段も不要である。したがって、簡単な構造で体格の大型化を招くことなく、かつバックアップを必要とすることなく容易に多回転数を取得することができる。   In the embodiment described above, the first shaft portion 31 and the second shaft portion 32 are engaged with each other by the first gear 33 and the second gear 34, and the first shaft portion 31 is more than the second shaft portion 32. Close to the input shaft 15. A first angle sensor 41 and a second angle sensor 42 are provided on the first shaft portion 31 and the second shaft portion 32, respectively. That is, the first angle sensor 41 and the second angle sensor 42 are provided on the intermediate shaft portion 30 that is neither the input shaft portion 15 nor the output shaft portion 12. The multi-rotation number calculation unit 52 calculates the multi-rotation number of the first shaft part 31 from the rotation angle of the first shaft part 31 detected by the first angle sensor 41. That is, the multi-rotation number calculation unit 52 calculates the theoretical value Rt2 of the rotation angle assumed for the second shaft part 32 according to the multi-rotation number n from the detected rotation angle of the first shaft part 31. Calculate as a group. The multi-rotation speed calculation unit 52 compares the calculated theoretical value group of the theoretical value Rt2 with the second rotational position R2 based on the actual measured value of the rotational angle of the second shaft part 32 detected by the second angle sensor 42. Then, the multi-rotation speed of the first shaft portion 31 is calculated. According to such calculation of the multi-rotation number n, in one embodiment, the number of teeth T1 of the first shaft portion 31 and the number of teeth T2 of the second shaft portion 32 may be relatively prime. Thus, the design freedom of the first shaft portion 31 and the second shaft portion 32 is improved by the relationship in which the number of teeth T1 and the number of teeth T2 are prime. As a result, it is easy to reduce the size of the second shaft portion 32 including the number of teeth T <b> 2 set by the second shaft portion 32 and the second gear 34. Even if it is difficult to attach the angle sensor to the input shaft portion 15 and the output shaft portion 12, the first shaft portion 31 is rotated by the first angle sensor 41 and the second angle sensor 42 provided in the intermediate shaft portion 30. The number n is obtained. Furthermore, the multi-rotation speed n of the first shaft portion 31 compares the theoretical value Rt2 assumed in the second shaft portion 32 with the second rotation position R2 based on the actual measurement value detected by the second angle sensor 42. Calculated. Therefore, an electrical backup for holding the position of the first shaft portion 31 is not necessary, and a large-capacity storage means for storing a data table having a large data amount is not necessary. Therefore, the multi-rotation speed can be easily obtained without increasing the size of the physique with a simple structure and without requiring a backup.

一実施形態では、出力軸部12は中空の筒状に形成されている。これにより、出力軸部12の内側に手先部などへ伸びる配線が収容される。したがって、配線の絡まりを低減することができ、露出する配線の減少により美感を高めることができる。また、中空の出力軸部12によって、軽量化を図ることができる。ここで、出力軸部12が中空の場合、角度センサを設けることができず、出力軸部12の回転角度を取得することは難しい。しかし、一実施形態では、中間軸部30から多回転数を取得することにより、出力軸部12の形状に関わらず、多回転数を取得することができ、アクチュエータ装置10で駆動される部材の回転位置および姿勢を取得することができる。   In one embodiment, the output shaft portion 12 is formed in a hollow cylindrical shape. As a result, the wiring extending to the hand portion or the like is accommodated inside the output shaft portion 12. Therefore, the entanglement of the wiring can be reduced, and the aesthetics can be enhanced by the reduction of the exposed wiring. Further, the hollow output shaft portion 12 can reduce the weight. Here, when the output shaft portion 12 is hollow, an angle sensor cannot be provided, and it is difficult to acquire the rotation angle of the output shaft portion 12. However, in one embodiment, by acquiring the multi-rotation number from the intermediate shaft part 30, the multi-rotation number can be acquired regardless of the shape of the output shaft part 12, and the member driven by the actuator device 10 can be obtained. The rotational position and posture can be acquired.

一実施形態では、第二角度センサ42に求められる解像度は、一回転を第二ギア34の歯数T2で除した最大値X程度に過ぎない。そのため、第二角度センサ42には、高い解像度が要求されない。これにより、第二角度センサ42は、例えば単回転を検出するような安価な小型の磁気エンコーダも適用可能である。したがって、機器の小型化および簡略化を図ることができる。   In one embodiment, the resolution required for the second angle sensor 42 is only about the maximum value X obtained by dividing one rotation by the number of teeth T <b> 2 of the second gear 34. For this reason, the second angle sensor 42 is not required to have a high resolution. Thereby, for the second angle sensor 42, for example, an inexpensive small magnetic encoder that detects a single rotation is also applicable. Therefore, the device can be reduced in size and simplified.

(その他の実施形態)
以上説明した本発明は、上記実施形態に限定されるものではなく、その要旨を逸脱しない範囲で種々の実施形態に適用可能である。
(Other embodiments)
The present invention described above is not limited to the above-described embodiment, and can be applied to various embodiments without departing from the gist thereof.

例えば、図1の構成の実施形態を用いた例では、駆動力伝達部13の中間軸部30は、2本の第一軸部31および第二軸部32を有している。しかし、図2に示すように、駆動力伝達部13の中間軸部20は、第一軸部21、第二軸部22および第三軸部23の3本でもよく、図示しないものの4本以上であってもよい。この図2に示す3本の中間軸部20を有する例の場合、入力軸部15に近い2本の中間軸部20、すなわち第一軸部21および第二軸部22を用いて多回転数を算出することが望ましい。   For example, in the example using the embodiment having the configuration shown in FIG. 1, the intermediate shaft portion 30 of the driving force transmission portion 13 has two first shaft portions 31 and second shaft portions 32. However, as shown in FIG. 2, the intermediate shaft portion 20 of the driving force transmission portion 13 may be the first shaft portion 21, the second shaft portion 22, and the third shaft portion 23. It may be. In the case of the example having the three intermediate shaft portions 20 shown in FIG. 2, the number of rotations is increased by using two intermediate shaft portions 20 close to the input shaft portion 15, that is, the first shaft portion 21 and the second shaft portion 22. It is desirable to calculate

入力軸部15から出力軸部12までの駆動力伝達部13に複数の中間軸部20があるとき、バックラッシュなどの誤差の影響を受けやすい。そして、この誤差は、出力軸部12に近い側ほど大きくなる傾向にある。そこで、入力軸部15に近い2本の中間軸部20、すなわち第一軸部21および第二軸部22を用いて多回転数を検出することにより、検出される多回転数および角度の精度は向上する。したがって、検出精度を高めることができるとともに、検出した値をフィードバック制御にも用いることができる。   When there are a plurality of intermediate shaft portions 20 in the driving force transmission portion 13 from the input shaft portion 15 to the output shaft portion 12, it is easily affected by errors such as backlash. This error tends to increase as the side is closer to the output shaft portion 12. Therefore, by detecting the multi-rotation number using the two intermediate shaft parts 20 close to the input shaft part 15, that is, the first shaft part 21 and the second shaft part 22, the accuracy of the detected multi-rotation number and angle is detected. Will improve. Therefore, the detection accuracy can be increased and the detected value can also be used for feedback control.

図面中、10はアクチュエータ装置、11は動力源、12は出力軸部、13は駆動力伝達部、15は入力軸部、20、30は中間軸部、21、31は第一軸部、22、32は第二軸部、41は第一角度センサ、42は第二角度センサ、52は多回転数算出部(多回転数算出手段)、61は第一回転位置算出部(第一回転位置算出手段)、62は第二回転位置算出部(第二回転位置算出手段)、63は理論値算出部(理論値算出手段)、64は多回転数決定部(多回転数決定手段)を示す。   In the drawings, 10 is an actuator device, 11 is a power source, 12 is an output shaft portion, 13 is a driving force transmission portion, 15 is an input shaft portion, 20 and 30 are intermediate shaft portions, 21 and 31 are first shaft portions, 22 , 32 is a second shaft portion, 41 is a first angle sensor, 42 is a second angle sensor, 52 is a multi-revolution number calculation unit (multi-revolution number calculation means), and 61 is a first rotation position calculation unit (first rotation position). Calculation means), 62 is a second rotation position calculation section (second rotation position calculation means), 63 is a theoretical value calculation section (theoretical value calculation means), and 64 is a multi-rotation speed determination section (multi-rotation speed determination means). .

Claims (5)

回転する入力軸部を有する動力源と、
前記入力軸部に入力された駆動力を出力する出力軸部と、
前記入力軸部に近い第一軸部、および前記第一軸部と噛み合って前記出力軸部に近い第二軸部の少なくとも2本の中間軸部を有し、前記入力軸部に入力された駆動力を減速して前記出力軸部へ伝達する駆動力伝達部と、
前記第一軸部に設けられ、前記第一軸部の回転角度の絶対値を検出する第一角度センサと、
前記第二軸部に設けられ、前記第二軸部の回転角度の絶対値を検出する第二角度センサと、
前記第一角度センサで検出した前記第一軸部の回転角度に基づいて算出した前記第一軸部の多回転数ごとの前記第二角度センサの理論値と前記第二角度センサの実測値との差分から、前記第一軸部の多回転数を算出する多回転数算出手段と、
を備えるアクチュエータ装置。
A power source having a rotating input shaft,
An output shaft that outputs the driving force input to the input shaft; and
The first shaft portion close to the input shaft portion and the second shaft portion meshing with the first shaft portion and close to the output shaft portion have at least two intermediate shaft portions, and are input to the input shaft portion A driving force transmission portion that decelerates the driving force and transmits the driving force to the output shaft portion;
A first angle sensor provided on the first shaft portion for detecting an absolute value of a rotation angle of the first shaft portion;
A second angle sensor provided on the second shaft portion for detecting an absolute value of a rotation angle of the second shaft portion;
The theoretical value of the second angle sensor and the actual measurement value of the second angle sensor calculated for each multi-rotation number of the first shaft portion calculated based on the rotation angle of the first shaft portion detected by the first angle sensor. Multi-rotation number calculating means for calculating the multi-rotation number of the first shaft portion from the difference between,
An actuator device comprising:
前記多回転数算出手段は、
前記第一角度センサで検出した前記第一軸部の回転角度r11から予め設定されている前記第一軸部の原点位置である第一軸原点r10を減じて、第一回転位置R1=r11−r10を算出する第一回転位置算出手段と、
前記第二角度センサで検出した前記第二軸部の回転角度r21から予め設定されている前記第二軸部の原点位置である第二軸原点r20を減じて、第二回転位置R2=r21−r22を算出する第二回転位置算出手段と、
前記第一回転位置算出手段で算出した前記第一回転位置R1から前記第一軸部がn回転したときの前記第二角度センサの理論値Rt2を算出する理論値算出手段と、
前記理論値算出手段で算出した前記理論値Rt2と前記第二回転位置算出手段で算出した前記第二回転位置R2との差分K=|R2−Rt2|を、前記第一軸部の多回転数nが前記第一軸部と前記第二軸部との歯数によって決定される検出可能最大多回転数Lになるまで算出し、前記差分Kが最小となる最小差分Ktempに対応する前記第一軸部の多回転数nを前記第一軸部の多回転数Nminとして決定する多回転数決定手段と、
を有する請求項1記載のアクチュエータ装置。
The multi-rotation number calculating means includes
A first rotation position R1 = r11− is obtained by subtracting a preset first axis origin r10, which is the origin position of the first axis, from the rotation angle r11 of the first axis detected by the first angle sensor. first rotational position calculating means for calculating r10;
A second rotation position R2 = r21− is obtained by subtracting a second axis origin r20 which is a preset origin position of the second axis part from a rotation angle r21 of the second axis part detected by the second angle sensor. a second rotational position calculating means for calculating r22;
Theoretical value calculation means for calculating a theoretical value Rt2 of the second angle sensor when the first shaft portion has rotated n times from the first rotation position R1 calculated by the first rotation position calculation means;
The difference K = | R2−Rt2 | between the theoretical value Rt2 calculated by the theoretical value calculating means and the second rotational position R2 calculated by the second rotational position calculating means is the number of multiple revolutions of the first shaft portion. n is calculated until it reaches a maximum detectable multi-rotation speed L determined by the number of teeth between the first shaft portion and the second shaft portion, and the first difference corresponding to the minimum difference Ktemp that minimizes the difference K A multi-rotation number determining means for determining the multi-rotation number n of the shaft portion as the multi-rotation number Nmin of the first shaft portion;
The actuator device according to claim 1, comprising:
前記第一軸部の歯数と前記第二軸部との歯数とは、互いに素となる関係である請求項1または2記載のアクチュエータ装置。   The actuator device according to claim 1 or 2, wherein the number of teeth of the first shaft portion and the number of teeth of the second shaft portion are coprime. 前記出力軸部は、中空の筒状に形成されている請求項1から3のいずれか一項記載のアクチュエータ装置。   The actuator device according to claim 1, wherein the output shaft portion is formed in a hollow cylindrical shape. 前記駆動力伝達部が3本以上の前記中間軸部を有するとき、
前記第一軸部および前記第二軸部は、前記入力軸部に近い2本の前記中間軸部である請求項1から4のいずれか一項記載のアクチュエータ装置。
When the driving force transmission part has three or more intermediate shaft parts,
5. The actuator device according to claim 1, wherein the first shaft portion and the second shaft portion are two intermediate shaft portions close to the input shaft portion.
JP2014147770A 2014-07-18 2014-07-18 Actuator device Active JP6303888B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014147770A JP6303888B2 (en) 2014-07-18 2014-07-18 Actuator device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014147770A JP6303888B2 (en) 2014-07-18 2014-07-18 Actuator device

Publications (2)

Publication Number Publication Date
JP2016024025A JP2016024025A (en) 2016-02-08
JP6303888B2 true JP6303888B2 (en) 2018-04-04

Family

ID=55270900

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014147770A Active JP6303888B2 (en) 2014-07-18 2014-07-18 Actuator device

Country Status (1)

Country Link
JP (1) JP6303888B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6934788B2 (en) * 2017-09-19 2021-09-15 ミネベアミツミ株式会社 Angle detection device, rotation amount identification unit and rotation drive unit

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10249755A (en) * 1997-03-14 1998-09-22 Sony Corp Robot device
JP4483060B2 (en) * 2000-09-22 2010-06-16 ソニー株式会社 Actuator device
JP2004150950A (en) * 2002-10-30 2004-05-27 Koyo Seiko Co Ltd Rotation angle detector
KR100528645B1 (en) * 2004-01-15 2005-11-15 현대모비스 주식회사 Method for measuring the absolute steering angle of steering shaft for vehicle
JP2007271330A (en) * 2006-03-30 2007-10-18 Furukawa Electric Co Ltd:The Rotation sensor
JP2012141217A (en) * 2010-12-28 2012-07-26 Minebea Co Ltd Rotation sensor

Also Published As

Publication number Publication date
JP2016024025A (en) 2016-02-08

Similar Documents

Publication Publication Date Title
JP4559982B2 (en) Rotation angle detection device and initial setting method thereof
CN111108346B (en) Angle detecting device, rotation amount designating unit, and rotation driving unit
JP5216462B2 (en) Rotary encoder and operation method thereof
JP5893498B2 (en) Power steering device and control device for power steering device
US7681688B2 (en) Steering apparatus
WO2014103550A1 (en) Manipulator
JP5878381B2 (en) Multi-turn absolute rotary encoder
JP2008039737A (en) Method of calculating amount of multi-rotation, multi-rotation absolute value encoder device having no battery, and actuator with reduction gears using the same
JP2008148412A (en) Motor control device
JP6303888B2 (en) Actuator device
JP5177639B2 (en) Magnetic encoder device and position detection method using the same
JP2019207204A (en) Rotation detector and electric power steering device using the same
US10598512B2 (en) Batteryless rotary encoder
JP2009109274A (en) Rotation angle detection device
JP2013164316A (en) Multi-rotation absolute rotary encoder
JP6310189B2 (en) Correction method of rotation angle command value
JP5096399B2 (en) Rotation angle detector
WO2021153613A1 (en) Absolute encoder, program for outputting angle error information about absolute encoder, and method for outputting angle error information about absolute encoder
US10422668B2 (en) Method and program for angle calibration of rotary shaft
US11789426B2 (en) Motor control angle sensor, motor control system, and control method for motor control angle sensor
JP2019207205A (en) Rotation detector and electric power steering device using the same
JP5147531B2 (en) Rotation angle detection device and manufacturing method thereof
JP5706355B2 (en) Rotation angle detector
JP2013120090A (en) Rotation angle detector
KR20150019343A (en) Geared encoder motor and the control system thereof

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170116

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20171019

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180219

R150 Certificate of patent or registration of utility model

Ref document number: 6303888

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250