CN105356823A - Load torque observation and compensation method for servo system - Google Patents
Load torque observation and compensation method for servo system Download PDFInfo
- Publication number
- CN105356823A CN105356823A CN201510725173.4A CN201510725173A CN105356823A CN 105356823 A CN105356823 A CN 105356823A CN 201510725173 A CN201510725173 A CN 201510725173A CN 105356823 A CN105356823 A CN 105356823A
- Authority
- CN
- China
- Prior art keywords
- moment
- load torque
- value
- current
- servo system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
The invention provides a load torque observation and compensation method for a servo system. First, the given value of current of a current loop at a previous moment, the motor speed at the current moment and the motor speed at the previous moment are read; then, the observed value of the load torque at the current moment is calculated; and the output of a speed regulator and the given value of current of the current loop are obtained, and the observed value of the load torque is compensated. According to the invention, the capability of the servo system to inhibit disturbance is effectively improved, the design difficulty of the speed regulator is simplified, and the precision of the servo system is improved.
Description
Technical field
The present invention relates to interchange following control system, particularly relate to the observation and compensation method that exchange load torque in servomechanism.
Background technology
Along with the development of modernized war, armament systems improve gradually to the tracking of target and the requirement of disturbance rejection, such as Archibald weapon is when shooting, also need to carry out target following, and design impact moment and will the tracking accuracy of servomechanism be affected, also require that servomechanism is under certain disturbing moment (load torque), has certain tracking accuracy simultaneously.Improve follower system precision about disturbance cancelling moment, conventional method is generally the bandwidth sum open-loop gain as far as possible increasing servomechanism, increases integral element to eliminate steady-state error in speed ring controller.The restriction that the increase of bandwidth is subject to system time constant is limited, and excessive open-loop gain can cause the decline of the stability of a system, and therefore this method improves the ability of disturbance rejection is limited.
Summary of the invention
In order to overcome the deficiencies in the prior art, the invention provides a kind of the load torque observation and the compensation method that exchange servomechanism, the load torque of system is observed according to the input and output of servomechanism, and observed quantity is compensated in servomechanism, reduce the impact of disturbance on servomechanism tracking accuracy.
The technical solution adopted for the present invention to solve the technical problems comprises the following steps:
The given value of current value I of the electric current loop of the first step, the upper moment k-1 of reading
*, and motor speed ω (k) of current time k and a upper moment k-1 and ω (k-1) (k-1);
Second step, calculating
wherein, T
1(k) and T
1(k-1) intermediate variable in its k moment and k-1 moment is respectively, T
kfor the sampling period of speed ring, time constant is T
c, torque coefficient is K
t;
3rd step, the intermediate variable in calculating k moment
wherein, J converts to the total moment of inertia on motor shaft, and F is viscous friction coefficient;
4th step, the load torque measured value in calculating k moment
5th step, the speed regulator in reading k moment export u
ω(k), and the given value of current value calculating k moment electric current loop
realize the compensation of load torque measured value.
The invention has the beneficial effects as follows: by interchange servo system load torque observe of the present invention and compensation method, effectively can improve the rejection ability of servomechanism to disturbance, simplify the design difficulty of speed regulator, and the precision of servomechanism can be improved.
Embodiment
Below in conjunction with embodiment, the present invention is further described, the present invention includes but be not limited only to following embodiment.
The present invention establishes interchange servomechanism electric current loop to be simplified to inertial element, and time constant is T
cif torque coefficient is K
t, total moment of inertia of converting on motor shaft is J, and viscous friction coefficient is F, then the concrete steps realizing servo system load torque observe and compensation method are:
The first step: the given value of current value I reading the electric current loop in a upper moment (k-1 moment)
*, and the rotational speed omega (k) of current time (k moment) and a upper moment (k-1 moment) motor and ω (k-1) (k-1);
Second step: calculate
wherein, T
1for intermediate variable, T
1(k) and T
1(k-1) value in its k moment and k-1 moment is respectively, T
kfor the sampling period of speed ring;
3rd step: calculate
wherein, T
2for intermediate variable, T
2k () is the value in its k moment;
4th step: computational load torque observe value
wherein
for the load torque measured value in k moment;
5th step, the speed regulator reading the k moment exports u
ω(k), and the given value of current value I calculating k moment electric current loop
*(k), namely
realize the compensation of load torque measured value.
In embodiments of the invention, as the electric current loop time constant T of servomechanism
c=0.2ms, the sampling period T of speed ring
ktime=1ms (0.001s), then the concrete steps realizing servo system load torque observe and compensation method are:
The first step: the given value of current value I reading the electric current loop in a upper moment (k-1 moment)
*, and the rotational speed omega (k) of current time (k moment) and a upper moment (k-1 moment) motor and ω (k-1) (k-1);
Second step: calculate
3rd step: calculate
4th step: computational load torque observe value
5th step, the speed regulator reading the k moment exports u
ω(k), and the given value of current value I calculating k moment electric current loop
*(k), namely
realize the compensation of load torque measured value.
Claims (1)
1. the load torque of servomechanism is observed and a compensation method, it is characterized in that comprising the steps:
The given value of current value I of the electric current loop of the first step, the upper moment k-1 of reading
*, and motor speed ω (k) of current time k and a upper moment k-1 and ω (k-1) (k-1);
Second step, calculating
Wherein, T
1(k) and T
1(k-1) intermediate variable in its k moment and k-1 moment is respectively, T
kfor the sampling period of speed ring, time constant is T
c, torque coefficient is K
t;
3rd step, the intermediate variable in calculating k moment
wherein, J converts to the total moment of inertia on motor shaft, and F is viscous friction coefficient;
4th step, the load torque measured value in calculating k moment
5th step, the speed regulator in reading k moment export u
ω(k), and the given value of current value calculating k moment electric current loop
realize the compensation of load torque measured value.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510725173.4A CN105356823A (en) | 2015-10-30 | 2015-10-30 | Load torque observation and compensation method for servo system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510725173.4A CN105356823A (en) | 2015-10-30 | 2015-10-30 | Load torque observation and compensation method for servo system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105356823A true CN105356823A (en) | 2016-02-24 |
Family
ID=55332724
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510725173.4A Pending CN105356823A (en) | 2015-10-30 | 2015-10-30 | Load torque observation and compensation method for servo system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105356823A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108155845A (en) * | 2018-01-09 | 2018-06-12 | 江西理工大学 | Automobile, motor load torque Forecasting Methodology and device |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102075127A (en) * | 2011-01-04 | 2011-05-25 | 北京航空航天大学 | Permanent magnet synchronous motor servo driving device and position control method thereof |
KR101348338B1 (en) * | 2012-10-30 | 2014-01-16 | 한국전기연구원 | Apparatus for controlling antislip using load torque observer |
CN103647490A (en) * | 2013-09-27 | 2014-03-19 | 天津大学 | Permanent magnet motor sliding mode control strategy |
CN103997272A (en) * | 2014-06-09 | 2014-08-20 | 浙江理工大学 | Load disturbance compensation device and method of permanent magnet synchronous motor |
CN104104296A (en) * | 2014-06-04 | 2014-10-15 | 哈尔滨工业大学 | Method and device for mechanical resonant restraint |
CN104184382A (en) * | 2014-08-11 | 2014-12-03 | 天津大学 | Method for observing speed of permanent magnet motor |
CN104660142A (en) * | 2015-03-23 | 2015-05-27 | 北京润科通用技术有限公司 | Motor control system and method |
-
2015
- 2015-10-30 CN CN201510725173.4A patent/CN105356823A/en active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102075127A (en) * | 2011-01-04 | 2011-05-25 | 北京航空航天大学 | Permanent magnet synchronous motor servo driving device and position control method thereof |
KR101348338B1 (en) * | 2012-10-30 | 2014-01-16 | 한국전기연구원 | Apparatus for controlling antislip using load torque observer |
CN103647490A (en) * | 2013-09-27 | 2014-03-19 | 天津大学 | Permanent magnet motor sliding mode control strategy |
CN104104296A (en) * | 2014-06-04 | 2014-10-15 | 哈尔滨工业大学 | Method and device for mechanical resonant restraint |
CN103997272A (en) * | 2014-06-09 | 2014-08-20 | 浙江理工大学 | Load disturbance compensation device and method of permanent magnet synchronous motor |
CN104184382A (en) * | 2014-08-11 | 2014-12-03 | 天津大学 | Method for observing speed of permanent magnet motor |
CN104660142A (en) * | 2015-03-23 | 2015-05-27 | 北京润科通用技术有限公司 | Motor control system and method |
Non-Patent Citations (1)
Title |
---|
许强等: "《带负载转矩补偿的PMSM交流伺服***自适应控制》", 《电工技术学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108155845A (en) * | 2018-01-09 | 2018-06-12 | 江西理工大学 | Automobile, motor load torque Forecasting Methodology and device |
CN108155845B (en) * | 2018-01-09 | 2021-05-07 | 江西理工大学 | Method and device for predicting load torque of automobile and motor |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104932252A (en) | Improved active disturbance rejection and PID cascade control method | |
CN107202584B (en) | Planet accurate landing anti-interference guidance method | |
CN102035456B (en) | Direct torque control system of permanent magnet synchronous motor based on terminal sliding mode | |
CN104260107B (en) | The method of a kind of implementation space mechanical arm flexible joint compensation of gear clearance | |
CN101902187B (en) | Control system for low-speed running of permanent magnet motor | |
CN103941583B (en) | The parameterization design method of disturbance rejection composite non-linear servo controller | |
CN104111664B (en) | In the method that speed ring overcomes motor dead band raising radar tracking precision | |
CN201910764U (en) | Permanent magnet synchronous motor (PMSM) direct torque control system based on terminal sliding mode | |
CN104570730A (en) | Improved active disturbance rejection control method | |
CN107612445B (en) | Control method of follow-up speed regulation system with load acceleration feedback | |
CN107505845B (en) | Control method for improving disturbance suppression capability of tilting mirror control system | |
CN105043348A (en) | Accelerometer gyroscope horizontal angle measurement method based on Kalman filtering | |
CN103592946B (en) | A kind of powered phase program self-adaptation longitudinal guidance method measured based on apparent acceleration | |
CN101603800B (en) | Method for constructing seeker guidance information of half-strapdown seeking | |
CN103051274A (en) | Variable damping-based passive control method for two-degree-of-freedom permanent magnetic synchronous motor | |
CN104266663A (en) | Secondary stable disturbance decoupling method for photoelectric tracking system of motion platform | |
CN104199301A (en) | Device and method for tracking trajectory of linear motor based on improved auto-disturbance rejection controller | |
CN105227035A (en) | A kind of permanent-magnetism linear motor control method | |
CN105356823A (en) | Load torque observation and compensation method for servo system | |
CN108023531A (en) | A kind of compensation method of measurable velocity disturbance for closed loop location servo | |
CN109445448B (en) | Self-adaptive integral sliding-mode attitude controller for wheel-controlled minisatellite | |
CN103529697A (en) | Method for determining a PID (proportion, integration and differentiation) parameter robust stable region of axial magnetic bearing | |
CN109270840B (en) | Time-varying correction network discretization method for missile control system | |
CN105391352A (en) | Fractional order step optimal ITAE speed control method for permanent magnet synchronous motor | |
CN105262382A (en) | Fractional order PI speed controlling method of permanent magnet synchronous motor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20160224 |