JP7345299B2 - Correction device and correction method - Google Patents
Correction device and correction method Download PDFInfo
- Publication number
- JP7345299B2 JP7345299B2 JP2019129563A JP2019129563A JP7345299B2 JP 7345299 B2 JP7345299 B2 JP 7345299B2 JP 2019129563 A JP2019129563 A JP 2019129563A JP 2019129563 A JP2019129563 A JP 2019129563A JP 7345299 B2 JP7345299 B2 JP 7345299B2
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- displacement
- gear reducer
- transmission error
- wave gear
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16H—GEARING
- F16H1/00—Toothed gearings for conveying rotary motion
- F16H1/28—Toothed gearings for conveying rotary motion with gears having orbital motion
- F16H1/32—Toothed gearings for conveying rotary motion with gears having orbital motion in which the central axis of the gearing lies inside the periphery of an orbital gear
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Retarders (AREA)
Description
この発明は、波動歯車減速機の角度伝達誤差を補正する補正装置及び補正方法に関する。 The present invention relates to a correction device and a correction method for correcting angular transmission error in a wave gear reducer.
従来、波動歯車減速機の角度伝達誤差を補正する方法として、事前測定方式が挙げられる(例えば特許文献1参照)。角度伝達誤差は、図5に示すように、波動歯車減速機に任意の回転角を入力した際に波動歯車減速機から出力される理論上の回転角と実際の回転角との差である。図5において、符号501は理論上の出力回転角を示し、符号502は実際の出力回転角を示し、符号503は角度伝達誤差を示している。事前測定方式では、事前に、波動歯車減速機の角度伝達誤差と、波動歯車減速機を駆動するアクチュエータの位相との関係を測定し、その関係に基づいて角度伝達誤差の補正を行う。
Conventionally, as a method for correcting the angular transmission error of a strain wave gear reducer, there is a pre-measurement method (see, for example, Patent Document 1). As shown in FIG. 5, the angle transmission error is the difference between the theoretical rotation angle output from the wave gear reducer and the actual rotation angle when an arbitrary rotation angle is input to the wave gear reducer. In FIG. 5,
しかしながら、事前測定方式では、アクチュエータの交換等によってアクチュエータの位相が変わると、角度伝達誤差に位相ずれが生じてしまう。そのため、このような場合には、角度伝達誤差とアクチュエータの位相との関係を再測定する必要がある。 However, in the advance measurement method, if the phase of the actuator changes due to actuator replacement or the like, a phase shift occurs in the angle transmission error. Therefore, in such a case, it is necessary to re-measure the relationship between the angular transmission error and the phase of the actuator.
この発明は、上記のような課題を解決するためになされたもので、再測定を行うことなく、角度伝達誤差の位相ずれを補正可能な補正装置を提供することを目的としている。 The present invention was made to solve the above-mentioned problems, and an object of the present invention is to provide a correction device capable of correcting a phase shift of an angular transmission error without re-measuring.
この発明に係る補正装置は、波動歯車減速機が有するフレクスプラインを駆動するアクチュエータの回転位置を検出する回転検出器と、波動歯車減速機におけるウェーブジェネレータの回転に伴うサーキュラスプラインの変位を検出するセンサと、センサにより検出された変位、及び、事前測定で当該センサにより検出された変位の時間変化と波動歯車減速機の角度伝達誤差の初期値の時間変化との位相関係に基づいて、当該角度伝達誤差の補正値を算出する演算部と、演算部により算出された補正値及び回転検出器により検出された回転位置に基づいて、アクチュエータを制御する制御部とを備えたことを特徴とする。 A correction device according to the present invention includes a rotation detector that detects the rotational position of an actuator that drives a flex spline included in a wave gear reducer, and a sensor that detects displacement of a circular spline accompanying rotation of a wave generator in the wave gear reducer. , the displacement detected by the sensor, and the phase relationship between the time change of the displacement detected by the sensor in advance measurement and the time change of the initial value of the angular transmission error of the wave gear reducer. The present invention is characterized by comprising a calculation unit that calculates a correction value for an error, and a control unit that controls the actuator based on the correction value calculated by the calculation unit and the rotational position detected by the rotation detector.
この発明によれば、上記のように構成したので、再測定を行うことなく、角度伝達誤差の位相ずれを補正可能となる。 According to the present invention, with the above configuration, it is possible to correct the phase shift of the angular transmission error without re-measuring.
以下、この発明の実施の形態について図面を参照しながら詳細に説明する。
実施の形態1.
図1は実施の形態1に係る補正装置1の構成例を示す図である。
補正装置1は、波動歯車減速機2の角度伝達誤差を補正する装置である。補正装置1は、図1に示すように、回転検出器11、センサ12、記憶部13、演算部14及び制御部15を備えている。なお、演算部14及び制御部15は、システムLSI(Large Scale Integration)等の処理回路、又はメモリ等に記憶されたプログラムを実行するCPU(Central Processing Unit)等により実現される。図1では、補正装置1に加え、波動歯車減速機2及びアクチュエータ3を示している。
Embodiments of the present invention will be described in detail below with reference to the drawings.
FIG. 1 is a diagram showing a configuration example of a
The
波動歯車減速機2は、楕円と真円の差動を利用した減速機である。波動歯車減速機2は、図2に示すように、サーキュラスプライン21、ウェーブジェネレータ22及びフレクスプライン23を有している。
The strain wave
サーキュラスプライン21は、リング状の剛体部品である。サーキュラスプライン21は、内周に歯が刻まれており、フレクスプライン23より歯数が2枚多い。サーキュラスプライン21は、通常、ケーシングに固定される。
ウェーブジェネレータ22は、楕円状のカムの外周に薄肉のボールベアリングを組合わせた部品である。ボールベアリングでは、内輪はカムに固定されているが、外輪はボールを介して弾性変形する。ウェーブジェネレータ22は、通常、入力軸(アクチュエータ3)に取付けられる。
フレクスプライン23は、薄肉カップ状の金属弾性体部品である。フレクスプライン23は、開口部外周に歯が刻まれている。フレクスプライン23の底をダイヤフラムと呼び、通常、出力軸(例えばロボットアーム)に取付けられる。
The
The
The
フレクスプライン23は、ウェーブジェネレータ22により楕円状に撓められ、長軸の部分でサーキュラスプライン21と歯が噛合い、短軸の部分では歯が完全に離れた状態となる。サーキュラスプライン21を固定してウェーブジェネレータ22を時計方向に回すと、フレクスプライン23は弾性変形し、サーキュラスプライン21との歯の噛合い位置が順次移動していく。ウェーブジェネレータ22が1回転すると、歯数差2枚分だけフレクスプライン23は反時計方向へ移動する。
The
アクチュエータ3は、波動歯車減速機2が有するウェーブジェネレータ22を駆動する。
The actuator 3 drives a
回転検出器11は、アクチュエータ3の回転位置を検出する。回転検出器11としては、例えばエンコーダを用いることができる。
The
センサ12は、波動歯車減速機2におけるウェーブジェネレータ22の回転に伴うサーキュラスプライン21の変位を検出する。センサ12は、サーキュラスプライン21の変位として、例えば、サーキュラスプライン21に対する応力又はサーキュラスプライン21の変形を検出する。センサ12としては、例えば、歪センサ又は光電センサ等を用いることができる。図2では、センサ12として歪センサを用いた場合を示し、歪センサがサーキュラスプライン21に取付けられた場合を示している。センサ12として光電センサを用いる場合には、光電センサをサーキュラスプライン21に対向配置し、光電センサからサーキュラスプライン21までの距離を測定することでサーキュラスプライン21の変形を検出可能である。
The
記憶部13は、事前測定でセンサ12により検出された変位の時間変化と波動歯車減速機2の角度伝達誤差の初期値の時間変化との位相関係を示す情報を記憶する。記憶部13は、HDD(Hard Disk Drive)、DVD(Digital Versatile Disc)又はメモリ等によって構成される。
The
なお図1では、記憶部13が補正装置1の内部に設けられた場合を示している。しかしながら、これに限らず、記憶部13は補正装置1の外部に設けられていてもよい。
Note that FIG. 1 shows a case where the
演算部14は、センサ12により検出された変位及び記憶部13に記憶された情報が示す位相関係に基づいて、角度伝達誤差の補正値を算出する。この際、演算部14は、変位の発生タイミング及び事前測定での当該変位と角度伝達誤差との位相関係に基づいて当該角度伝達誤差の位相ずれを推定し、当該位相ずれに応じて当該角度伝達誤差の補正値を算出する。
The
制御部15は、演算部14により算出された補正値及び回転検出器11により検出された回転位置に基づいて、アクチュエータ3を制御する。この制御部15により、波動歯車減速機2の角度伝達誤差を補正する。
The
次に、図1に示す実施の形態1に係る補正装置1の動作例について、図3を参照しながら説明する。なお、記憶部13は、事前測定でセンサ12により検出された変位の時間変化と波動歯車減速機2の角度伝達誤差の初期値の時間変化との位相関係を示す情報を記憶している。
図1に示す実施の形態1に係る補正装置1の動作例では、図3に示すように、まず、回転検出器11は、アクチュエータ3の回転位置を検出する(ステップST301)。
Next, an example of the operation of the
In the operation example of the
また、センサ12は、ウェーブジェネレータ22の回転に伴うサーキュラスプライン21の変位を検出する(ステップST302)。
Furthermore, the
次いで、演算部14は、センサ12により検出された変位及び記憶部13に記憶された情報が示す位相関係に基づいて、角度伝達誤差の補正値を算出する(ステップST303)。ここで、アクチュエータ3の交換等によってアクチュエータ3の位相が変わると、角度伝達誤差に位相ずれが生じてしまう。そこで、演算部14は、上記変位の発生タイミング及び事前測定での当該変位と角度伝達誤差との位相関係に基づいて当該角度伝達誤差の位相ずれを推定する。そして、演算部14は、推定した位相ずれに応じ、角度伝達誤差の補正値を算出する。
Next, the
このように、図1に示す実施の形態1に係る補正装置1では、記憶部13が事前測定でセンサ12により検出された変位の時間変化と波動歯車減速機2の角度伝達誤差の初期値の時間変化との位相関係を示す情報を記憶し、センサ12がウェーブジェネレータ22の回転に伴うサーキュラスプライン21の変位を検出している。そして、図4に示すように、角度伝達誤差とセンサ12により検出される変位は、共に、ウェーブジェネレータ22が1回転する間に2回発生する。また、センサ12により検出される変位と角度伝達誤差との位相関係は、アクチュエータ3の交換等によりアクチュエータ3の位相が変化しても変化しない。そのため、演算部14では、センサ12により検出される変位の位相から角度伝達誤差の位相ずれを算出可能である。なお図4Aにおいて、符号401は事前測定での角度伝達誤差の初期値の時間変化を示し、符号402は事前測定でセンサ12により検出された変位の時間変化を示している。また、符号403はアクチュエータ3の交換等により位相が変化した後においてセンサ12により検出された変位の時間変化を示している。また、符号404は角度伝達誤差の位相ずれを示し、符号405は演算部14により推定された位相ずれが生じた場合での角度伝達誤差の時間変化を示している。
In this way, in the
次いで、制御部15は、演算部14により算出された補正値及び回転検出器11により検出された回転位置に基づいて、アクチュエータ3を制御する(ステップST304)。
以上の動作により、実施の形態1に係る補正装置1では、アクチュエータ3の位相が変化した場合でも再測定せずに角度伝達誤差を補正可能となる。
Next, the
With the above-described operation, the
また、回転検出器11は、バックアップ(位相記録)用の電池を有している。一方、従来では、回転検出器11の電池が切れた場合、電池交換による回転検出器11の原点の再校正が必要となり、その結果、波動歯車減速機2が取付けられた装置の分解が必要となる。これに対し、実施の形態1に係る補正装置1では、上記電池交換を行った場合でも、回転検出器11の電池交換前後での角度伝達誤差の位相ずれを検出可能であり、装置を分解せずに角度伝達誤差をオンラインで補正できる。
Moreover, the
以上のように、この実施の形態1によれば、補正装置1は、波動歯車減速機2が有するフレクスプライン23を駆動するアクチュエータ3の回転位置を検出する回転検出器11と、波動歯車減速機2におけるウェーブジェネレータ22の回転に伴うサーキュラスプライン21の変位を検出するセンサ12と、センサ12により検出された変位、及び、事前測定でセンサ12により検出された変位の時間変化と波動歯車減速機2の角度伝達誤差の初期値の時間変化との位相関係に基づいて、当該角度伝達誤差の補正値を算出する演算部14と、演算部14により算出された補正値及び回転検出器11により検出された回転位置に基づいて、アクチュエータ3を制御する制御部15とを備えた。これにより、実施の形態1に係る補正装置1は、再測定を行うことなく、角度伝達誤差の位相ずれを補正可能となる。
As described above, according to the first embodiment, the
なお、本願発明はその発明の範囲内において、実施の形態の任意の構成要素の変形、若しくは実施の形態の任意の構成要素の省略が可能である。 Note that within the scope of the present invention, any constituent elements of the embodiments may be modified or any constituent elements of the embodiments may be omitted.
1 補正装置
2 波動歯車減速機
3 アクチュエータ
11 回転検出器
12 センサ
13 記憶部
14 演算部
15 制御部
21 サーキュラスプライン
22 ウェーブジェネレータ
23 フレクスプライン
1
Claims (4)
前記波動歯車減速機におけるウェーブジェネレータの回転に伴うサーキュラスプラインの変位を検出するセンサと、
前記センサにより検出された変位、及び、事前測定で当該センサにより検出された変位の時間変化と前記波動歯車減速機の角度伝達誤差の初期値の時間変化との位相関係に基づいて、当該角度伝達誤差の補正値を算出する演算部と、
前記演算部により算出された補正値及び前記回転検出器により検出された回転位置に基づいて、前記アクチュエータを制御する制御部と
を備えた補正装置。 a rotation detector that detects the rotational position of an actuator that drives a flexspline included in the wave gear reducer;
a sensor that detects displacement of a circular spline accompanying rotation of a wave generator in the wave gear reducer;
The angle transmission is performed based on the displacement detected by the sensor, and the phase relationship between the time change of the displacement detected by the sensor in advance measurement and the time change of the initial value of the angular transmission error of the wave gear reducer. a calculation unit that calculates an error correction value;
A control unit that controls the actuator based on the correction value calculated by the calculation unit and the rotational position detected by the rotation detector.
ことを特徴とする請求項1記載の補正装置。 The correction device according to claim 1, wherein the sensor detects stress on the circular spline or deformation of the circular spline.
ことを特徴とする請求項1又は請求項2記載の補正装置。 The calculation unit estimates the phase shift of the angle transmission error based on the timing of occurrence of the displacement and the phase relationship between the displacement and the initial value of the angle transmission error in advance measurement, and adjusts the angle transmission according to the phase shift. The correction device according to claim 1 or 2, further comprising calculating a correction value for the error.
前記センサにより検出された変位、及び、事前測定で当該センサにより検出された変位の時間変化と前記波動歯車減速機の角度伝達誤差の初期値の時間変化との位相関係に基づいて、当該角度伝達誤差の補正値を算出する演算ステップと、
前記演算ステップにおいて算出した補正値及び前記回転検出器により検出された回転位置に基づいて、前記アクチュエータを制御する制御ステップとを有する
ことを特徴とする補正方法。 A correction device including a rotation detector that detects the rotational position of an actuator that drives a flex spline included in a wave gear reducer, and a sensor that detects displacement of a circular spline accompanying rotation of a wave generator in the wave gear reducer. A correction method,
The angle transmission is performed based on the displacement detected by the sensor, and the phase relationship between the time change of the displacement detected by the sensor in advance measurement and the time change of the initial value of the angular transmission error of the wave gear reducer. a calculation step for calculating an error correction value;
A correction method comprising: a control step of controlling the actuator based on the correction value calculated in the calculation step and the rotational position detected by the rotation detector.
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019129563A JP7345299B2 (en) | 2019-07-11 | 2019-07-11 | Correction device and correction method |
| PCT/JP2020/025969 WO2021006169A1 (en) | 2019-07-11 | 2020-07-02 | Correction device and correction method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019129563A JP7345299B2 (en) | 2019-07-11 | 2019-07-11 | Correction device and correction method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2021014874A JP2021014874A (en) | 2021-02-12 |
| JP7345299B2 true JP7345299B2 (en) | 2023-09-15 |
Family
ID=74115252
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2019129563A Active JP7345299B2 (en) | 2019-07-11 | 2019-07-11 | Correction device and correction method |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP7345299B2 (en) |
| WO (1) | WO2021006169A1 (en) |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008090692A (en) | 2006-10-04 | 2008-04-17 | Harmonic Drive Syst Ind Co Ltd | Actuator position fluctuation suppression method |
| JP2011220380A (en) | 2010-04-05 | 2011-11-04 | Yaskawa Electric Corp | Actuator and robot |
| JP2016156637A (en) | 2015-02-23 | 2016-09-01 | 株式会社ロボテック | Torque sensor for transmission, and transmission with torque sensor |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0481907A (en) * | 1990-07-24 | 1992-03-16 | Harmonic Drive Syst Ind Co Ltd | Minute positioning device |
-
2019
- 2019-07-11 JP JP2019129563A patent/JP7345299B2/en active Active
-
2020
- 2020-07-02 WO PCT/JP2020/025969 patent/WO2021006169A1/en not_active Ceased
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008090692A (en) | 2006-10-04 | 2008-04-17 | Harmonic Drive Syst Ind Co Ltd | Actuator position fluctuation suppression method |
| JP2011220380A (en) | 2010-04-05 | 2011-11-04 | Yaskawa Electric Corp | Actuator and robot |
| JP2016156637A (en) | 2015-02-23 | 2016-09-01 | 株式会社ロボテック | Torque sensor for transmission, and transmission with torque sensor |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2021006169A1 (en) | 2021-01-14 |
| JP2021014874A (en) | 2021-02-12 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6460697B2 (en) | Angle detection method, angle detection apparatus, and robot apparatus | |
| JP2021014876A (en) | Failure determination device and failure determination method | |
| US10259121B2 (en) | Robot apparatus, and measuring method of rotation driving apparatus | |
| US8912928B2 (en) | Encoder, driving apparatus, method for calculating absolute position, and method for manufacturing encoder | |
| JP7338960B2 (en) | Servo control device and servo control method | |
| JP7343101B2 (en) | Rotation angle detection sensor, torque detection sensor, and power transmission device | |
| JP7173010B2 (en) | Calibration device, encoder device, drive device, stage device, robot device, manufacturing method of encoder device, and calibration program | |
| JP7000263B2 (en) | Initial setting method and initial setting device | |
| JP2015219096A (en) | Multiple-rotation encoder | |
| JP2026063143A (en) | Position detection device, position detection method, and position detection program | |
| JP7345299B2 (en) | Correction device and correction method | |
| JP6341141B2 (en) | Correction method of zero error of torque sensor | |
| JP7805852B2 (en) | Calibration device, calibration method, and calibration program | |
| JP7264931B2 (en) | Gimbal and system with same | |
| JP7546438B2 (en) | Correction system, correction device, and correction method | |
| US20090015188A1 (en) | Method for suppressing variation in speed of actuator | |
| JP5376338B2 (en) | Rotation angle detector | |
| JP7586019B2 (en) | Detection device, control device, and control method | |
| JP2016156637A (en) | Torque sensor for transmission, and transmission with torque sensor | |
| JP2014238117A (en) | Speed reducer-incorporated actuator and articulated robot with the same | |
| CN111492218A (en) | Correction method of zero point error in torque sensor | |
| JP2008257571A (en) | Servo control method | |
| JP2021071444A (en) | Rotation angle detector | |
| JP6853534B2 (en) | Torque sensor | |
| WO2024009514A1 (en) | Position detection system, actuator, and position detection method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220621 |
|
| TRDD | Decision of grant or rejection written | ||
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20230803 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20230808 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230905 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7345299 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |