[go: up one dir, main page]

CN119045392B - Double-inertia system position control method based on fusion of model and data driving - Google Patents

Double-inertia system position control method based on fusion of model and data driving Download PDF

Info

Publication number
CN119045392B
CN119045392B CN202411535719.5A CN202411535719A CN119045392B CN 119045392 B CN119045392 B CN 119045392B CN 202411535719 A CN202411535719 A CN 202411535719A CN 119045392 B CN119045392 B CN 119045392B
Authority
CN
China
Prior art keywords
controller
subsystem
fast
slow
dual
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
CN202411535719.5A
Other languages
Chinese (zh)
Other versions
CN119045392A (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.)
Zhejiang University ZJU
Zhejiang University Advanced Electrical Equipment Innovation Center
Original Assignee
Zhejiang University ZJU
Zhejiang University Advanced Electrical Equipment Innovation Center
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 Zhejiang University ZJU, Zhejiang University Advanced Electrical Equipment Innovation Center filed Critical Zhejiang University ZJU
Priority to CN202411535719.5A priority Critical patent/CN119045392B/en
Publication of CN119045392A publication Critical patent/CN119045392A/en
Application granted granted Critical
Publication of CN119045392B publication Critical patent/CN119045392B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
    • G05B19/0423Input/output
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/20Pc systems
    • G05B2219/25Pc structure of the system
    • G05B2219/25257Microcontroller

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种融合模型与数据驱动的双惯量系统位置控制方法,该方法通过奇异摄动法对系统进行降阶为慢变子系统与快变子系统,得到一个慢时间尺度的准稳态模型和一个快时间尺度的边界层模型;在慢变子系统控制器设计中,本发明提出一种基于DESO的两自由度ADRC位置控制方法,实现系统跟踪性能和抗扰性能的解耦。针对快变子系统,本发明提出一种神经网络PD控制策略,仅依靠系统的输入输出信息在线更新神经网络权重,实现刚度不确定时对系统振动的快速抑制。因此,本发明的优点在于控制器参考跟踪性能和抗扰性能解耦,控制器设计不依赖模型参数,结构简单,待整定参数少。

The present invention discloses a dual-inertia system position control method that integrates a model and data drive. The method reduces the order of the system into a slow-changing subsystem and a fast-changing subsystem through a singular perturbation method, and obtains a quasi-steady-state model of a slow time scale and a boundary layer model of a fast time scale. In the design of the slow-changing subsystem controller, the present invention proposes a two-degree-of-freedom ADRC position control method based on DESO to achieve the decoupling of the system tracking performance and anti-disturbance performance. For the fast-changing subsystem, the present invention proposes a neural network PD control strategy that only relies on the input and output information of the system to update the neural network weights online, so as to achieve rapid suppression of system vibration when the stiffness is uncertain. Therefore, the advantages of the present invention are that the reference tracking performance and anti-disturbance performance of the controller are decoupled, the controller design does not rely on model parameters, the structure is simple, and there are few parameters to be adjusted.

Description

Double-inertia system position control method based on fusion of model and data driving
Technical Field
The invention belongs to the technical field of motor control, and particularly relates to a double-inertia system position control method based on a fusion model and data driving.
Background
In the field of robotics, machine tools, etc., a dual inertia system (Two MASS SYSTEM, TMS) is a common model describing the connection of a motor shaft and a flexible drive mechanism with a load, such as a gearbox, a reducer, a belt, etc. The TMS becomes a four-order underactuated system by the flexible transmission mechanism, and resonance points appear in the system, so that the positioning accuracy of a load side is seriously affected. In addition, unknown disturbance caused by modeling errors, external interference and load change can have a large influence on the positioning accuracy of the under-actuated TMS load side. How to design a reasonable controller, and effectively inhibit system vibration while timely compensating unknown disturbance is a key for researching TMS position control problem.
In recent years, the singular perturbation method has been widely applied to the controller design of TMS, and the core idea is to separate the time scale of system dynamics, so as to obtain a quasi-steady-state model for tracking control and a boundary layer model for vibration suppression. The active disturbance rejection control (Active Disturbance Rejection Control, ADRC) has the characteristics of stronger disturbance rejection capability and no dependence on an accurate model, so that the active disturbance rejection control becomes a practical control method for replacing classical PID control, and can be used in the design of a controller aiming at an accurate steady-state model. As the core part of ADRC, the extended state observer (Extended State Observer, ESO) uniformly and equivalently observes and compensates the internal disturbance and the external disturbance of the system as lumped disturbance, so that the disturbance suppression performance of the system is improved, while the traditional position loop ADRC controller belongs to a degree-of-freedom controller, and the tracking performance and the disturbance rejection performance of the system are coupled.
The active damping method is a simple and effective method in the design of a boundary layer model controller, the method improves the damping ratio of a boundary layer model based on feedback compensation of system transmission torque differentiation so as to inhibit vibration of the system, the method depends on accurate acquisition of transmission torque, and in a scene of using a double encoder without a torque sensor, the method depends on accurate acquisition of rigidity of a flexible mechanism, however in an actual application scene, the rigidity calibration of the system is often difficult, and the rigidity of the flexible mechanism is inevitably changed due to ageing of the system. Therefore, the difficulty in obtaining accurate stiffness parameters limits the application of active damping methods.
Disclosure of Invention
In view of the above, the invention provides a dual-inertia system position control method integrating a model and data driving, which can compensate unknown disturbance under the condition that the tracking performance and the disturbance rejection performance of a system are completely decoupled, realize high-precision position control, and effectively inhibit system vibration without knowing the rigidity parameters of the system.
A method for controlling the position of a double-inertia system by fusing a model and data driving comprises the following steps:
(1) Reducing the order of the double-inertia system into a slow-change subsystem and a fast-change subsystem by a singular perturbation method;
(2) Reconstructing the slow-change subsystem and the fast-change subsystem;
(3) On the basis of the reconstructed slow-change subsystem, the controller is designed into a two-degree-of-freedom ADRC controller based on DESO (Decoupling Extended State Observer, decoupled state observer);
(4) On the basis of the reconstructed fast-changing subsystem, designing a controller of the fast-changing subsystem as a PD (proportional differential) controller based on data driving and a neural network;
(5) The output torque u s of the slow-change subsystem controller and the output torque u f of the fast-change subsystem controller are added to obtain a reference torque u, and the load side position is subjected to closed-loop control through the double-inertia system according to the reference torque u.
Further, the model expression of the slow-varying subsystem is as follows:
;
;
Wherein J m and J L are rotational inertia of the motor side and the load side of the dual-inertia system, B m and B L are damping coefficients of the motor side and the load side of the dual-inertia system, T L is load torque, As a quasi-steady state value of the transmission torque,AndSecond-order differential and first-order differential of θ L and θ L are the positions of the load side of the dual-inertia system, and δ is an intermediate variable.
Further, the model expression of the fast-changing subsystem is as follows:
Wherein k 0=Ksε2,Ks is the spring rate, epsilon is singular perturbation parameter (0 < epsilon < 1), eta is the transmission torque error, namely T r is the drive torque, i.e., T r=KsmL),θm is the position on the motor side of the dual inertia system,AndSecond-order and first-order differentiation of η at a fast-varying time scale t ε, respectively, and dt ε/dt=1/epsilon, t representing time.
Further, the specific implementation mode of the step (2) is that the flexible compensation gain is unified into the controller parameter designs of the slow-changing subsystem and the fast-changing subsystem respectively, meanwhile, the flexible compensation item is used as a part of the fast-changing subsystem and is combined with the damping compensation item to form a PD controller taking transmission torque as input, and the controller outputs of the slow-changing subsystem and the fast-changing subsystem after reconstruction are expressed as follows:
Wherein θ d is a given reference position instruction, k sp and k sd are respectively the proportional coefficient and the differential coefficient of the reconstructed slow-change subsystem controller, k fp and k fd are respectively the proportional coefficient and the differential coefficient of the reconstructed fast-change subsystem controller, The first differential of θ d、θm、θL, respectively.
Further, the two-degree-of-freedom ADRC controller in the step (3) comprises a tracking differentiator, a PD controller and a DESO, wherein the tracking differentiator is used for converting a step-jump reference position command into a smoothly-varying reference position signal and providing the reference position signal and a differentiated reference speed signal thereof to the PD controller, the PD controller uses a load side position and a speed estimated by the DESO as feedback signals to adjust the motor output torque to enable the load side position to follow the reference position command, the DESO is used for estimating the load side position, the speed and the lumped disturbance, the suppression of internal and external disturbance is realized by compensating the lumped disturbance, and a discrete equation of the DESO is as follows:
Wherein: And Load side position estimates for the k+1 control period and the k control period respectively,AndLoad side speed estimates for the k+1 control period and the k control period respectively,AndThe lumped disturbance estimates for the k +1 control period and the k control period respectively,H 1、h2、h3 is a DESO adjustment parameter, z represents a z transformation operator, T s is a control period duration, θ L (k) is a load side position actual value of a kth control period, u s (k) is an output torque of a kth control period slow-change subsystem controller, and J n=Jm+JL and k are natural numbers.
Further, the output of the two-degree-of-freedom ADRC controller is expressed as follows:
Wherein u s (k) is the output torque of the slow-varying subsystem controller in the kth control period, and θ ref (k) and ω ref (k) are the reference position signal and the reference speed signal, respectively, in the kth control period.
Further, the PD controller in the step (4) updates the neural network weight online according to the input/output information of the dual inertia system, so as to realize rapid suppression of system vibration, and the output of the PD controller is expressed as follows:
Wherein u f (k) is the output torque of the kth control period quick-change subsystem controller, X and a are respectively an input layer and a hidden layer of the neural network, a=VX= [ a 1(k),a2(k)]T, V is the weight of the hidden layer W i (k) is the actual load side position values of the output layer weights ,X=[e(k),e(k-1)]T,e(k-1)=θL(k-1)-θm(k-1),e(k)=θL(k)-θm(k),θL(k-1) and θ L (k) corresponding to a i (k) and are the actual motor side position values of the k-1 control period and the k control period, respectively, θ m (k-1) and θ m (k) are the k-1 control period and the k control period, respectively, T represents transposition.
Further, the neural network has a loss function as follows:
where L represents the loss function.
A computer device comprising a memory and a processor, wherein the memory stores a computer program, and the processor is configured to execute the computer program to implement the method for controlling the position of the dual inertia system by fusing a model and data.
A computer readable storage medium storing a computer program which when executed by a processor implements the above-described fusion model and data-driven dual inertia system position control method.
Based on the technical scheme, the invention has the following beneficial technical effects:
1. According to the method for controlling the self-disturbance-rejection position of the slow-variation subsystem in decoupling two degrees of freedom, the reference tracking performance and the disturbance rejection performance of the system can be independently optimized by adjusting the parameters of the controller and the parameters of the disturbance observer.
2. The PD control strategy of the fast-changing subsystem neural network is model-free control based on data driving, and can update the parameters of a controller on line to effectively inhibit system vibration under variable rigidity.
3. The invention fully utilizes the known model parameters and the acquired data information, is a control method for fusing the model and the data drive, and has simpler structure and fewer parameters to be set compared with the conventional intelligent algorithm.
Drawings
FIG. 1 is a schematic diagram of a position-current dual closed loop control of a dual inertia system in an embodiment of the present invention.
FIG. 2 is a block diagram of a dual inertia system and a slow and fast subsystem controller for controlling the position of the dual inertia system in accordance with an embodiment of the present invention.
FIG. 3 is a schematic diagram of experimental waveforms of a conventional ADRC and a decoupling two-degree-of-freedom ADRC according to the present invention under a position command step in a verification example of the present invention, wherein (a) corresponds to the conventional ADRC and (b) corresponds to the decoupling two-degree-of-freedom ADRC according to the present invention.
Fig. 4 is a schematic diagram of experimental waveforms of a conventional ADRC and a decoupling two-degree-of-freedom ADRC according to the present invention under a sudden load torque change in an experimental example of the present invention, where (a) corresponds to the conventional ADRC and (b) corresponds to the decoupling two-degree-of-freedom ADRC according to the present invention.
Fig. 5 is a schematic diagram of experimental waveforms of the neural network PD controller of the present invention under a position command step in a verification example of the present invention.
Detailed Description
In order to more particularly describe the present invention, the following detailed description of the technical scheme of the present invention is provided with reference to the accompanying drawings and the specific embodiments.
In the embodiment, a tested motor with inertia of 1.2 multiplied by 10 -4kg·m2 is connected with a load motor with inertia of 0.8 multiplied by 10 - 4kg·m2, and a double-inertia system is simulated by means of an elastic coupling with rigidity of 5Nm/rad, so that closed-loop control is performed on the load side position.
As shown in fig. 1, the dual-inertia system adopts a dual-loop control framework based on a magnetic field directional control strategy, and generally comprises a position loop and a current loop dual-loop control structure, wherein the position loop generates a desired reference torque U according to a reference position signal theta d, a motor side position feedback theta m and a load side position feedback theta L, the reference torque U is converted into a reference input i ref of the current loop through a torque coefficient K T, the current loop controls and outputs a reference voltage through sampling a motor stator current i, and then the output voltage of an inverter is regulated through a SVPWM (Space Vector Pulse Width Modulation ) modulation technology to drive a motor, and U DC is the direct current voltage of the inverter. When the current loop bandwidth is sufficiently high, the output torque T m can track the reference torque u completely in a very short time, so the dynamics of the current loop are ignored when designing the position loop, and u=t m is considered.
In order to realize closed-loop control of the load side position of the dual-inertia system, the embodiment provides a dual-inertia system position control method based on fusion of a model and data driving, which comprises the following specific processes:
(1) The dual inertia system is reduced to a slow-change subsystem and a fast-change subsystem through a singular perturbation method.
1.1 The dynamic model of the double-inertia system is established as follows:
Wherein, theta m and theta L are the positions of the motor side and the load side respectively, J m and B m are the rotational inertia and the damping coefficient of the motor side respectively, J L and B L are the rotational inertia and the damping coefficient of the load side respectively, T m is the motor output torque, T L is the load torque, K s is the spring rate coefficient, AndSecond and first order differentials of theta L respectively,AndThe second and first differential of θ m, respectively.
1.2 Defining the transmission torque T r=KsmL) so as to convert the dynamic model of the double-inertia system into a singular perturbation form as follows:
where u is the reference torque that is desired to be generated, AndSecond-order and first-order differentials of T r, respectively, ε is a singular perturbation parameter (0 < ε < 1), k 0=Ksε2.
Let ε=0 to make the dual inertia system in slow time scale to obtain quasi-steady state value of transmission torqueThe slow-varying subsystem quasi-steady state model is as follows:
;
Wherein J n=Jm+JL,Bn=Bm+BL,us is the output of the slow-varying subsystem controller.
1.3 The transformation of the singular perturbation form of the dual inertia system dynamics model into a form free of θ L is expressed as follows:
Wherein: A new scale variable t ε is defined and let dt ε/dt=1/epsilon. At the time scale of this fast-varying time scale, Is regarded as a constant, defines a variableAnd hasThe singular perturbation form of the dual inertia system model can be expressed as:
Order the I.e., η=0, the slow-varying subsystem model at the slow-varying time scale is obtained as follows:
subtracting the slow-change subsystem model from the dual-inertia system model in the singular perturbation form to obtain a fast-change subsystem boundary layer model as follows:
wherein u f is the output of the fast-changing subsystem controller.
(2) And reconstructing the structure of the traditional singular perturbation method.
The controller of the traditional singular perturbation method slow-change subsystem is of a PD control law structure, and the fast-change subsystem is designed to obtain a D controller according to a damping compensation method. In this embodiment, the flexible compensation gains are unified into the controller parameter designs of the slow and fast-changing subsystems respectively, and meanwhile, the flexible compensation term is received as a part of the fast-changing subsystem, and the flexible compensation term and the damping compensation term are combined into a PD controller with transmission torque as input, so as to obtain the following expression of the output u s、uf of the slow and fast-changing subsystem after reconstruction:
The method comprises the steps of enabling theta d to be a reference position instruction, enabling k sp、ksd to be parameters of a reconstructed slow-change subsystem PD controller, and enabling k fp、kfd to be parameters of a reconstructed fast-change subsystem PD controller.
(3) On the basis of the reconstructed singular perturbation method structure, the two-degree-of-freedom self-interference rejection controller ADRC which is completely decoupled is designed for the slow-variation subsystem.
The decoupling two-degree-of-freedom ADRC consists of three parts including a tracking differentiator, a PD controller, and a decoupling extended state observer DESO. The PD controller takes the estimated position signal and the estimated speed signal of the DESO as feedback, adjusts the output torque of the motor to enable the position of the load side to follow the reference position instruction, and the DESO is used for estimating the position, the speed and the lumped disturbance of the system and realizing the inhibition of internal and external disturbance by compensating the lumped disturbance, wherein the discrete equation is as follows:
Wherein: The estimated values of the load side position, the load side speed and the lumped disturbance in the kth control period are respectively shown, T s is the control period, and h 1、h2、h3 is the adjustment parameter of the DESO. In this embodiment, T s=5×10-5 designs the observer bandwidth based on the bandwidth parameter tuning method ωo=600,h1=3ωo,h2=3ωo 2,h3o 3.
The expression of decoupling the two degrees of freedom ADRC output is:
wherein k sp、ksd is a parameter of the PD controller, J n=Jm+JL=2×10-4, and k sp=2,ksd =0.2 in this embodiment.
The tracking performance of the decoupling two-degree-of-freedom ADRC is only related to the PD controller, the decoupling two-degree-of-freedom ADRC is not related to the DESO, the immunity performance is only related to the DESO, the decoupling two-degree-of-freedom ADRC is not related to the PD controller, the complete decoupling of the tracking performance and the immunity performance is realized, and the tracking performance and the immunity performance of the system position instruction can be independently optimized respectively by adjusting the parameters of the PD controller and the DESO.
(4) On the basis of the reconstructed singular perturbation method structure, a neural network PD controller based on data driving is designed for the fast-changing subsystem.
The neural network PD controller based on data driving is improved on the basis of the original quick-change subsystem PD controller, the neural network weight is updated on line according to the input and output information of the system, the quick suppression of the system vibration is realized, accurate model parameters are not relied on, and the expression of the neural network PD controller is as follows:
Wherein x= [ e (k), e (k-1) ] T is an input to the neural network, e (k) =θ L(k)-θm (k) represents a position difference between the load side and the motor side of the kth control period, For the weight of the hidden layer, a=vx is the output of the hidden layer, W is the weight of the output layer, and the initial value W (0) = [ k fp,kfd ]; in this embodiment, k fp=10,kfd =0.2.
The neural network PD controller based on data driving adopts an online training mode, in each control period, a loss function of the neural network is calculated according to the error between the actual position and the reference position, the neural network is reversely propagated through a gradient descent method, and the weight of a network output layer is further increased until the loss function reaches the minimum, wherein the online training formula of the neural network PD controller is as follows:
;
;
;
Where P (k) represents the loss function of the kth iteration, For fitting the pseudo partial derivative of the output and input relation of the controlled system, Y (k) =θ m(k)-θL (k), ρ is a given learning rate coefficient, and ρ=0.01 in this embodiment.
After the design of the slow-speed-change subsystem controller and the fast-speed-change subsystem controller is completed, the dual-inertia system position control structure integrating the model and the data drive is shown in fig. 2, the tracking differentiator generates a transition process for a position instruction, the PD controller takes the output of the tracking differentiator as a reference, the position and the speed signals estimated by the observer are used as feedback to determine the tracking performance of the controller, the lumped disturbance estimated by the observer is used as disturbance compensation to determine the disturbance rejection performance of the controller.
FIG. 3 shows experimental waveforms for a conventional ADRC decoupled from the present invention in two degrees of freedom ADRC given a position command comprising a 150ms transition time amplitude pi rad. In a practical scenario, unknown disturbances such as friction force, system parameter perturbation and the like are necessarily existed in the dual-inertia system in the motion process, and as can be seen from fig. 3 (a), although the ESO of the conventional ADRC can inhibit the disturbance occurring when the system tracks the reference position, the disturbance information is transmitted to the estimationAnd (3) withAnd thus affects the tracking performance of the PD controller. It can be seen from FIG. 3 (b) that the DESO, while effectively suppressing system disturbances, is estimatedAnd (3) withDoes not contain unknown disturbance information, and the quality of the disturbance suppression effect can not be influencedAnd (3) withTherefore, the disturbance suppression performance has no influence on the tracking performance under the decoupling two-degree-of-freedom ADRC structure.
Fig. 4 shows experimental waveforms of a conventional ADRC decoupled from the present invention in two degrees of freedom ADRC at a sudden load torque of 0.3 Nm. It can be seen from FIG. 4 (a) that due to ESO estimationAnd (3) withThe PD controller participates in the disturbance suppression process in order to eliminate disturbance, so that the PD controller and the ESO have certain coupling on the disturbance suppression performance of the traditional ADRC. As can be seen from fig. 4 (b), the PD controller is estimated in DESOAnd (3) withWhen the method is used as feedback, any disturbance information is not received, the output after disturbance appears is kept unchanged, and the disturbance suppression process is not participated at all, so that the tracking performance under the decoupling two degrees of freedom ADRC can be explained not to influence the disturbance suppression performance. The coupling of the conventional ADRC reference tracking performance and the disturbance rejection performance is proved through step giving and load mutation experiments, and the decoupling two-degree-of-freedom ADRC performance is decoupled.
Fig. 5 shows the PD controller position tracking effect and the neural network PD parameter convergence process of the present invention under a step position command of three consecutive magnitudes pi rad. When the initial value of k fd is 0, that is, the PD controller does not perform damping compensation at all, it can be seen that the first position command tracking under the initial value cannot well inhibit system vibration, then the neural network PD quickly adjusts k fd to about 0.18 according to the vibration information of the system, vibration of a load side position is quickly inhibited, vibration generated by the position change of the last two times is effectively inhibited, and k fd tends to converge.
The embodiments described above are described in order to facilitate the understanding and application of the present invention to those skilled in the art, and it will be apparent to those skilled in the art that various modifications may be made to the embodiments described above and that the general principles described herein may be applied to other embodiments without the need for inventive faculty. Therefore, the present invention is not limited to the above-described embodiments, and those skilled in the art, based on the present disclosure, should make improvements and modifications within the scope of the present invention.

Claims (5)

1.一种融合模型与数据驱动的双惯量系统位置控制方法,包括如下步骤:1. A dual-inertia system position control method based on a fusion model and data drive, comprising the following steps: (1)通过奇异摄动法将双惯量系统降阶为慢变子系统和快变子系统;(1) The dual-inertia system is reduced to a slow-varying subsystem and a fast-varying subsystem by the singular perturbation method; 所述慢变子系统的模型表达式如下:The model expression of the slow-varying subsystem is as follows: 其中:Jm和JL分别为双惯量系统电机侧和负载侧的转动惯量,Bm和BL分别为双惯量系统电机侧和负载侧的阻尼系数,TL为负载转矩,为传动扭矩的准稳态值,分别为θL的二阶微分和一阶微分,θL为双惯量系统负载侧的位置,δ为中间变量;Where: Jm and JL are the rotation inertia of the dual inertia system on the motor side and the load side, Bm and BL are the damping coefficients of the dual inertia system on the motor side and the load side, TL is the load torque, is the quasi-steady-state value of the transmission torque, and are the second-order differential and first-order differential of θ L , θ L is the position of the load side of the dual-inertia system, and δ is the intermediate variable; 所述快变子系统的模型表达式如下:The model expression of the fast-changing subsystem is as follows: 其中:k0=Ksε2,Ks为弹簧刚度系数,ε为奇异摄动参数,η为传动扭矩误差即 Tr为传动扭矩即Tr=KsmL),θm为双惯量系统电机侧的位置,η″和η′分别为η在快变时间尺度tε下的二阶微分和一阶微分,且dtε/dt=1/ε,t表示时间;Where: k 0 = K s ε 2 , K s is the spring stiffness coefficient, ε is the singular perturbation parameter, η is the transmission torque error, that is T r is the transmission torque, that is, T r =K smL ), θ m is the position of the motor side of the dual inertia system, η″ and η′ are the second-order differential and first-order differential of η at the fast-changing time scale t ε, respectively, and dt ε /dt=1/ε, t represents time; (2)对所述慢变子系统和快变子系统进行重构,具体实现方式为:将柔性补偿增益分别统一到慢变子系统和快变子系统的控制器参数设计中,同时把柔性补偿项作为快变子系统的一部分并与阻尼补偿项组合成以传动扭矩为输入的PD控制器,重构后慢变子系统和快变子系统的控制器输出表达如下:(2) The slow-changing subsystem and the fast-changing subsystem are reconstructed. The specific implementation method is: the flexible compensation gain is unified into the controller parameter design of the slow-changing subsystem and the fast-changing subsystem respectively, and the flexible compensation term is taken as a part of the fast-changing subsystem and combined with the damping compensation term to form a PD controller with the transmission torque as input. The controller outputs of the reconstructed slow-changing subsystem and the fast-changing subsystem are expressed as follows: 其中:θd为给定的参考位置指令,ksp和ksd分别为重构后慢变子系统控制器的比例系数和微分系数,kfp和kfd分别为重构后快变子系统控制器的比例系数和微分系数,分别为θd、θm的一阶微分;Where: θd is the given reference position command, ksp and ksd are the proportional coefficient and differential coefficient of the reconstructed slow-changing subsystem controller, kfp and kfd are the proportional coefficient and differential coefficient of the reconstructed fast-changing subsystem controller, are the first-order differentials of θ d and θ m respectively; (3)在重构后的慢变子系统基础上,将其控制器设计为基于DESO的两自由度ADRC控制器;(3) Based on the reconstructed slow-varying subsystem, its controller is designed as a two-degree-of-freedom ADRC controller based on DESO; 所述两自由度ADRC控制器包括跟踪微分器、PD控制器以及DESO,其中跟踪微分器用于将阶跃突变的参考位置指令转换为平滑变化的参考位置信号,并将该参考位置信号及其微分后的参考速度信号提供给PD控制器;PD控制器以DESO估计的负载侧位置和速度作为反馈信号,调节电机输出转矩使负载侧位置跟随参考位置指令;DESO用于估计负载侧位置、速度以及集总扰动,通过补偿集总扰动实现对内外部扰动的抑制,DESO的离散方程如下:The two-degree-of-freedom ADRC controller includes a tracking differentiator, a PD controller and a DESO, wherein the tracking differentiator is used to convert a step-change reference position instruction into a smoothly changing reference position signal, and provide the reference position signal and its differentiated reference speed signal to the PD controller; the PD controller uses the load side position and speed estimated by the DESO as feedback signals to adjust the motor output torque so that the load side position follows the reference position instruction; the DESO is used to estimate the load side position, speed and lumped disturbance, and suppress internal and external disturbances by compensating for the lumped disturbance. The discrete equation of the DESO is as follows: 其中:分别为第k+1控制周期和第k控制周期的负载侧位置估计值,分别为第k+1控制周期和第k控制周期的负载侧速度估计值,分别为第k+1控制周期和第k控制周期的集总扰动估计值,h1、h2、h3为DESO的调节参数,z表示z变换算子,Ts为控制周期时长,θL(k)为第k控制周期的负载侧位置实际值,us(k)为第k控制周期慢变子系统控制器的输出转矩,Jn=Jm+JL,k为自然数;in: and are the load side position estimation values of the k+1th control cycle and the kth control cycle, respectively, and are the load side speed estimation values of the k+1th control cycle and the kth control cycle, respectively, and are the lumped disturbance estimates of the k+1th control cycle and the kth control cycle, respectively, h 1 , h 2 , h 3 are the adjustment parameters of DESO, z represents the z-transformation operator, T s is the control cycle duration, θ L (k) is the actual load side position value of the kth control cycle, u s (k) is the output torque of the slow-varying subsystem controller of the kth control cycle, J n =J m +J L , k is a natural number; 所述两自由度ADRC控制器的输出表达如下:The output of the two-degree-of-freedom ADRC controller is expressed as follows: 其中:us(k)为第k控制周期慢变子系统控制器的输出转矩,θref(k)和ωref(k)分别为第k控制周期的参考位置信号和参考速度信号;Wherein: u s (k) is the output torque of the slow-varying subsystem controller in the kth control period, θ ref (k) and ω ref (k) are the reference position signal and reference speed signal in the kth control period respectively; (4)在重构后的快变子系统基础上,将其控制器设计为基于数据驱动和神经网络的PD控制器;(4) Based on the reconstructed fast-changing subsystem, its controller is designed as a PD controller based on data drive and neural network; (5)将慢变子系统控制器的输出转矩us与快变子系统控制器的输出转矩uf相加得到参考转矩u,根据该参考转矩u通过双惯量系统对负载侧位置进行闭环控制。(5) The output torque u s of the slow-changing subsystem controller is added to the output torque u f of the fast-changing subsystem controller to obtain a reference torque u. According to the reference torque u, the load side position is closed-loop controlled through the dual-inertia system. 2.根据权利要求1所述的一种融合模型与数据驱动的双惯量系统位置控制方法,其特征在于:所述步骤(4)中的PD控制器根据双惯量系统的输入输出信息在线更新神经网络权重,实现对系统振动的快速抑制,该PD控制器的输出表达如下:2. According to the dual-inertia system position control method of the fusion model and data-driven according to claim 1, it is characterized in that: the PD controller in the step (4) updates the neural network weight online according to the input and output information of the dual-inertia system to achieve rapid suppression of system vibration, and the output of the PD controller is expressed as follows: 其中:uf(k)为第k控制周期快变子系统控制器的输出转矩,X和a分别为神经网络的输入层和隐藏层,a=VX=[a1(k),a2(k)]T,V为隐藏层权重且Wi(k)为ai(k)对应的输出层权重,X=[e(k),e(k-1)]T,e(k-1)=θL(k-1)-θm(k-1),e(k)=θL(k)-θm(k),θL(k-1)和θL(k)分别为第k-1控制周期和第k控制周期的负载侧位置实际值,θm(k-1)和θm(k)分别为第k-1控制周期和第k控制周期的电机侧位置实际值,T表示转置。Where: uf (k) is the output torque of the fast-changing subsystem controller in the kth control cycle, X and a are the input layer and hidden layer of the neural network respectively, a=VX=[ a1 (k), a2 (k)] T , V is the hidden layer weight and Wi (k) is the output layer weight corresponding to ai (k), X=[e(k),e(k-1)] T , e(k-1)= θL (k-1) -θm (k-1), e(k)= θL (k) -θm (k), θL (k-1) and θL (k) are the actual load side position values of the k-1th control cycle and the kth control cycle, respectively, θm (k-1) and θm (k) are the actual motor side position values of the k-1th control cycle and the kth control cycle, respectively, and T represents transposition. 3.根据权利要求2所述的一种融合模型与数据驱动的双惯量系统位置控制方法,其特征在于:所述神经网络的损失函数如下:3. According to the dual-inertia system position control method of the fusion model and data-driven according to claim 2, it is characterized in that: the loss function of the neural network is as follows: 其中:L表示损失函数。Where: L represents the loss function. 4.一种计算机设备,包括存储器和处理器,其特征在于:所述存储器中存有计算机程序,所述处理器用于执行该计算机程序以实现如权利要求1~3任一权利要求所述的一种融合模型与数据驱动的双惯量系统位置控制方法。4. A computer device, comprising a memory and a processor, characterized in that: a computer program is stored in the memory, and the processor is used to execute the computer program to implement a dual-inertia system position control method that integrates a model and data as described in any one of claims 1 to 3. 5.一种计算机可读存储介质,存储有计算机程序,其特征在于:所述计算机程序被处理器执行时以实现如权利要求1~3任一权利要求所述的一种融合模型与数据驱动的双惯量系统位置控制方法。5. A computer-readable storage medium storing a computer program, characterized in that: when the computer program is executed by a processor, it implements a dual-inertia system position control method of a fusion model and data-driven as described in any one of claims 1 to 3.
CN202411535719.5A 2024-10-31 2024-10-31 Double-inertia system position control method based on fusion of model and data driving Active CN119045392B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202411535719.5A CN119045392B (en) 2024-10-31 2024-10-31 Double-inertia system position control method based on fusion of model and data driving

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202411535719.5A CN119045392B (en) 2024-10-31 2024-10-31 Double-inertia system position control method based on fusion of model and data driving

Publications (2)

Publication Number Publication Date
CN119045392A CN119045392A (en) 2024-11-29
CN119045392B true CN119045392B (en) 2025-02-11

Family

ID=93576428

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202411535719.5A Active CN119045392B (en) 2024-10-31 2024-10-31 Double-inertia system position control method based on fusion of model and data driving

Country Status (1)

Country Link
CN (1) CN119045392B (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108181806A (en) * 2017-12-01 2018-06-19 西北工业大学 Robot for space position and posture Auto-disturbance-rejection Control based on sampling output
CN116979847A (en) * 2023-07-21 2023-10-31 中国科学院西安光学精密机械研究所 DESO-based DADRC and SM-DADRC, dual inertia systems

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2447792A1 (en) * 2005-09-19 2012-05-02 Cleveland State University Controllers, observer, and applications thereof
CN102030007B (en) * 2010-11-26 2013-07-24 清华大学 Method for acquiring overall dynamics controlled quantity of independently driven-independent steering vehicle
CN108646572B (en) * 2018-07-16 2020-12-25 广西师范大学 Control method of three-axis pan-tilt servo motor based on combination of BP neural network and active disturbance rejection controller
CN109639194A (en) * 2019-01-21 2019-04-16 广西师范大学 A composite control method of neural network and active disturbance rejection of a three-axis pan-tilt servo motor
CN115664286B (en) * 2022-11-10 2024-07-19 常州市武进亚太机电配件有限公司 Hub motor control system based on discrete active disturbance rejection current controller

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108181806A (en) * 2017-12-01 2018-06-19 西北工业大学 Robot for space position and posture Auto-disturbance-rejection Control based on sampling output
CN116979847A (en) * 2023-07-21 2023-10-31 中国科学院西安光学精密机械研究所 DESO-based DADRC and SM-DADRC, dual inertia systems

Also Published As

Publication number Publication date
CN119045392A (en) 2024-11-29

Similar Documents

Publication Publication Date Title
CN107561935B (en) Motor position servo system friction compensation control method based on multilayer neural network
CN112643670B (en) Flexible joint control method based on sliding-mode observer
CN110968037B (en) Control method for reducing contour error of multi-axis motion system
CN108983610A (en) A kind of robust adaptive disturbance rejection control method
CN115562021A (en) A Control Method Based on Parameter Uncertainty and Disturbance Suppression of Double Frame Magnetic Suspension Control Moment Gyro Frame System
CN112769364A (en) Fast self-adaptive anti-interference control method of direct current motor servo system
CN115877712A (en) Time-delay-based mechanical arm multivariable spiral control method considering input saturation
CN120159703B (en) Variable speed variable pitch wind generating set torque control method, system and computer readable medium
CN118100724A (en) Permanent magnet synchronous motor active disturbance rejection control method and system
CN119045392B (en) Double-inertia system position control method based on fusion of model and data driving
CN110932609B (en) Self-adaptive recursion control method and system for multi-motor servo system
CN111399377A (en) Control Method of Electric Load Simulator Based on Negative Feedback Correction
CN109184925B (en) Electronic throttle control method based on adaptive integral terminal sliding mode technology
CN111077782B (en) A Design Method of U-Model Disturbance-Resistant Controller for Continuous Systems Based on Standard
CN118625659A (en) A hierarchical lateral control method and system for an autonomous driving vehicle considering the underlying time delay characteristics of the vehicle
CN110095985B (en) Observer design method and anti-interference control system
Zhao et al. Design of MRAC and Modified MRAC for the Turntable
CN115793462A (en) Robust control method for lateral balance of unmanned bicycle
CN118920908B (en) Piezoelectric driving robust control method based on sliding mode observer and radial basis function neural network
CN118123812B (en) A multi-modal active vibration suppression method based on a robotic arm joint servo system
KR20030075446A (en) Precision speed and position control method of actuator system
CN119727481B (en) A sliding mode control method for permanent magnet synchronous motor based on predetermined time
CN111830824A (en) Direct current motor servo system asymptotic tracking control method considering current loop dynamics
Sariyildiz IEEEICM25:" A High-Performance Disturbance Observer"
CN118584821B (en) A pantograph active control method considering controlling different components

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant