H-type motion platform all-drive synchronous control method based on self-adaptive switching model

Through the H-type motion platform full drive synchronization control method based on the adaptive switching model, the problem of poor vibration and control stability caused by the coupling synchronization of the two-side motor of the H-type motion platform is solved, and efficient and stable synchronization control effect is achieved.

CN118938664AActive Publication Date: 2024-11-12HARBIN INST OF TECH
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202410983885.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12
Estimated Expiration
2044-07-22

AI Technical Summary

Technical Problem

Due to the problems of vibration, poor control stability and low accuracy due to the coupling synchronization of the two-side motors, the existing synchronization control methods have failed to effectively improve the synchronization control performance.

Method used

Adopting the H-type motion platform full drive synchronization control method based on the adaptive switching model, the bilateral position-decline synchronization dynamic model is established, and the adaptive model switching parameters are designed to achieve the difference Mode and common mode decoupling control, deduce a full drive synchronization system model to improve synchronization control performance.

Benefits of technology

The synchronous control performance of the H-type motion platform is significantly improved, and the problem of platform vibration and poor control stability caused by the out-of-synchronization of the motor movements on both sides is solved, achieving efficient and stable full-drive synchronization control effect.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938664A_ABST
    Figure CN118938664A_ABST
Patent Text Reader

Abstract

The invention discloses an H-shaped motion platform all-drive synchronous control method based on a self-adaptive switching model, and belongs to the field of precision machining, motion control and electromechanical integration servo control. According to the invention, the problems of platform vibration, poor control stability and low precision caused by asynchronous motion of two sides of the H-shaped motion platform are solved. According to the method, a cross beam mass center displacement-synchronization error dynamic model is established according to physical constraints of an H-shaped motion platform, adaptive model switching parameters are constructed, and adaptive model switching between two working conditions of inclination angle adjustment and inclination angle saturation can be realized; then designing a differential mode and common mode decoupling control method to decouple the model into an all-drive synchronous system model, and deducing an all-drive error dynamic model based on the all-drive synchronous system model; and finally, differential mode and common mode control quantities of the motors on the two sides are obtained according to the all-drive error dynamic model, and synchronous control is performed on the H-shaped motion platform based on the differential mode and common mode control quantities. The method can be applied to a high-precision synchronous control task of the H-shaped motion platform.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the fields of precision machining, motion control and mechatronics servo control, and in particular relates to a full-drive synchronous control method of an H-type motion platform based on an adaptive switching model. Background Art

[0002] The H-type motion platform is a servo system that can realize positioning and tracking control in the XY plane. It has a simple and efficient structure. The middle part includes an H-type servo structure composed of a crossbeam and an actuator end. The thrust devices on both sides provide power for the system. In industrial control, the control quantity can be converted into current or voltage by the driver to drive the thrust devices on both sides to move. The thrust device can be a linear motor or a combination of a rotary motor and a ball screw. The H-type motion platform is widely used in automated measurement, large-span gantry cranes, laser processing, surface mounting, and wafer detection systems due to its simple structure, high reliability, and large thrust.

[0003] The control difficulty of the H-type motion platform lies in the coupled synchronous control of the motors on both sides. Since the motors on both sides of the H-type motion platform are coupled together through the crossbeam and there is a gap at the connection between the crossbeam and the guide rail, the movements of the motors on both sides will be coupled and affect each other, resulting in synchronization errors, which will cause the vibration of the H-type motion platform, and reduce the control stability and accuracy. At present, there have been many studies on the decoupling and synchronous control of the H-type motion platform, including master-slave synchronous control, cross-coupling synchronous control and other methods. However, the existing synchronous control methods focus on the synchronous control process and ignore the coupled synchronous dynamics of the H-type motion platform. Therefore, the existing methods are still limited in improving the synchronous control performance of the H-type motion platform, and the control stability and accuracy need to be further improved. Summary of the invention

[0004] The purpose of the present invention is to improve the synchronous control performance of the H-type motion platform and solve the problems of platform vibration, poor control stability and low precision caused by asynchronous bilateral motion. A full-drive synchronous control method of an H-type motion platform based on an adaptive switching model is proposed. The synchronous control performance is improved, thereby improving the tracking and positioning accuracy.

[0005] The technical solution adopted by the present invention to solve the above technical problems is:

[0006] A method for all-wheel drive synchronous control of an H-type motion platform based on an adaptive switching model, the method specifically comprising the following steps:

[0007] Step 1: According to the physical constraints of the H-shaped motion platform, a bilateral position-angle synchronous dynamics model based on the beam deflection angle is established, and then the established bilateral position-angle synchronous dynamics model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamics model based on the beam center of mass displacement and the position deviation of the motors on both sides;

[0008] Step 2: Design an adaptive model switching parameter for the model switching between the two working conditions of the inclination adjustment and inclination saturation of the H-shaped motion platform beam, and transform the model in step 1 into a beam center of mass displacement-synchronous error dynamics model based on the adaptive model switching parameter;

[0009] Step 3: Design a differential mode and common mode decoupling control method for the H-type motion platform, decouple the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters into an all-wheel drive synchronization system model; and then derive the all-wheel drive error dynamics model based on the all-wheel drive synchronization system model;

[0010] Step 4: Obtain the differential mode control quantity and common mode control quantity of the motors on both sides according to the full-drive error dynamics model, and perform synchronous control of the H-type motion platform based on the differential mode control quantity and common mode control quantity of the motors on both sides.

[0011] Furthermore, the bilateral position-angle synchronization dynamics model based on the crossbeam angle is established according to the physical constraints of the H-shaped motion platform, specifically:

[0012] The physical constraints of the H-type motion platform are:

[0013]

[0014] Where θ is the rotation angle of the middle beam, y 1 is the displacement of linear motor 1, y 2 is the displacement of linear motor 2, L is the length of the beam;

[0015] Under physical constraints, the bilateral position-angle synchronous dynamic model of the crossbeam connection of the H-shaped motion platform is:

[0016]

[0017] In the formula, m 1 is the equivalent inertial mass of the linear motor 1, m 2 is the equivalent inertial mass of linear motor 2, m is the average mass of linear motor 1 and linear motor 2, K θ1 C is the rigidity coefficient of the beam angle on the linear motor 1, θ1 K is the damping coefficient of the beam angle on the linear motor 1, θ2 C is the stiffness coefficient of the beam angle on the linear motor 2, θ2is the damping coefficient of the beam angle on the linear motor 2, is the first-order derivative of θ, for y 1 The second-order derivative of for y 2 The second-order derivative of is the second-order derivative of θ, F 1 is the control thrust of linear motor 1, F 2 is the control thrust of linear motor 2, F f1 is the friction force on the linear motor 1, F f2 is the friction force on the linear motor 2;

[0018] The friction force F fi for:

[0019]

[0020] Where i = 1, 2, y i is the displacement of linear motor i, for y i The first derivative of g is the gravitational acceleration, sgn(·) is the sign function, m i is the equivalent inertial mass of linear motor i, μ k The constant friction coefficient of an object in macroscopic motion, k v It represents the kinetic friction coefficient during the macroscopic motion of an object.

[0021] Furthermore, the bilateral position-deflection synchronous dynamics model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamics model based on the beam center of mass displacement and the position deviation of the motors on both sides, specifically:

[0022] The bilateral position-angle synchronization dynamic model based on the crossbeam deflection angle is transformed into a dynamic model based on the position deviation Δy of the motors on both sides:

[0023]

[0024] In the formula, Δy=y 1 -y 2 is the synchronization error of the H-type motion platform, is the first-order derivative of Δy, is the second-order derivative of Δy, K Δ =(K θ1 +K θ2 ) / L,C Δ =(C θ1 +C θ2 ) / L,K i =K θi / L,Ci =C θi / L, i=1,2;

[0025] The dynamic model based on the motor position deviation Δy on both sides is transformed into a beam center of mass displacement-synchronous error dynamic model based on the beam center of mass displacement and the motor position deviation on both sides:

[0026]

[0027] In the formula, y=(y 1 +y 2 ) / 2, is the second-order derivative of y, K y =(K 1 -K 2 ) / 2,C y =(C 1 -C 2 ) / 2.

[0028] Furthermore, the model of step 1 is converted into a beam center of mass displacement-synchronous error dynamics model based on adaptive model switching parameters, and the specific process is:

[0029] When the beam inclination reaches saturation, The beam center of mass displacement-synchronous error dynamics model is transformed into:

[0030]

[0031] Then the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters is:

[0032]

[0033] Where k(Δy) is the designed adaptive model switching parameter;

[0034] The model switching between equation (5) and equation (6) is achieved based on the designed adaptive model switching parameters.

[0035] Furthermore, the adaptive model switching parameter k(Δy) is:

[0036]

[0037] In the formula, Δy max is the maximum value of the guide rail gap, e is the base of the natural logarithm, χ>0, δ>0, and δ represents the parameter of the adaptive term.

[0038] Furthermore, the differential mode and common mode decoupling control method of the H-type motion platform is designed to decouple the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters into an all-wheel drive synchronization system model, specifically:

[0039]

[0040] In the formula, u c For the common mode control of the all-wheel drive synchronization system, u d Differential mode control for all-wheel drive synchronization system;

[0041]

[0042] Furthermore, in order to achieve the desired state of the all-wheel drive synchronization system, the all-wheel drive error dynamics model is:

[0043]

[0044] In the formula, for y r The second derivative of y r is the desired tracking signal of the all-wheel drive synchronization system, for e y The second derivative of y is the position deviation.

[0045] Furthermore, the differential mode control amount and the common mode control amount of the motors on both sides are:

[0046]

[0047] in, is the common mode control quantity of the motors on both sides, is the differential mode control quantity of the motors on both sides, a 0 、a 1 、b 0 and b 1 These are the coefficients required for pole configuration.

[0048] Furthermore, the H-type motion platform is synchronously controlled based on the differential mode control quantity and the common mode control quantity of the motors on both sides, specifically:

[0049]

[0050] In the formula, F 1 is the calculated control thrust of the linear motor 1, F 2 is the calculated control thrust of the linear motor 2.

[0051] Furthermore, the coefficient a required for the pole configuration is 0 、a 1 、b 0 and b 1 The calculation method is:

[0052] Based on the full-wheel drive theory control method, the pole position is set as:

[0053]

[0054] In the formula, λ c1 and λ c2 Indicates position deviation e y The locations of the two dominant poles of the subsystem, λ d1 and λ d2 represents the locations of the two dominant poles of the synchronous subsystem;

[0055] Derived k j ,l j , j = 0,1 and then perform pole configuration, that is, parameter a 0 、a 1 、b 0 and b 1 They are:

[0056]

[0057] The beneficial effects of the present invention are:

[0058] 1. In view of the synchronous motion characteristics of the H-type motion platform, the present invention designs an adaptive model switching parameter. The beam center of mass displacement-synchronous error dynamics model constructed based on the adaptive model switching parameter can not only meet the actual physical system constraints of the H-type motion platform, but also realize continuous model switching between the two working conditions of inclination angle adjustment and inclination angle saturation.

[0059] 2. Based on the adaptive switching model, the present invention proposes a universal differential-mode and common-mode decoupling control method, which can decouple the crossbar center of mass displacement-synchronization error dynamics model into an all-wheel drive synchronization system model, and further obtain the all-wheel drive error dynamics model, which is convenient for realizing the all-wheel drive synchronization control of the H-type motion platform, and has important research significance and practical value.

[0060] 3. According to the all-wheel drive error dynamics model, the present invention proposes an all-wheel drive synchronous control method for an H-type motion platform, and designs an all-wheel drive system control method based on differential mode control and common mode control to improve the synchronous control performance of the H-type motion platform. It can solve the problems of platform vibration, poor control stability and low precision caused by the asynchronous movement of motors on both sides, and achieve efficient and stable all-wheel drive synchronous control effect. BRIEF DESCRIPTION OF THE DRAWINGS

[0061] Figure 1 This is the full-wheel drive synchronous control block diagram of the H-type motion platform;

[0062] Figure 2 This is the result diagram of the synchronous error dynamics identification of the H-type motion platform;

[0063] Figure 3This is a comparison chart of the tracking performance of the beam center of mass displacement under sinusoidal signal input

[0064] Figure 4 It is a comparison chart of the tracking error of the beam center of mass displacement under the sine signal input;

[0065] Figure 5 This is a comparison chart of the synchronization error of the H-type motion platform under sinusoidal signal input. DETAILED DESCRIPTION

[0066] Specific implementation method 1: This implementation method is a method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model, and the method specifically includes the following steps:

[0067] Step 1: According to the physical constraints of the H-shaped motion platform, a bilateral position-angle synchronous dynamics model based on the beam deflection angle is established, and then the established bilateral position-angle synchronous dynamics model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamics model based on the beam center of mass displacement and the position deviation of the motors on both sides;

[0068] Step 2: Design the adaptive model switching parameters for the model switching between the crossbeam inclination adjustment condition and the inclination saturation condition of the H-type motion platform, and transform the model of step 1 into the crossbeam center of mass displacement-synchronous error dynamics model based on the adaptive model switching parameters.

[0069] Step 3: Design a differential mode and common mode decoupling control method for the H-type motion platform, decouple the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters into an all-wheel drive synchronization system model; and then derive the all-wheel drive error dynamics model based on the all-wheel drive synchronization system model;

[0070] Step 4: Obtain the differential mode control quantity and common mode control quantity of the motors on both sides according to the full-drive error dynamics model, and perform synchronous control of the H-type motion platform based on the differential mode control quantity and common mode control quantity of the motors on both sides.

[0071] Specific implementation method 2: This implementation method is different from the specific implementation method 1 in that the bilateral position-angle synchronous dynamics model based on the crossbeam angle is established according to the physical constraints of the H-shaped motion platform, specifically:

[0072] The physical constraints of the H-type motion platform are:

[0073]

[0074] Where θ is the rotation angle of the middle beam, y 1 is the displacement of linear motor 1, y 2 is the displacement of linear motor 2, L is the length of the beam;

[0075] Under physical constraints, the bilateral position-angle synchronous dynamic model of the crossbeam connection of the H-shaped motion platform is:

[0076]

[0077] In the formula, m 1 is the equivalent inertial mass of the linear motor 1, m 2 is the equivalent inertial mass of linear motor 2, m is the average mass of linear motor 1 and linear motor 2, K θ1 C is the rigidity coefficient of the beam angle on the linear motor 1, θ1 K is the damping coefficient of the beam angle on the linear motor 1, θ2 C is the stiffness coefficient of the beam angle on the linear motor 2, θ2 is the damping coefficient of the beam angle on the linear motor 2, is the first-order derivative of θ, for y 1 The second-order derivative of for y 2 The second-order derivative of is the second-order derivative of θ, F 1 is the control thrust of linear motor 1, F 2 is the control thrust of linear motor 2, F f1 is the friction force on the linear motor 1, F f2 is the friction force on the linear motor 2;

[0078] The friction force F fi for:

[0079]

[0080] Where i = 1, 2, y i is the displacement of linear motor i, for y i The first derivative of g is the gravitational acceleration, sgn(·) is the sign function, m i is the equivalent inertial mass of linear motor i, μ k The constant friction coefficient of an object in macroscopic motion, k v It represents the kinetic friction coefficient during the macroscopic motion of an object.

[0081] The other steps and parameters are the same as those in the first embodiment.

[0082] Specific implementation method three: This implementation method is different from specific implementation method one or two in that the bilateral position-deflection synchronous dynamic model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamic model based on the beam center of mass displacement and the position deviation of the motors on both sides. The specific process is as follows:

[0083] Considering the actual industrial control application, the bilateral position-angle synchronization dynamic model based on the beam deflection angle is transformed into a dynamic model based on the position deviation Δy of the motors on both sides:

[0084]

[0085] Where Δy = y 1 -y 2 , is the first-order derivative of Δy, is the second-order derivative of Δy, K Δ =(K θ1 +K θ2 ) / L,C Δ =(C θ1 +C θ2 ) / L,K i =K θi / L,C i =C θi / L, i=1,2;

[0086] Without considering the deviation of the motor models on both sides, the next step of optimization is performed, and the dynamic model based on the position deviation Δy of the motors on both sides is converted into a beam center of mass displacement-synchronous error dynamic model:

[0087]

[0088] In the formula, y=(y 1 +y 2 ) / 2, is the second-order derivative of y, K y =(K 1 -K 2 ) / 2,C y =(C 1 -C 2 ) / 2.

[0089] The other steps and parameters are the same as those in the first or second embodiment.

[0090] Specific implementation method 4: This implementation method is different from any one of specific implementation methods 1 to 3 in that the model in step 1 is converted into a beam center of mass displacement-synchronous error dynamics model based on adaptive model switching parameters. The specific process is as follows:

[0091] Since the motor models on both sides are similar, Ky ,C y ≈0, friction F f1 ,F f2 Provide damping for the system, and the model is now complete;

[0092] In engineering, due to the tolerance of mechanical structure production, the cause of synchronization error is the guide rail gap. Since the guide rail gap is limited, a system model under the extreme position is considered, that is, when the guide rail gap is close to the maximum value Δy→Δy max When the inclination angle of the beam reaches saturation, the inclination angle of the entire beam is fixed. The beam center of mass displacement-synchronous error dynamics model is transformed into:

[0093]

[0094] Then the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters is:

[0095]

[0096] Where k(Δy) is the designed adaptive model switching parameter;

[0097] The model switching between equation (5) and equation (6) is achieved based on the designed adaptive model switching parameters.

[0098] The other steps and parameters are the same as those in Specific Embodiments 1 to 3.

[0099] Specific implementation mode 5: This implementation mode is different from any one of the specific implementation modes 1 to 4 in that the adaptive model switching parameter k(Δy) is:

[0100]

[0101] In the formula, Δy max is the maximum value of the guide rail gap, e is the base of the natural logarithm, χ>0, δ>0, and δ represents the parameter of the adaptive term.

[0102] The other steps and parameters are the same as those in Specific Embodiments 1 to 4.

[0103] Specific implementation method 6: This implementation method is different from specific implementation methods 1 to 5 in that a differential mode and common mode decoupling control method of an H-type motion platform is designed, and the beam center of mass displacement-synchronization error dynamics model based on adaptive model switching parameters is decoupled into an all-wheel drive synchronization system model, specifically:

[0104]

[0105] In the formula, u cIt is the common mode control of the all-wheel drive synchronous system, directly driving the position y subsystem, u d It is the differential mode control of the all-wheel drive synchronous system, used to control the synchronization error Δy subsystem;

[0106]

[0107] The other steps and parameters are the same as those in Specific Implementation Methods 1 to 5.

[0108] Specific implementation method 7: This implementation method is different from any one of specific implementation methods 1 to 6 in that, in order to further achieve the desired state of the all-wheel drive synchronization system, the all-wheel drive error dynamics model is:

[0109]

[0110] In the formula, for y r The second derivative of y r is the desired tracking signal of the all-wheel drive synchronization system, for e y The second derivative of y is the position deviation.

[0111] The other steps and parameters are the same as those in Specific Embodiments 1 to 6.

[0112] Specific implementation eight: This implementation differs from any one of specific implementations one to seven in that the differential mode control amount and the common mode control amount of the motors on both sides are:

[0113]

[0114] in, is the common mode control quantity of the motors on both sides, is the differential mode control quantity of the motors on both sides, a 0 、a 1 、b 0 and b 1 These are the coefficients required for pole configuration.

[0115] The other steps and parameters are the same as those in Specific Embodiments 1 to 7.

[0116] Specific implementation method 9: This implementation method is different from any one of specific implementation methods 1 to 8 in that the H-type motion platform is synchronously controlled based on the differential mode control amount and the common mode control amount of the motors on both sides, specifically:

[0117]

[0118] In the formula, F 1 is the calculated control thrust of the linear motor 1, F 2is the calculated control thrust of the linear motor 2.

[0119] The other steps and parameters are the same as those in Specific Embodiments 1 to 8.

[0120] Specific implementation method 10: This implementation method is different from the specific implementation methods 1 to 9 in that the coefficient a required for the pole configuration is 0 、a 1 、b 0 and b 1 The calculation method is:

[0121] Based on the full-wheel drive theory control method, the pole position is set as:

[0122]

[0123] In the formula, λ c1 and λ c2 Indicates position deviation e y The locations of the two dominant poles of the subsystem, λ d1 and λ d2 Indicates the positions of the two dominant poles of the synchronous subsystem. These two sets of poles need to be obtained according to parameter tuning;

[0124] Based on the two selected sets of poles, k can be derived j ,l j , j = 0,1 and then perform pole configuration, that is, parameter a 0 、a 1 、b 0 and b 1 They are:

[0125]

[0126] The other steps and parameters are the same as those in Specific Embodiments 1 to 9.

[0127] Example

[0128] The present invention is further described in detail below in conjunction with embodiments and drawings, but the embodiments of the present invention are not limited thereto.

[0129] This embodiment provides a tracking and synchronization control method for an H-type motion platform based on a full-drive system model. This embodiment uses a dual-drive linear motor platform to verify the algorithm.

[0130] like Figure 1 The figure shows an H-shaped motion platform of this embodiment. The thrust devices on both sides are linear motors and linear motor drivers. The thrust devices are used to provide power for the system. The thrust devices on both sides are coupled and connected through the middle crossbeam to form an H-shaped motion platform. Figure 1The coordinate transformation, all-wheel drive error dynamics model, elimination of nonlinear terms, pole reconfiguration, and derivation of differential mode and common mode control quantities in the embodiment are an H-type motion platform all-wheel drive synchronous control method based on an adaptive switching model, which specifically includes the following steps:

[0131] Step 1: Establish the dynamic model of the H-type motion platform under two working conditions: crossbeam inclination adjustment and inclination saturation. When the crossbeam inclination does not reach saturation, that is, under the inclination adjustment condition, the crossbeam center of mass displacement-synchronization error dynamic model is:

[0132]

[0133] In the formula, y=(y 1 +y 2 ) / 2, is the second-order derivative of y, K y =(K 1 -K 2 ) / 2,C y =(C 1 -C 2 ) / 2.

[0134] Since the motor models on both sides are similar, K y ,C y ≈0, friction F f1 ,F f2 Provide damping for the system, and the model is now complete;

[0135] In engineering, due to the tolerance of mechanical structure production, the cause of synchronization error is the guide rail gap. Since the guide rail gap is limited, a system model under the extreme position is considered, that is, when the guide rail gap is close to the maximum value Δy→Δy max When the inclination angle of the beam reaches saturation, the inclination angle of the entire beam is fixed. Therefore, when the inclination angle of the beam reaches saturation, that is, under the inclination saturation condition, the beam center of mass displacement-synchronous error dynamics model is transformed into:

[0136]

[0137] Step 2: The beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters is:

[0138]

[0139] Where k(Δy) is the designed adaptive model switching parameter;

[0140] The switching parameter k(Δy) of the designed adaptive model is expressed as follows:

[0141]

[0142] In the formula, parameter δ>0, Δy max >0 According to the specific system design, χ>0 is to prevent the synchronous control input denominator from being 0.

[0143] Step 3: Establish system structure, determine main system parameters and verify model accuracy

[0144] Based on the control method of the all-wheel drive system model, the differential mode and common mode decoupling control method of the H-type motion platform is designed, and the control input is linearly transformed to transform the system into an all-wheel drive system, that is, the linear transformation is as follows:

[0145]

[0146] In the formula, u c represents the common-mode input of the system, which directly drives the position y subsystem, u d Represents the differential input of the system. The differential input is used to control the Δy subsystem, so we get 1 ,y 2 Common mode signal of the thrust of the motors on both sides, u c and u d The full-wheel drive synchronous control of the H-type motion platform based on the adaptive switching model is represented by d →Δy transfer function relationship, and the synchronous error dynamics of the H-type motion platform is identified using the sweep frequency method, such as Figure 2 As shown. Determine the parameters of the adaptive term δ = 2.81, χ = 0.05, Δy max =35.5μm, K Δ =1.627×10 5 , C Δ =171.41.

[0147] Step 4: Assume the expected tracking signal of the system is y r , is the second derivative of the desired tracking signal or the desired acceleration signal, and the following error dynamics equation is obtained:

[0148]

[0149] Step 5: Obtain the differential mode control quantity and common mode control quantity of the motors on both sides according to the full-drive error dynamics model, and reconfigure to eliminate nonlinear terms and poles.

[0150] The derived control quantity:

[0151]

[0152] Combined with the full-wheel drive theoretical control method, the pole position is set as:

[0153]

[0154] In the formula, λ c1,2 Indicates position deviation e y The locations of the two dominant poles of the subsystem, λ d1,2 represents the positions of the two dominant poles of the synchronous subsystem, and chooses different k j ,l j (j=0,1) can be pole-placed.

[0155] Then the solution is and Parameter a j ,b j (j=0,1) is in the following form:

[0156] a 0 =-mk 0

[0157] a 1 =-mk 1

[0158] b 0 =ml 0 / k(Δy)

[0159] b 0 =ml 1 / k(Δy)

[0160] Step 6. Calculate the thrust on both sides through step 4:

[0161]

[0162] Among them, F 1 ,F 2 They represent the thrust on both sides of the H-shaped motion platform respectively, and can simultaneously realize the control of tracking error and synchronization error.

[0163] The above design process is tested. The input reference signal is a sinusoidal signal. The all-wheel drive synchronous control method based on the adaptive switching model proposed in the present invention and the traditional parallel synchronous control method are used to control the bilateral motors of the H-type motion platform to track the reference signal. The following is obtained: Figures 3 to 5 of the test results. Figure 3 This is a comparison chart of the tracking performance of the beam center of mass displacement under sinusoidal signal input. The angular frequency of the input signal is πrad / s and the amplitude is 40mm. Figure 4It is a tracking error comparison diagram of the displacement of the center of mass of the beam under sinusoidal signal input. According to the results in the figure, it can be seen that compared with the traditional control method, the control method proposed in the present invention has better tracking effect, and the error peak is reduced by about 50μm. Figure 5 It is a comparison diagram of the synchronization error of the H-type motion platform under sinusoidal signal input. According to the results in the figure, it can be seen that the synchronization error peak of the control method proposed in the present invention is about 5μm, which is only one-third of the traditional control method, and significantly improves the synchronization control performance of the H-type motion platform.

[0164] The above calculation examples of the present invention are only used to explain the calculation model and calculation process of the present invention in detail, and are not intended to limit the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the scope of protection of the present invention.

Claims

1. A method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model, characterized in that: The method specifically comprises the following steps: Step 1: According to the physical constraints of the H-shaped motion platform, a bilateral position-angle synchronous dynamics model based on the beam deflection angle is established, and then the established bilateral position-angle synchronous dynamics model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamics model based on the beam center of mass displacement and the position deviation of the motors on both sides; Step 2: Design an adaptive model switching parameter for the model switching between the two working conditions of the crossbeam inclination angle adjustment and the inclination angle saturation of the H-type motion platform, and transform the model in step 1 into a crossbeam center of mass displacement-synchronous error dynamics model based on the adaptive model switching parameter; Step 3: Design a differential mode and common mode decoupling control method for the H-type motion platform, decouple the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters into an all-wheel drive synchronization system model; and then derive the all-wheel drive error dynamics model based on the all-wheel drive synchronization system model; Step 4: Obtain the differential mode control quantity and common mode control quantity of the motors on both sides according to the full-drive error dynamics model, and perform synchronous control of the H-type motion platform based on the differential mode control quantity and common mode control quantity of the motors on both sides.

2. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 1, characterized in that: The bilateral position-angle synchronization dynamics model based on the crossbeam deflection angle is established according to the physical constraints of the H-shaped motion platform, specifically: The physical constraints of the H-type motion platform are: Where θ is the rotation angle of the middle beam, y1 is the displacement of linear motor 1, y2 is the displacement of linear motor 2, and L is the length of the beam; Under physical constraints, the bilateral position-angle synchronous dynamic model of the crossbeam connection of the H-shaped motion platform is: Where m1 is the equivalent inertial mass of linear motor 1, m2 is the equivalent inertial mass of linear motor 2, m is the average mass of linear motor 1 and linear motor 2, and K is θ1 C is the rigidity coefficient of the beam angle on the linear motor 1, θ1 K is the damping coefficient of the beam angle on the linear motor 1, θ2 C is the stiffness coefficient of the beam angle on the linear motor 2, θ2 is the damping coefficient of the beam angle on the linear motor 2, is the first-order derivative of θ, is the second-order derivative of y1, is the second-order derivative of y2, is the second-order derivative of θ, F1 is the control thrust of linear motor 1, F2 is the control thrust of linear motor 2, Ff1 is the friction force exerted on linear motor 1, and Ff2 is the friction force exerted on linear motor 2; The friction force Ffi is: Where i = 1, 2, yi is the displacement of linear motor i, is the first-order derivative of yi, g is the acceleration due to gravity, sgn(·) is the sign function, mi is the equivalent inertial mass of the linear motor i, μk represents the constant friction coefficient during the macroscopic motion of the object, and kv represents the dynamic friction coefficient during the macroscopic motion of the object.

3. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 2, characterized in that: The bilateral position-deflection synchronous dynamics model based on the beam deflection angle is converted into a beam center of mass displacement-synchronous error dynamics model based on the beam center of mass displacement and the position deviation of the motors on both sides, specifically: The bilateral position-angle synchronization dynamic model based on the crossbeam deflection angle is transformed into a dynamic model based on the position deviation Δy of the motors on both sides: In the formula, Δy=y1-y2, is the first-order derivative of Δy, is the second-order derivative of Δy, K Δ =(K θ1 +K θ2 ) / L,C Δ =(C θ1 +C θ2 ) / L, Ki=K θ i / L, Ci=C θ i / L, i=1,2; The dynamic model based on the position deviation Δy of the motors on both sides is transformed into the beam center of mass displacement-synchronous error dynamic model: Where y = (y1 + y2) / 2, is the second-order derivative of y, Ky=(K1-K2) / 2, Cy=(C1-C2) / 2.

4. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 3, characterized in that: The model of step 1 is converted into a beam center of mass displacement-synchronous error dynamics model based on adaptive model switching parameters, and the specific process is as follows: When the beam inclination reaches saturation, The beam center of mass displacement-synchronous error dynamics model is transformed into: Then the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters is: Where k(Δy) is the designed adaptive model switching parameter; The model switching between equation (5) and equation (6) is achieved based on the designed adaptive model switching parameters.

5. The method for all-wheel drive synchronous control of an H-type motion platform based on an adaptive switching model according to claim 4, characterized in that: The adaptive model switching parameter k(Δy) is: In the formula, Δy max is the maximum value of the guide rail gap, e is the base of the natural logarithm, χ>0, δ>0, and δ represents the parameter of the adaptive term.

6. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 5, characterized in that: The differential mode and common mode decoupling control method of the H-type motion platform is designed, and the beam center of mass displacement-synchronization error dynamics model based on the adaptive model switching parameters is decoupled into the all-wheel drive synchronization system model, specifically: In the formula, u c For the common mode control of the all-wheel drive synchronization system, u d Differential mode control for all-wheel drive synchronization system; 7. The method for all-wheel drive synchronous control of an H-type motion platform based on an adaptive switching model according to claim 6, characterized in that: The all-wheel drive error dynamics model is: In the formula, for y r The second derivative of y r is the desired tracking signal of the all-wheel drive synchronization system, for e y The second derivative of y is the position deviation.

8. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 7, characterized in that: The differential mode control quantity and common mode control quantity of the motors on both sides are: in, is the common mode control quantity of the motors on both sides, is the differential mode control quantity of the motors on both sides, and a0, a1, b0 and b1 are the coefficients required for pole configuration.

9. The method for all-wheel drive synchronization control of an H-type motion platform based on an adaptive switching model according to claim 8, characterized in that: The H-type motion platform is synchronously controlled based on the differential mode control amount and the common mode control amount of the motors on both sides, specifically: Wherein, F1 is the calculated control thrust of linear motor 1, and F2 is the calculated control thrust of linear motor 2.

10. The method for all-wheel drive synchronous control of an H-type motion platform based on an adaptive switching model according to claim 9, characterized in that: The calculation method of the coefficients a0, a1, b0 and b1 required for the pole configuration is: Based on the full-wheel drive theory control method, the pole position is set as: In the formula, λ c1 and λ c2 Indicates position deviation e y The locations of the two dominant poles of the subsystem, λ d1 and λ d2 represents the locations of the two dominant poles of the synchronous subsystem; Derived k j ,l j , j=0,1 and then perform pole configuration, that is, the parameters a0, a1, b0 and b1 are:

Citation Information

Patent Citations

  • H-shaped motion platform modeling method based on Lagrangian dynamics

    CN109657282A

  • Direct-drive H-shaped platform synchronous control method under zero error constraint

    CN113885441A

  • Self-adaptive friction compensation control method and system for dual-drive tracking platform

    CN114578694A

  • Multi-axis cooperative control method for double-drive gantry platform of chip mounter

    CN116088312A

  • Device and method for improving contour precision of servo system of direct-drive XY motion platform

    CN116300683A