Motion control method for small car

By designing a nonlinear constraint function and inverse step controller based on dynamic model, the problem of insufficient response speed and insufficient constraint consideration of the car control algorithm is solved, and the fast and high-precision tracking control and constraint satisfaction of the car in a fixed time is achieved. , suitable for nonlinear uncertain systems with asymmetric time-varying full-state constraints.

CN114779762BActive Publication Date: 2024-11-26XIAN UNIV OF POSTS & TELECOMM
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210314214.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-03-28
Publication Date
2024-11-26
Estimated Expiration
2042-03-28

AI Technical Summary

Technical Problem

The existing car control algorithm has limited response speed, making it difficult to achieve fast and high-precision tracking control, and lacks constraints on the position and speed of the car, which makes it difficult to meet hardware and safety constraints in practical applications.

Method used

Based on the dynamic model of the car, a nonlinear constraint function and inverse step controller was designed. Through a fixed-time instruction filter and a virtual controller, a car controller was established to ensure that the car achieves the expected state quickly within a fixed time. , high-precision tracking control, and meet the constraints of position and speed.

Benefits of technology

It realizes fast and high-precision tracking control in a fixed time, ensures that the car position and speed meet the constraints, avoids the computational expansion problem in traditional inverse steps, and is suitable for nonlinear uncertain systems that are asymmetric time-varying full-state constraints .

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114779762B_ABST
    Figure CN114779762B_ABST
Patent Text Reader

Abstract

The present invention generally relates to a motion control method for a trolley, and more particularly to a control method for a trolley. The control method is based on a dynamic model of the trolley, and the control method comprises: obtaining a control target of the trolley displacement, the control target comprising an expected displacement y at a corresponding time t d ; Establish a nonlinear constraint function based on the displacement and speed of the car; According to the nonlinear constraint function and the control target, establish a car controller based on the backstepping method; Control the movement of the car according to the car controller. The control method provided by the present invention can ensure fast and high-precision tracking control of the desired state within a fixed time, thereby ensuring that the position and speed of the mobile car meet the constraint conditions.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention generally relates to motion control of a vehicle, and more particularly to a control method for a vehicle. Background Art

[0002] With the rapid development of science and technology, the field of automation has penetrated into social production and life. For example, fully automatic washing machines can wash clothes cleanly without human intervention; in factories, people use various automation devices or systems, such as robots, automated carts, CNC machine tools, flexible production lines and computer integrated manufacturing systems, to complete product processing, assembly, packaging, transportation, storage and other tasks.

[0003] In recent years, automation technology has also been applied to various types of vehicles, and automatic tracking has also been widely used in industrial automation and the automotive industry.

[0004] According to statistics from the World Health Organization, traffic accidents worldwide cause 1.24 million deaths each year, and the number is expected to increase by 20,000 each year. The successful development of driverless vehicles will significantly reduce the number of traffic accidents, so the call is getting louder and louder.

[0005] Secondly, the use of unmanned driving technology will not only reduce the incidence of traffic accidents, but will also greatly alleviate the pressure of traffic congestion.

[0006] However, the international unmanned vehicle driving technology is not very mature yet, and is greatly restricted by environmental factors. Various problems such as driving safety have not been well solved, and can only be debugged continuously. A mobile tracking car is an exploration of unmanned driving technology, and the design of a reasonable automatic control algorithm is crucial to realize the automatic tracking of the mobile car.

[0007] However, the existing car control algorithm has a limited response speed, making it difficult to achieve fast and high-precision tracking control of the given target. On the other hand, the control process lacks consideration of the car's position and speed constraints. However, in actual applications, due to hardware limitations or safety considerations, the car's position and speed often need to be limited to a certain range, that is, to meet certain constraints. Summary of the invention

[0008] The present invention provides a control method for a small vehicle, which is used to solve the above-mentioned problem.

[0009] According to one aspect of the present invention, a control method for a vehicle is provided, wherein the control method is based on a dynamic model of the vehicle, and the control method comprises:

[0010] Get the control target of the vehicle displacement, which includes the expected displacement y at the corresponding time t d ;

[0011] Establish a nonlinear constraint function based on the displacement and velocity of the car;

[0012] According to the nonlinear constraint function and the control target, a trolley controller is established based on the backstepping method, wherein the trolley controller includes:

[0013]

[0014] Among them, u is the car controller; c 2,1 、c 2,2 、c 2,3 , γ 1 , γ 2 is a parameter; 1 =z 1 -η 1 ,ξ 2 =z 2 -η 2 , z 1 = x 1 -x d ; z 2 = x 2 -π 2 ; π 2 is the output signal of the fixed time command filter; 1 is the nonlinear constraint function of displacement, χ 2 is the nonlinear constraint function of velocity, χ d is the nonlinear constraint function of the desired displacement, is the nonlinear constraint function χ 2 The relevant variable term of 1 is the first error compensation signal; η 2 is a second error compensation signal; is the fuzzy logic basis function; for and Estimated value, and The adaptive law is λ 21 , 22 is the coefficient;

[0015] The movement of the trolley is controlled according to the trolley controller.

[0016] The control method provided by the present invention can ensure fast and high-precision tracking control of the desired state within a fixed time, thereby ensuring that the position and speed of the mobile vehicle meet the constraint conditions.

[0017] Furthermore, the fixed time instruction filter is:

[0018]

[0019]

[0020] in, π i+1 =q i,1 ; σ i =q i,1 -α i ; r i,1 ,r i,2 >0, a constant; α i is the input signal of the fixed time command filter, which is a virtual controller; 0.5<β i,1 <1;φ i as a parameter.

[0021] Furthermore, the first virtual controller α based on the displacement 1 and a second virtual controller α based on velocity 2 for:

[0022]

[0023]

[0024] Furthermore, the first error compensation signal η 1 and the second imaginary error compensation signal η 2 for:

[0025]

[0026]

[0027] Furthermore, the nonlinear state constraint functions of displacement and velocity are:

[0028]

[0029]

[0030] Among them, χ 1 (t) is the nonlinear constraint function of displacement; is a positive constant of displacement; x 1 (t) is the displacement of the car relative to the static position at time t; 2 (t) is the nonlinear constraint function of velocity; is a positive constant of speed; x 2 (t) is the speed at time t.

[0031] Furthermore, the dynamic model of the car is:

[0032]

[0033]

[0034] Among them, x 1 is the displacement of the car relative to its resting position, x 2 F is the speed; d is the damping coefficient; M is the mass of the car; is the spring stiffness; k 0 is the amplitude; f 1 (x) = -0.01cos(x 1 )sin(x 2 ) is the external disturbance to the control system.

[0035] Furthermore, the control objectives of the vehicle displacement include:

[0036] y d =0.5sin(0.01t). BRIEF DESCRIPTION OF THE DRAWINGS

[0037] By reading the following detailed description with reference to the accompanying drawings, the above and other objects, features and advantages of the exemplary embodiments of the present invention will become readily understood. In the accompanying drawings, several embodiments of the present invention are shown in an exemplary and non-limiting manner, and the same or corresponding reference numerals represent the same or corresponding parts, wherein:

[0038] Figure 1 is the state x 1 and the desired state y d curve;

[0039] Figure 2 is the state x 2 curve;

[0040] Figure 3 is the tracking error |x 1 -y d |curve;

[0041] Figure 4 is the virtual control force curve;

[0042] Figure 5 It is the control force curve of the car. DETAILED DESCRIPTION

[0043] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.

[0044] It should be understood that when the terms "first", "second", etc. are used in the claims, descriptions, and drawings of the present invention, they are only used to distinguish different objects, rather than to describe a specific order. The terms "include" and "comprise" used in the description and claims of the present invention indicate the presence of the described features, wholes, steps, operations, elements, and / or components, but do not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components, and / or their collections.

[0045] In one embodiment, a motion control method for a mobile vehicle includes the following steps:

[0046] 1) Establish a dynamic model of the mobile car and obtain the control target of the car's displacement.

[0047] The kinetic model is:

[0048]

[0049]

[0050] Let y = x 1 ;

[0051] Among them, x 1 is the displacement of the car relative to its resting position, x 2 F is the speed; d =1.1Ns / m is the damping coefficient; M=1kg is the mass of the trolley; is the spring stiffness; k 0 =0.33N / m, is the amplitude; f 1 (x) = -0.01cos(x 1 )sin(x 2 ) is the external disturbance to the control system.

[0052] The control objective includes the desired displacement y at the corresponding time t d ;y d =0.5sin(0.01t), x(0)=[-0.2,0.5] T is the initial position.

[0053] 2) Establish nonlinear state constraint functions for each state.

[0054] In the control of the car, the state quantities are speed and displacement, so the nonlinear state constraint functions of speed and displacement are:

[0055]

[0056]

[0057] Among them, χ 1 (t) is the nonlinear constraint function of displacement; is a positive constant of displacement; x 1 (t) is the displacement of the car relative to the static position at time t; 2 (t) is the nonlinear constraint function of velocity; is a positive constant of speed; x 2 (t) is the speed at time t.

[0058] 3) According to the nonlinear constraint function and control objectives, the car controller is established based on the backstepping method.

[0059] The car controller is designed based on the Lyapunov function. The car controller is designed as follows:

[0060]

[0061] Among them, u is the car controller; c 2,1 、c 2,2 、c 2,3 , γ 1 , γ 2 is a parameter; 1 =z 1 -η 1 ,ξ 2 =z 2 -η 2 , z 1 = x 1 -x d ;z 2 = x 2 -π 2 ; π 2 is the output signal of the fixed time command filter; 1 is the nonlinear constraint function of displacement, χ 2 is the nonlinear constraint function of velocity, χ d is the nonlinear constraint function of the desired displacement, is the nonlinear constraint function χ 2 The relevant variable term; η 1 is the first error compensation signal; η 2 is a second error compensation signal; is the fuzzy logic basis function; for and Estimated value, and The adaptive law is λ 21 , 22 is the coefficient.

[0062] Car controller π 2 Obtained by the following fixed time command filter:

[0063]

[0064]

[0065] where i=1,...,n,σ i =q i,1 -α i , 0.5<β i,1 <1, β i,2 ∈(1,1+p), p is a positive constant, α i is the input signal of the command filter, π i+1 =q i,1 and

[0066] In this embodiment, n=2, α i is the input signal of the fixed time command filter, is the output of the fixed-time command filter.

[0067] The first virtual controller based on displacement α 1 , the first error compensation signal η 1 and a second virtual controller α based on speed 2 and the second error compensation signal η 2 as follows:

[0068] First virtual controller α 1 for:

[0069]

[0070] The first error compensation signal η 1 Designed for:

[0071]

[0072] Second virtual controller α 2 for

[0073]

[0074] The second error compensation signal is designed as

[0075]

[0076] in, and The adaptive law is

[0077]

[0078] 4) Control the movement of the car according to the car controller in step 3).

[0079] In actual application scenarios, specific parameters can be designed according to specific circumstances. For example, the specific parameters in step 3) above include:

[0080] λ 11 =0.002,λ 12 =0.02,λ 21 =0.002,λ 22 =0.02, κ 1 (t) = 0.7 + 0.05 cos (0.t1), κ 2 (t) = 0.4 + 0.01 cos (0.t1), γ 1 =0.6,γ 2 =1.1,c 1,1 =1,c 1,2 =0.01,c 1,3 =0.01,c 2,1 =1,c 2,2 =0.01,c 2,3 =0.01, μ i =0.4,r 2,1 =0.1,r 2,2 =0.1,β 2,1 =0.6,β 2,2 =1.1.

[0081] According to the above parameters, we can get Figures 1 to 5 The stability of the closed-loop system is proved by ( Figure 4 a 1 That is, virtual control force), the fixed-time tracking control method for asymmetric time-varying full-state constrained nonlinear uncertain systems proposed in the present invention can not only ensure that the closed-loop system is fixed-time stable, and the output tracking error converges to a neighborhood containing the origin within a fixed time, but also make each state of the system meet the constraints.

[0082] From the perspective of control theory, backstepping has always been an active research field for nonlinear systems, but since backstepping is not applicable to uncertain nonlinear systems, various approximate methods, such as fuzzy logic systems and neural networks, are used to design backstepping controllers. It is worth pointing out that in the framework of traditional backstepping methods, the "computational expansion" problem caused by applying multiple differential operators to the virtual control input may occur, which will undoubtedly increase the online computing burden and even lead to a decrease in the performance of the control system. In order to solve this problem, the problem is avoided by using instruction filters to approximate the differential coefficients of the virtual controller when designing the backstepping controller.

[0083] Constraint problems have been a recurring research topic over the past few decades due to their almost universal presence in real-world industrial systems. So far, scholars have studied the state constraint problem for various nonlinear systems using different methods, including the barrier Lyapunov function, which has been shown to be an effective method for dealing with the constraint problem of nonlinear systems. In recent years, backstepping control methods based on barrier Lyapunov functions have been used to study symmetric and asymmetric full-state constrained nonlinear systems. It is worth noting that when using barrier Lyapunov functions for controller design, it is necessary to satisfy the virtual controller to remain in a predefined region, while in practical applications, this assumption requires offline calculation of controller parameters and adds difficulty to parameter design. In addition, when the barrier Lyapunov method is used to deal with asymmetric full-constraint problems, discontinuities occur. Therefore, nonlinear mappings or state-dependent functions are used to study state constraint problems. However, most of the existing results on state-constrained control can only ensure that the resulting closed-loop system is asymptotically stable or finite-time stable.

[0084] As we all know, fast convergence speed is an important requirement for nonlinear system tracking problems. For asymptotic control methods, the desired control performance can only be obtained when the convergence time is close to infinity. Obviously, for some modern complex industrial processes, such as high-performance cars, nuclear power plants and aircraft, it is more practical to achieve the control target within a finite time. Therefore, compared with asymptotic control methods, finite time control methods have better anti-interference ability, faster convergence speed and higher tracking accuracy, so they have received widespread attention. It is worth pointing out that the stability time of finite time control methods depends on the initial state of the system. However, due to various reasons, the initial conditions are often unknown in practical applications, so the requirement of known initial conditions is not always met. Therefore, for uncertain nonlinear systems, fixed time control methods, as an extension of finite time control methods, have a convergence time that does not depend on the initial state of the system. They can make the system output state converge to the desired state within a fixed time, realize fast and high-precision tracking control of uncertain nonlinear systems, and ensure that the system meets the asymmetric time-varying state constraints.

[0085] The control method of the present invention is demonstrated from the perspective of control theory, including:

[0086] Step 1: Establish a nonlinear system model with unknown nonlinear terms.

[0087] The nonlinear system model is:

[0088]

[0089] in, is the system status, and is the system input and output, f i (x), i=1,…,n, j=1,…,n-1 are unknown nonlinear terms of the system. Consider that the system is fully controllable and all states of the system are subject to constraints.

[0090] Step 2: Establish state constraint function

[0091]

[0092] in, is a positive constant, x i The initial state of (t) satisfies x i (0)∈Ω i ,i=1,...,n.

[0093] According to the above formula, we can get

[0094] in,

[0095]

[0096]

[0097] Further, we can get:

[0098] x i (t) = γ i χ i (t),i=1,2,...,n;

[0099] in,

[0100] Step 3: Define the following coordinate transformation.

[0101] z 1 = x 1 -x d ;

[0102] z i = xi -π i ,i=2,...,n;

[0103] in, π i It is the output signal of the following fixed time instruction filter.

[0104] The fixed time instruction filter is designed as:

[0105]

[0106]

[0107] where i=1,...,n,σ i =q i,1 -α i , r i,1 ,r i,2 >0,0.5<β i,1 <1; β i,2 ∈(1,1+p), p is a positive number, α i is the input signal of the command filter, π i+1 =q i,1 and

[0108] Step 4: Design virtual controller α 1 and error compensation signal η 1 .

[0109] By designing a Lyapunov function of the following form

[0110]

[0111] Get virtual controller α 1 for:

[0112]

[0113]

[0114]

[0115] in, λ 11 ,λ 12 ,c 1,1 ,c 1,2 ,c 1,3 Is a positive number.

[0116] Error compensation signal η 1 Designed for:

[0117]

[0118] Step 5: Design virtual controller α 2 and error compensation signal η 2

[0119] By designing a Lyapunov function of the following form

[0120]

[0121] Get the virtual control controller α 2 for:

[0122]

[0123]

[0124]

[0125] in, λ 21 ,λ 22 ,c 2,1 ,c 2,2 ,c 2,3 Is a positive number.

[0126] Error compensation signal η 2 Designed for:

[0127]

[0128] Step 6. Design virtual controller α i , i = 3, ..., n-1 and error compensation signal η i .

[0129] By designing a Lyapunov function of the following form

[0130]

[0131] Get the virtual control controller α i ,i=3,…,n-1 is

[0132]

[0133]

[0134]

[0135] in, λ i1 ,λi2 ,c i,1 ,c i,2 ,c i,3 Is a positive number.

[0136] Error compensation signal η i Designed for:

[0137]

[0138] Step 7: Design controller u and error compensation signal η n .

[0139] By designing a Lyapunov function of the following form:

[0140]

[0141] The following controller u is obtained:

[0142]

[0143]

[0144]

[0145] in λ n1 ,λ n2 ,c n,1 ,c n,2 ,c n,3 Is a positive number.

[0146] Error compensation signal η n Designed for:

[0147]

[0148] The present invention has the following advantages:

[0149] 1. The full-state asymmetric time-varying constraint problem is handled by designing a nonlinear state constraint function. Compared with the traditional barrier Lyapunov-based method, this method is applicable to both symmetric and asymmetric full-state asymmetric time-varying constraint problems without changing the controller structure, and eliminates the assumed constraints that need to be kept in the predetermined area when designing the virtual controller.

[0150] 2. At present, the research results of full-state constrained control based on nonlinear state constraint functions are mostly asymptotically stable or finite-time stable. For uncertain nonlinear systems, this paper proposes a new fixed-time control method based on backstepping, which enables the system to track the desired trajectory within a fixed time and the system state satisfies the constraints.

[0151] 3. When designing the controller, the command filtering technology is used to avoid the "computational expansion" problem caused by the traditional backstepping method.

[0152] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0153] The above-mentioned embodiments only express several implementation methods of the present invention, and the description thereof is relatively specific and detailed, but it cannot be understood as limiting the scope of the patent application. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.

Claims

1. A motion control method for a car, wherein the control method is based on a dynamic model of the car, characterized in that: The control method comprises: Get the control target of the vehicle displacement, which includes the expected displacement y at the corresponding time t d ; Establish a nonlinear constraint function based on the displacement and velocity of the car; According to the nonlinear constraint function and the control target, a trolley controller is established based on the backstepping method, wherein the trolley controller includes: Among them, u is the car controller; c 2,1 、c 2,2 、c 2,3 , γ1, γ2 are parameters; ξ1=z1-η1, ξ2=z2-η2, z1=χ1-χ d ; z2 = χ2-π2; π2 is the output signal of the fixed time command filter; χ1 is the nonlinear constraint function of displacement, χ2 is the nonlinear constraint function of speed, χ d is the nonlinear constraint function of the desired displacement, is the related variable term of the nonlinear constraint function χ2; η1 is the first error compensation signal; η2 is the second error compensation signal; is the fuzzy logic basis function; for and Estimated value, and The adaptive law is λ 21 , 22 is the coefficient; The movement of the trolley is controlled according to the trolley controller.

2. The motion control method according to claim 1, characterized in that: The fixed time command filter is: in, π i+1 =q i,1 ; σ i =q i,1 -α i ; r i,1 ,r i,2 >0, a constant; α i is the input signal of the fixed time command filter, which is a virtual controller; 0.5<β i,1 <1;φ i as a parameter.

3. The motion control method according to claim 2, characterized in that: The first virtual controller α1 based on displacement and the second virtual controller α2 based on speed are:

4. The motion control method according to claim 3, characterized in that: The first error compensation signal η1 and the second imaginary error compensation signal η2 are:

5. The motion control method according to claim 1, characterized in that: The nonlinear state constraint functions of displacement and velocity are: Among them, χ1(t) is the nonlinear constraint function of displacement; is a positive constant of displacement; x1(t) is the displacement of the car relative to the static position at time t; χ2(t) is the nonlinear constraint function of speed; is a positive constant of velocity; x2(t) is the velocity at time t.

6. The motion control method according to claim 1, characterized in that: The dynamic model of the car is: Where x1 is the displacement of the car relative to its resting position, x2 is its velocity; F d is the damping coefficient; M is the mass of the car; is the spring stiffness; k0 is the amplitude; f1(x)=-0.01cos(x1)sin(x2) is the external disturbance to the control system.

7. The motion control method according to claim 1, characterized in that: The control objectives of the trolley displacement include: and d =0.5sin(0.01t)。