Friction torque compensation method based on shafting rotation inclination angle error
By designing the angular velocity closed-loop control model and optimizing the friction torque model, the problem of the axis system tilt error in traditional technology is solved, the friction torque compensation accuracy is improved, visual jitter and control accuracy are reduced.
Patent Information
- Application Number
- CN202411175143.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-29
AI Technical Summary
The traditional friction torque compensation model does not consider the axis system slewing inclination error, which leads to the control easily jitter and crawling when the target distance is close, affecting the stable tracking accuracy of the visual axis.
Design an angular velocity closed-loop control model, obtain the slewing inclination error model, correct the friction torque model, and optimize the relevant parameters through the particle swarm algorithm to obtain the friction torque optimization model, and compensate to the angular velocity closed-loop control model.
The friction torque compensation accuracy is improved, the friction torque changes caused by the slewing angle error are avoided, and the problems of visual jitter and reduction of control accuracy are reduced.
Smart Images

Figure CN119045331A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of friction compensation, and in particular to a method for compensating friction torque based on an error in the rotational inclination of a shaft system. Background Art
[0002] The line of sight stabilization tracking system is a system used to keep the line of sight (usually refers to the pointing direction of the observation device or sensor) relatively stable and accurately track the target. It achieves stable tracking of the target through a speed-position closed loop. When the target is close, its angular velocity relative to the tracking system is small and is affected by the friction of the shaft system. At this time, the control is prone to jitter, crawling and other phenomena, causing visual jitter and affecting the tracking accuracy. The traditional friction torque compensation model does not consider the influence of the shaft system rotation inclination error on the friction torque. Therefore, the friction torque compensation model needs to be corrected to improve the compensation accuracy of the friction torque. Summary of the invention
[0003] In view of the above defects or deficiencies in the prior art, the present application aims to provide a method for compensating the friction torque based on the shaft system rotation inclination error, comprising the following steps:
[0004] Constructing an angular velocity closed-loop control model, wherein the input of the angular velocity closed-loop control model is the angular velocity, and the output includes a voltage angle curve, wherein the abscissa of the voltage angle curve is the measured azimuth angle, and the ordinate is the control voltage value;
[0005] Obtaining a rotation tilt angle error model, wherein the input of the rotation tilt angle error model is the actual azimuth angle, and the output is the rotation tilt angle error;
[0006] Correcting the friction torque model according to the rotation inclination angle error model to obtain a friction torque correction model;
[0007] Optimizing the relevant parameters of the friction torque correction model to obtain a friction torque optimization model, wherein the relevant parameters include Coulomb friction coefficient, static friction coefficient, Stribeck speed and viscous friction torque proportional coefficient;
[0008] The friction torque optimization model is compensated to the angular velocity closed-loop control model.
[0009] According to the technical solution provided in the embodiment of the present application, the step of obtaining the gyroscopic inclination error model includes the following steps:
[0010] Constructing an axis system rotation model, wherein the axis system rotation model includes a theoretical axis system position and an actual axis system position after the visual axis is rotated;
[0011] According to the shaft system rotation model, an azimuth error model is obtained, wherein the input of the azimuth error model is the actual azimuth, and the output is the azimuth error;
[0012] The rotation inclination error model is calculated according to the azimuth error model.
[0013] According to the technical solution provided in the embodiment of the present application, the friction torque correction model is shown as follows:
[0014]
[0015] Where, T f represents the friction torque; T C is the Coulomb friction coefficient, T S represents the static friction coefficient, w S represents the Stribeck velocity, B is the proportional coefficient of the viscous friction torque; vi represents the angular velocity; T f (v i ) represents the theoretical friction torque at different angular velocities.
[0016] According to the technical solution provided in the embodiment of the present application, the optimization of the relevant parameters of the friction torque correction model to obtain the friction torque optimization model includes the following steps:
[0017] Obtaining a measured friction torque model, wherein the input of the measured friction torque model is a measured azimuth angle, a control voltage, and an angular velocity, and the output is the measured friction torque;
[0018] constructing an objective function according to the friction torque correction model and the actual friction torque function;
[0019] The objective function is optimized by particle swarm algorithm to obtain the optimized correlation function, and then the friction torque optimization model is obtained.
[0020] According to the technical solution provided in the embodiment of the present application, the objective function is optimized by the particle swarm algorithm to obtain the optimized correlation function, which includes the following steps:
[0021] Set the convergence threshold;
[0022] Initializing the related parameters to obtain initialization parameters;
[0023] Solving the objective function based on the initialization parameters to obtain an objective function value;
[0024] When it is determined that the objective function value is less than or equal to the convergence threshold, the objective function is determined to have converged; if the objective function value is greater than the convergence threshold, the initialization parameters are updated, the objective function value is recalculated, and the convergence of the objective function is determined until the objective function converges.
[0025] According to the technical solution provided in the embodiment of the present application, solving the objective function based on the initialization parameters to obtain the objective function value includes the following steps:
[0026] Acquire an angular velocity sampling sequence, wherein the angular velocity sampling sequence includes a plurality of angular velocities;
[0027] According to the angular velocity closed-loop control model, a plurality of voltage angle curves corresponding to each of the angular velocities in the angular velocity sequence are obtained, wherein the abscissa of the voltage angle curve is the measurement azimuth, and the ordinate is the control voltage;
[0028] Correcting each of the voltage angle curves to obtain a voltage angle correction curve, wherein all of the voltage angle correction curves have the same zero point;
[0029] Sampling on each of the voltage angle correction curves to obtain a plurality of sampling sets, each of the sampling sets including an angular velocity, a measurement azimuth angle, and a control voltage corresponding thereto;
[0030] Inputting the sample set into the friction torque correction model to obtain a theoretical friction torque value;
[0031] Inputting the sampling set into the measured friction torque model to obtain the measured friction torque value;
[0032] The objective function value is obtained according to the theoretical friction torque value and the measured friction torque value.
[0033] According to the technical solution provided in the embodiment of the present application, the step of correcting each of the voltage angle curves to obtain a voltage angle correction curve includes the following steps:
[0034] Obtaining the mean azimuth of each of the voltage angle curves;
[0035] Averaging all the mean azimuths to obtain a corrected azimuth;
[0036] The voltage angle correction curve is obtained by correcting each of the voltage angle curves according to the corrected azimuth angle.
[0037] According to the technical solution provided in the embodiment of the present application, the step of obtaining the mean azimuth of each voltage angle curve comprises the following steps:
[0038] Obtaining a voltage mean value of each of the voltage angle curves according to a maximum value and a minimum value of a control voltage of each of the voltage angle curves;
[0039] Obtaining a minimum azimuth set of each voltage angle curve according to the voltage mean value, wherein the minimum azimuth set includes a plurality of minimum azimuths, wherein the voltage angle curve is a sine wave, and the minimum azimuth is a measured azimuth corresponding to the voltage mean value in each full cycle;
[0040] The minimum azimuth angle sets are averaged to obtain the mean azimuth angle of each voltage angle curve.
[0041] In summary, the present application proposes a method for compensating the friction torque based on the shaft system rotation inclination angle error. By designing an angular velocity closed-loop control model and establishing an shaft system rotation model, a rotation inclination angle error model is obtained, and it is compensated to the friction torque model to obtain a friction torque correction model, which is optimized to obtain a friction torque optimization model, and it is compensated to the angular velocity closed-loop control model, thereby avoiding the problem of decreased compensation accuracy caused by the change of friction torque caused by the rotation inclination angle error. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] Figure 1 A flow chart of a method for compensating the friction torque of a shaft system rotation inclination error provided in an embodiment of the present application;
[0043] Figure 2 A control schematic diagram of an angular velocity closed-loop control model provided in an embodiment of the present application;
[0044] Figure 3 A schematic diagram of a shaft system rotation model provided in an embodiment of the present application;
[0045] Figure 4 A voltage angle curve waveform diagram provided in an embodiment of the present application;
[0046] Figure 5 A control schematic diagram of the compensated angular velocity closed-loop control model provided in an embodiment of the present application. DETAILED DESCRIPTION
[0047] The present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the relevant invention, rather than to limit the invention. It is also necessary to explain that, for ease of description, only the parts related to the invention are shown in the accompanying drawings.
[0048] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0049] As mentioned in the background technology, the present application proposes a method for compensating the friction torque based on the shaft system rotation inclination error, comprising the following steps:
[0050] S100. Constructing an angular velocity closed-loop control model, wherein the input of the angular velocity closed-loop control model is the angular velocity, and the output includes a voltage angle curve, wherein the abscissa of the voltage angle curve is the measured azimuth angle, and the ordinate is the control voltage value;
[0051] Among them, the angular velocity closed-loop control model is as follows: Figure 2 As shown in the figure, the speed sensor is used to receive the visual axis rotation speed of the controlled object, output the angular velocity, and feed back the input angular velocity; the angle sensor is used to output the measured azimuth of the visual axis rotation; the rotation speed of the visual axis is obtained by the speed sensor, and the obtained control voltage, rotation speed and measured azimuth are input into the data storage module, thereby obtaining the voltage angle curve, which is marked as U(v i ), horizontal axis represents the measurement azimuth, and the ordinate U represents the control voltage.
[0052] S200. Obtaining a rotation tilt angle error model, wherein the input of the rotation tilt angle error model is the actual azimuth angle, and the output is the rotation tilt angle error;
[0053] The steps include:
[0054] S210. Constructing an axis rotation model, wherein the axis rotation model includes a theoretical axis position and an actual axis position after the visual axis is rotated;
[0055] S220. Obtain an azimuth error model according to the shaft system rotation model, wherein the input of the azimuth error model is the actual azimuth, and the output is the azimuth error;
[0056] The axis rotation model is as follows: Figure 3 As shown, XYZ is the position of the visual axis before rotation, XYZ' is the position of the visual axis after rotation about the Y axis; ε represents the axis inclination error, Δδ represents the rotation inclination error, Represents the measurement azimuth; Represents the actual azimuth;
[0057] The azimuth error model obtained by the geometric algorithm is as follows:
[0058]
[0059] In the formula, represents the azimuth error.
[0060] S230. Calculate the rotation inclination error model according to the azimuth error model;
[0061] The rotation angle error model is obtained through geometric calculation, as shown in the following formula:
[0062]
[0063] Where Δδ represents the rotation angle error, and k can be obtained by formula (1).
[0064] S300. Correcting the friction torque model according to the rotation angle error model to obtain a friction torque correction model;
[0065] The friction torque model before correction uses the Stribeck (Stribeck Friction Model) model. After the rotation angle error model is corrected into the Stribeck model, the friction torque correction model is obtained, as shown in the following formula:
[0066]
[0067] Where, T f represents the friction torque; T C is the Coulomb friction coefficient, T S represents the static friction coefficient, w S represents the Stribeck velocity, B is the proportional coefficient of the viscous friction torque; vi represents the angular velocity; T f (v i ) represents the theoretical friction torque at different angular velocities;
[0068] S400. Optimizing the relevant parameters of the friction torque correction model to obtain a friction torque optimization model, wherein the relevant parameters include Coulomb friction coefficient, static friction coefficient, Stribeck speed and viscous friction torque proportional coefficient; comprising the following steps:
[0069] S410. Obtaining a measured friction torque model, wherein the input of the measured friction torque model is the measured azimuth, the control voltage and the angular velocity, and the output is the measured friction torque;
[0070] S420. Constructing an objective function according to the friction torque correction model and the actual friction torque function, wherein the objective function includes the relevant parameters;
[0071] The objective function is shown in the following formula:
[0072]
[0073] S430. Optimizing the objective function by using a particle swarm algorithm to obtain an optimized correlation function, and then obtaining the friction torque optimization model, including the following steps:
[0074] S431. Set the convergence threshold;
[0075] S432. Initialize the related parameters to obtain initialization parameters;
[0076] S433. Solving the objective function based on the initialization parameters to obtain the objective function value; comprising the following steps:
[0077] S4331. Acquire an angular velocity sampling sequence, wherein the angular velocity sampling sequence includes a plurality of angular velocities;
[0078] Specifically, starting from 0, with v d1 The input angular velocity given by the angular velocity closed-loop control model is increased in sequence at intervals until the shaft system angle changes and can maintain uniform motion. The angular velocity at this time is recorded as v1, and the corresponding control voltage is the starting voltage;
[0079] With v d2 As intervals, starting from the angular velocity v1, the given input angular velocity is increased in sequence. When the shaft system rotates at a constant speed, the angular velocity V = [v2, v3, ..., v n ], which is the angular velocity sampling sequence.
[0080] S4332. According to the angular velocity closed-loop control model, a plurality of voltage angle curves corresponding to each of the angular velocities in the angular velocity sampling sequence are obtained, wherein the abscissa of the voltage angle curve is the measurement azimuth, and the ordinate is the control voltage;
[0081] Setting the input angular velocity of the angular velocity closed-loop control model according to the angular velocity sampling sequence, thereby obtaining the voltage angle curve corresponding to each angular velocity;
[0082] S4333. Correcting each of the voltage angle curves to obtain a voltage angle correction curve, wherein all of the voltage angle correction curves have the same zero point; comprising the following steps:
[0083] a. Obtaining the mean azimuth of each voltage angle curve comprises the following steps:
[0084] a1. According to the maximum and minimum values of the control voltage of each voltage angle curve, the mean voltage of each voltage angle curve is obtained;
[0085] Wherein, the voltage angle curve is a sine wave, and the voltage mean value is calculated according to the control voltage values corresponding to the peaks and troughs of the control voltage of the voltage angle curve in the full cycle;
[0086] a2. Obtaining a minimum azimuth set of each voltage angle curve according to the voltage mean, wherein the minimum azimuth set includes a plurality of minimum azimuths, wherein the voltage angle curve is a sine wave, and the minimum azimuth is a measured azimuth corresponding to the voltage mean in each cycle;
[0087] like Figure 4 As shown in FIG. 1 , a voltage angle curve corresponding to one angular velocity is shown, and the dotted line is the voltage mean. Then, the measured azimuth angle corresponding to the voltage mean in the voltage angle curve is The minimum azimuth set is:
[0088] a3. Taking the average of the minimum azimuth sets, the mean azimuth of each voltage angle curve is obtained;
[0089] The angular velocity sampling sequence obtained in step S4321 is V = [v2, v3, ..., v n ], there are n angular velocities, then there are correspondingly n minimum azimuth sets, and the mean azimuth set includes n minimum azimuth means;
[0090] b. taking the average of the mean azimuth set to obtain a corrected azimuth;
[0091] The n minimum azimuth angle means are averaged to obtain the corrected azimuth angle, which is denoted as Φ m .
[0092] c. Correcting each of the voltage angle curves according to the correction azimuth to obtain the voltage angle correction curve; that is, correcting n of the voltage angle curves, and after correction, any measured azimuth satisfy Correct the n voltage angle curves to the same zero point for ease of calculation.
[0093] S4334. Sampling on each of the voltage angle correction curves to obtain a plurality of sampling sets, each of the sampling sets including an angular velocity and a plurality of measured azimuth angles and control voltages at the angular velocity;
[0094] S4335. Input the sample set into the friction torque correction model to obtain a theoretical friction torque value;
[0095] The measured azimuth angle in the sampling set is used to obtain the actual angular velocity through formula (1), and the actual angular velocity and the angular velocity v in the sampling set are added together. i And the initialization parameters are input into formula (3) to obtain the theoretical friction torque value;
[0096] S4336. Inputting the sample set into the measured friction torque model to obtain the measured friction torque value;
[0097] The measured friction torque value is calculated according to the control voltage in each of the sampling sets;
[0098] S4337. Obtain the objective function value according to the theoretical friction torque value and the measured friction torque value; input the theoretical friction torque value and the measured torque value into formula (4) to obtain the objective function value;
[0099] S434. When it is determined that the objective function value is less than or equal to the convergence threshold, the objective function is determined to be converged; if the objective function value is greater than the convergence threshold, the initialization parameters are updated, the objective function value is recalculated and the convergence of the objective function is determined until the objective function converges.
[0100] S500. Compensate the friction torque optimization model to the angular velocity closed-loop control model.
[0101] The friction torque optimization model is feed-forward compensated before the driver input voltage position, such as Figure 5 As shown, the system is rotated at different angular velocities to observe whether the shaft system has shaking or creeping phenomena. If such phenomena exist, the angular velocity sampling sequence is reacquired and the friction torque model is optimized again.
[0102] In summary, the present application designs an angular velocity closed-loop control model and establishes an axis rotation model to obtain a rotational inclination angle error model, and compensates it into the friction torque model to obtain a friction torque correction model, and optimizes it to obtain a friction torque optimization model, and compensates it into the angular velocity closed-loop control model, thereby avoiding the problem of decreased compensation accuracy caused by changes in friction torque caused by the rotational inclination angle error.
[0103] The above description is only a preferred embodiment of the present application and an explanation of the technical principles used. Those skilled in the art should understand that the scope of the invention involved in the present application is not limited to the technical solution formed by a specific combination of the above technical features, but should also cover other technical solutions formed by any combination of the above technical features or their equivalent features without departing from the inventive concept. For example, the above features are replaced with the technical features with similar functions disclosed in this application (but not limited to) by each other.
Claims
1. A method for compensating the friction torque based on the rotation angle error of the shaft system. It is characterized in that The steps include: Constructing an angular velocity closed-loop control model, wherein the input of the angular velocity closed-loop control model is the angular velocity, and the output includes a voltage angle curve, wherein the abscissa of the voltage angle curve is the measured azimuth angle, and the ordinate is the control voltage value; Obtaining a rotation tilt angle error model, wherein the input of the rotation tilt angle error model is the actual azimuth angle, and the output is the rotation tilt angle error; Correcting the friction torque model according to the rotation inclination angle error model to obtain a friction torque correction model; Optimizing the relevant parameters of the friction torque correction model to obtain a friction torque optimization model, wherein the relevant parameters include Coulomb friction coefficient, static friction coefficient, Stribeck speed and viscous friction torque proportional coefficient; The friction torque optimization model is compensated to the angular velocity closed-loop control model.
2. The method for compensating the friction torque based on the rotational inclination error of the shaft system according to claim 1, It is characterized in that The step of obtaining the rotation angle error model comprises the following steps: Constructing an axis system rotation model, wherein the axis system rotation model includes a theoretical axis system position and an actual axis system position after the visual axis is rotated; According to the shaft system rotation model, an azimuth error model is obtained, wherein the input of the azimuth error model is the actual azimuth, and the output is the azimuth error; The rotation inclination error model is calculated according to the azimuth error model.
3. The method for compensating the friction torque based on the rotational inclination error of the shaft system according to claim 1, It is characterized in that The friction torque correction model is shown as follows: Where, T f represents the friction torque; T C is the Coulomb friction coefficient, T S represents the static friction coefficient, w S represents the Stribeck speed, B is the proportional coefficient of the viscous friction torque; vi represents the angular velocity; T f (v i ) represents the theoretical friction torque at different angular velocities.
4. The method for compensating the friction torque based on the rotational inclination error of the shaft system according to claim 3, It is characterized in that Optimizing the relevant parameters of the friction torque correction model to obtain the friction torque optimization model includes the following steps: Obtaining a measured friction torque model, wherein the input of the measured friction torque model is a measured azimuth angle, a control voltage, and an angular velocity, and the output is the measured friction torque; constructing an objective function according to the friction torque correction model and the actual friction torque function; The objective function is optimized by a particle swarm algorithm to obtain an optimized correlation function, and then the friction torque optimization model is obtained.
5. The method for compensating the friction torque based on the shaft system rotation error according to claim 4, It is characterized in that Optimizing the objective function by using a particle swarm algorithm to obtain an optimized correlation function comprises the following steps: Set the convergence threshold; Initializing the related parameters to obtain initialization parameters; Solving the objective function based on the initialization parameters to obtain an objective function value; When it is determined that the objective function value is less than or equal to the convergence threshold, it is determined that the objective function converges; If the objective function value is greater than the convergence threshold, the initialization parameter is updated, and the objective function value is recalculated and the convergence of the objective function is determined until the objective function converges.
6. The method for compensating the friction torque based on the shaft system rotation error according to claim 4, It is characterized in that The step of solving the objective function based on the initialization parameters to obtain the objective function value comprises the following steps: Acquire an angular velocity sampling sequence, wherein the angular velocity sampling sequence includes a plurality of angular velocities; According to the angular velocity closed-loop control model, a plurality of voltage angle curves corresponding to each of the angular velocities in the angular velocity sequence are obtained, wherein the abscissa of the voltage angle curve is the measurement azimuth, and the ordinate is the control voltage; Correcting each of the voltage angle curves to obtain a voltage angle correction curve, wherein all of the voltage angle correction curves have the same zero point; Sampling on each of the voltage angle correction curves to obtain a plurality of sampling sets, each of the sampling sets including an angular velocity, a measurement azimuth angle, and a control voltage corresponding thereto; Inputting the sample set into the friction torque correction model to obtain a theoretical friction torque value; Inputting the sampling set into the measured friction torque model to obtain the measured friction torque value; The objective function value is obtained according to the theoretical friction torque value and the measured friction torque value.
7. The method for compensating the friction torque based on the shaft system rotation error according to claim 6, It is characterized in that The step of correcting each of the voltage angle curves to obtain a voltage angle correction curve comprises the following steps: Obtaining the mean azimuth of each of the voltage angle curves; Averaging all the mean azimuths to obtain a corrected azimuth; The voltage angle correction curve is obtained by correcting each of the voltage angle curves according to the corrected azimuth angle.
8. The method for compensating the friction torque based on the shaft system rotation error according to claim 7, It is characterized in that The step of obtaining the mean azimuth of each voltage angle curve comprises the following steps: Obtaining a voltage mean value of each of the voltage angle curves according to a maximum value and a minimum value of a control voltage of each of the voltage angle curves; Obtaining a minimum azimuth set of each voltage angle curve according to the voltage mean value, wherein the minimum azimuth set includes a plurality of minimum azimuths, wherein the voltage angle curve is a sine wave, and the minimum azimuth is a measured azimuth corresponding to the voltage mean value in each full cycle; The minimum azimuth angle sets are averaged to obtain the mean azimuth angle of each voltage angle curve.
