JP6536559B2 - トルク制御装置 - Google Patents
トルク制御装置 Download PDFInfo
- Publication number
- JP6536559B2 JP6536559B2 JP2016252590A JP2016252590A JP6536559B2 JP 6536559 B2 JP6536559 B2 JP 6536559B2 JP 2016252590 A JP2016252590 A JP 2016252590A JP 2016252590 A JP2016252590 A JP 2016252590A JP 6536559 B2 JP6536559 B2 JP 6536559B2
- Authority
- JP
- Japan
- Prior art keywords
- torque
- value
- torque sensor
- switching
- output
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B5/00—Anti-hunting arrangements
- G05B5/01—Anti-hunting arrangements electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/046—Controlling the motor
- B62D5/0463—Controlling the motor calculating assisting torque from the motor based on driver input
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/08—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque
- B62D6/10—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque characterised by means for sensing or determining torque
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/32—Automatic controllers electric with inputs from more than one sensing element; with outputs to more than one correcting element
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37344—Torque, thrust, twist, machining force measurement
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39001—Robot, manipulator control
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/64—Electric machine technologies in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Robotics (AREA)
- Control Of Electric Motors In General (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Description
上述した特許文献1では、2つの制御演算手段の出力を切り替えた後にローパスフィルタ(LPF)を入れて、後段のモータ駆動機への入力の急激な変化を抑えている。ここで、制御演算手段の出力を切り替える際に急激な信号の変化が生じる。これを抑制するために、制御演算手段の出力に常に特定のカットオフ周波数のLPFを入れている。但し、出力を切り替えない通常時にも常にLPFが入っているため、常に出力信号に遅れが生じてしまう。
本発明の実施の形態2は、上述した実施の形態1の変形例である。トルクセンサ151及び152の両方とも故障した場合に、トルクセンサ値の代わりに電流値を用いたトルク推定値によりトルク制御を行うものである。例えば、切替部は、第1のトルクセンサ及び第2のトルクセンサの出力に加え、電流値を用いてトルク推定値を算出する第3のトルクセンサ(不図示)の出力を受け付ける。そして、第1から第3のトルクセンサによりそれぞれ検出されたトルクセンサ値に基づいて、トルクセンサの切替を行う。すなわち、第1又は第2のトルクセンサから第3のトルクセンサに切り替える場合に、トルク推定値を所定時間の間、第2のLPFに通すものである。これにより、切替時の出力の急激な変化をさらに抑えることができる。特に、第1又は第2のトルクセンサから第3のトルクセンサに切り替える場合は、値の急激な変化が大きいため、当該手法が効果的である。
11 位置制御器
12 トルク制御器
121 LPF1
122 摩擦トルク推定オブザーバ
13 電流制御器
14 モータ
151 トルクセンサ
152 トルクセンサ
16 ロボットハンド
17 トルクセンサ切替判断器
18 トルクセンサ切替器
181 スイッチ部
182 スイッチ部
183 LPF2
184 スイッチ部
Kt トルクフィードバック係数
Ki トルク定数
Kts トルクセンサ剛性
Kε1 トルクセンサ計測換算係数1
Kε2 トルクセンサ計測換算係数2
i モータ電流
Rm モータ抵抗
Lm モータインダクタンス
Jm モータイナーシャ
Jmn モータノミナルイナーシャ
Jl 負荷イナーシャ
L オブザーバゲイン
N 減速比
Um トルク指令
θm モータ角度
θl 負荷角度
^θm モータ角度の推定値
τm 中間トルク指令
τf 摩擦トルク(外乱)
τ モータトルク指令
τr モータ出力トルク
τt トルク
τext 外力トルク(環境)
τg 重力トルク
τt1 計測トルク値
τt2 計測トルク値
^τf 推定摩擦トルク
Pm 位置指令
P 位置
Claims (1)
- 先端に負荷が配置され、入力される電流に基づきトルクを出力するモータと、
前記モータが出力したトルクの出力値を検出する複数のトルクセンサと、
前記負荷の目標位置と前記複数のトルクセンサのいずれかが検出したトルクの出力値とに基づきトルク指令値を算出するトルク指令出力部と、
前記トルク指令値に基づき前記電流を制御する電流制御器と、
を備えるトルク制御装置であって、
前記トルク指令出力部は、
前記トルク指令値を第1の周波数によりカットオフして前記電流制御器へ出力する第1のローパスフィルタを含み、
前記トルク制御装置は、
前記複数のトルクセンサのうち第1のトルクセンサにより検出された第1のトルク値が所定条件を満たす場合に、第2のトルクセンサにより検出された第2のトルク値を前記トルク指令出力部へ出力するように切り替える切替部をさらに備え、
前記切替部は、
前記第2のトルク値を第2の周波数によりカットオフして前記トルク指令出力部へ出力する第2のローパスフィルタを含み、
前記切り替え時から所定時間の間に前記第2のローパスフィルタを使用し、当該所定時間経過後に前記第2のローパスフィルタを使用せずに前記第2のトルク値を前記トルク指令出力部へ出力し、
前記第2の周波数は、前記第1の周波数より高い、
トルク制御装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016252590A JP6536559B2 (ja) | 2016-12-27 | 2016-12-27 | トルク制御装置 |
US15/840,193 US10048654B2 (en) | 2016-12-27 | 2017-12-13 | Torque control apparatus |
CN201711430977.7A CN108238096B (zh) | 2016-12-27 | 2017-12-26 | 转矩控制装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016252590A JP6536559B2 (ja) | 2016-12-27 | 2016-12-27 | トルク制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018106446A JP2018106446A (ja) | 2018-07-05 |
JP6536559B2 true JP6536559B2 (ja) | 2019-07-03 |
Family
ID=62629723
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016252590A Active JP6536559B2 (ja) | 2016-12-27 | 2016-12-27 | トルク制御装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US10048654B2 (ja) |
JP (1) | JP6536559B2 (ja) |
CN (1) | CN108238096B (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017213182A1 (ja) * | 2016-06-07 | 2017-12-14 | 三菱電機株式会社 | 異常診断装置及び異常診断方法 |
CN109689478A (zh) * | 2016-09-16 | 2019-04-26 | 日本精工株式会社 | 电动助力转向装置 |
JP7131611B2 (ja) * | 2018-06-04 | 2022-09-06 | 日産自動車株式会社 | 異常判定装置及び異常判定方法 |
US11618163B2 (en) * | 2018-12-27 | 2023-04-04 | Fanuc Corporation | Industrial robot system |
JP7015276B2 (ja) * | 2018-12-27 | 2022-02-02 | ファナック株式会社 | 産業用ロボットシステム |
US11199151B2 (en) * | 2019-06-26 | 2021-12-14 | Cummins Inc. | Vehicle controller with complementary capacitance for analog-to-digital converter (A/D) low pass filter |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003101413A (ja) | 2001-09-25 | 2003-04-04 | Ricoh Co Ltd | Da変換器 |
JP2003312507A (ja) * | 2002-04-22 | 2003-11-06 | Nsk Ltd | 電動パワーステアリング装置 |
JP4061245B2 (ja) | 2003-05-30 | 2008-03-12 | 三菱電機株式会社 | 電動式パワーステアリング制御装置 |
JP4500604B2 (ja) * | 2004-07-05 | 2010-07-14 | カヤバ工業株式会社 | パワーステアリング装置 |
JP2006031627A (ja) * | 2004-07-21 | 2006-02-02 | Tietech Co Ltd | 位置決め制御装置及び位置決め制御方法 |
JP5499526B2 (ja) * | 2009-06-19 | 2014-05-21 | 株式会社ジェイテクト | 電動パワーステアリング装置 |
JP5573456B2 (ja) * | 2010-07-23 | 2014-08-20 | 日産自動車株式会社 | 電動車両の制振制御装置および電動車両の制振制御方法 |
JP5403163B2 (ja) * | 2011-06-21 | 2014-01-29 | 日本精工株式会社 | トルク検出装置の異常診断方法、電動パワーステアリング装置及びアイドリングストップ仕様車両 |
JP5892012B2 (ja) * | 2012-09-11 | 2016-03-23 | 日本精工株式会社 | 車載電子制御装置 |
EP2913648B1 (en) * | 2012-10-23 | 2019-12-18 | NSK Ltd. | Torque detection device, electric power steering device, and vehicle |
JP2014136525A (ja) * | 2013-01-17 | 2014-07-28 | Omron Automotive Electronics Co Ltd | ステアリング制御装置 |
JP5751433B2 (ja) * | 2013-02-06 | 2015-07-22 | 株式会社安川電機 | モータ制御装置及びモータ制御方法 |
KR101837332B1 (ko) * | 2014-02-24 | 2018-03-09 | 히다치 오토모티브 시스템즈 가부시키가이샤 | 차량 탑재 기기의 제어 장치 및 파워 스티어링 장치 |
-
2016
- 2016-12-27 JP JP2016252590A patent/JP6536559B2/ja active Active
-
2017
- 2017-12-13 US US15/840,193 patent/US10048654B2/en active Active
- 2017-12-26 CN CN201711430977.7A patent/CN108238096B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
US20180181083A1 (en) | 2018-06-28 |
US10048654B2 (en) | 2018-08-14 |
JP2018106446A (ja) | 2018-07-05 |
CN108238096A (zh) | 2018-07-03 |
CN108238096B (zh) | 2020-04-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6536559B2 (ja) | トルク制御装置 | |
JP2008312339A (ja) | 電動機の制御装置 | |
US9964582B2 (en) | Motor control device that detects breakage of motor power line or power element abnormality of motor power conversion device | |
WO2012014249A1 (ja) | 電動機制御装置及び電動機制御装置の制御方法 | |
JP7126049B2 (ja) | 電動機制御装置および電動機制御方法 | |
JP2006197726A (ja) | 位置決め制御装置および位置決め制御方法 | |
JP6193937B2 (ja) | 分流器の故障を検出する機能を有するモータ駆動装置 | |
US20160084724A1 (en) | Hydraulic pressure control device | |
JP2013034188A (ja) | 2重比較器を利用して、信号フィードバックなしで精密な信号整流およびタイミングシステムを容易にするための方法 | |
US9667181B2 (en) | Motor control circuit and method of monitoring a motor | |
JP2004064833A (ja) | 電動機制御装置 | |
JPWO2014207781A1 (ja) | リモートユニットおよびリモートユニットの異常判定方法 | |
JP6931980B2 (ja) | サーボ制御装置 | |
WO2018061452A1 (ja) | 電動機制御装置および電動機制御方法 | |
JP2016002931A (ja) | 軌道回路用送信器及びその故障検知方法 | |
JP5122258B2 (ja) | 電動パワーステアリング制御装置 | |
EP3203332B1 (en) | Automatic control device | |
JP6389167B2 (ja) | マイナループフィードバックフォールバックのための方法及びシステム | |
JP4999474B2 (ja) | 誘導機制御装置 | |
JP4993889B2 (ja) | 誘導機制御装置 | |
JP4308624B2 (ja) | エンジン制御装置 | |
JP2010124554A (ja) | 誘導機制御装置 | |
JP4164650B2 (ja) | A/d回路の故障検出方法およびサーボ装置 | |
KR101585118B1 (ko) | 서보 제어 장치 | |
JP6013168B2 (ja) | タービン過速度防止システム及び方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180619 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190417 |
|
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: 20190507 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190520 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6536559 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |