JP6303888B2 - Actuator device - Google Patents
Actuator device Download PDFInfo
- 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
Links
- 238000004364 calculation method Methods 0.000 claims description 54
- 230000005540 biological transmission Effects 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 11
- 238000001514 detection method Methods 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000004590 computer program Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 1
- 239000013585 weight reducing agent Substances 0.000 description 1
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.
そこで、本発明の目的は、入力軸部および出力軸部へ角度センサの取り付けが困難であっても、中間軸部に設けた角度センサから、簡単な構造で体格の大型化を招くことなく、バックアップや大容量の記憶手段を必要とすることなく多回転数を取得するアクチュエータ装置を提供することにある。 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.
以下、一実施形態によるアクチュエータ装置を図面に基づいて説明する。
図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
駆動力伝達部13は、この動力源11と出力軸部12との間に設けられている。出力軸部12は、入力軸部15から入力された駆動力を出力する。出力軸部12は、出力ギア17を有している。また、本実施形態の場合、出力軸部12は、中空の筒状に形成されている。これにより、出力軸部12の軽量化が図られている。駆動力伝達部13は、入力軸部15に入力された駆動力を減速して出力軸部12へ伝達する。図2に示す例の場合、駆動力伝達部13は、中間軸部20として第一軸部21、第二軸部22および第三軸部23を有している。
The driving
以下、説明の簡単のために、図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
アクチュエータ装置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
アクチュエータ装置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
多回転数算出部52は、第二軸部32に設けられた第二角度センサ42で想定される理論値と実測値との差分から第一軸部31の多回転数を算出する。ここで、第二角度センサ42で想定される理論値は、第一角度センサ41で検出した第一軸部31の回転角度に基づいて算出される。多回転数算出部52を構成する第一回転位置算出部61、第二回転位置算出部62、理論値算出部63および多回転数決定部64は、詳細には次のような処理を実行する。
The multi-rotation
第一回転位置算出部61は、第一回転位置R1を算出する。具体的には、第一回転位置算出部61は、第一角度センサ41から第一軸部31の回転角度r11を検出する。第一回転位置算出部61は、検出した回転角度r11から第一軸原点r10を減じることにより、第一回転位置R1をR1=r11−r10として算出する。ここで、第一軸原点r10は、文字通り第一軸部31の回転の基準となる原点であり、既知の値として定義され、制御ユニット51のROMに記憶されている。
The first rotational
第二回転位置算出部62は、第二回転位置R2を算出する。具体的には、第二回転位置算出部62は、第二角度センサ42から第二軸部32の回転角度r21を検出する。第二回転位置算出部62は、検出した回転角度r21から第二軸原点r20を減じることにより、第二回転位置R2をR2=r21−r20として算出する。ここで、第二軸原点r20は、文字通り第二軸部32の回転の基準となる原点であり、既知の値として定義され、制御ユニット51のROMに記憶されている。
The second rotational
理論値算出部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
多回転数決定部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
ここで、検出可能最大多回転数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
一方、例えば第一ギア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
多回転数決定部64は、検出可能最大多回転数Lを最大値として多回転数nごとに差分Kを算出する。多回転数決定部64は、算出した差分Kから、最小となる最小差分Ktempを抽出する。多回転数決定部64は、この抽出した最小差分Ktempに対応する第一軸部31の多回転数nを、第一軸部31の多回転数Nminとして決定する。
The multi-rotation
次に、上記の構成によるアクチュエータ装置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
The multi-rotation
第一回転位置算出部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
多回転数決定部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
多回転数決定部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
多回転数決定部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
多回転数決定部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
多回転数決定部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
以上の処理により、多回転数決定部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
以上説明した一実施形態では、第一軸部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
一実施形態では、出力軸部12は中空の筒状に形成されている。これにより、出力軸部12の内側に手先部などへ伸びる配線が収容される。したがって、配線の絡まりを低減することができ、露出する配線の減少により美感を高めることができる。また、中空の出力軸部12によって、軽量化を図ることができる。ここで、出力軸部12が中空の場合、角度センサを設けることができず、出力軸部12の回転角度を取得することは難しい。しかし、一実施形態では、中間軸部30から多回転数を取得することにより、出力軸部12の形状に関わらず、多回転数を取得することができ、アクチュエータ装置10で駆動される部材の回転位置および姿勢を取得することができる。
In one embodiment, the
一実施形態では、第二角度センサ42に求められる解像度は、一回転を第二ギア34の歯数T2で除した最大値X程度に過ぎない。そのため、第二角度センサ42には、高い解像度が要求されない。これにより、第二角度センサ42は、例えば単回転を検出するような安価な小型の磁気エンコーダも適用可能である。したがって、機器の小型化および簡略化を図ることができる。
In one embodiment, the resolution required for the
(その他の実施形態)
以上説明した本発明は、上記実施形態に限定されるものではなく、その要旨を逸脱しない範囲で種々の実施形態に適用可能である。
(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
入力軸部15から出力軸部12までの駆動力伝達部13に複数の中間軸部20があるとき、バックラッシュなどの誤差の影響を受けやすい。そして、この誤差は、出力軸部12に近い側ほど大きくなる傾向にある。そこで、入力軸部15に近い2本の中間軸部20、すなわち第一軸部21および第二軸部22を用いて多回転数を検出することにより、検出される多回転数および角度の精度は向上する。したがって、検出精度を高めることができるとともに、検出した値をフィードバック制御にも用いることができる。
When there are a plurality of
図面中、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:
前記第一軸部および前記第二軸部は、前記入力軸部に近い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.
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)
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)
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 |
-
2014
- 2014-07-18 JP JP2014147770A patent/JP6303888B2/en active Active
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 |