Intelligent vehicle control method and system

Through the limited-time convergence function and inverse step method, the expected control rate of smart cars is designed, combined with the event triggering framework, the problem of excessive control command frequency in the intelligent car control system is solved, trajectory tracking and mechanical component life extension are achieved, and the intelligent car is improved controllability and ride experience.

CN117922607BActive Publication Date: 2024-11-22ZHONGXIONG ZHITU (XIONGAN) TECHNOLOGY CO LTD
View PDF 12 Cites 0 Cited by

Patent Information

Application Number
CN202311765303.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-12-21
Publication Date
2024-11-22
Estimated Expiration
2043-12-21

AI Technical Summary

Technical Problem

When the existing intelligent car control system pursues extremely low trajectory tracking errors, it continuously issues control instructions, resulting in increased wear of mechanical components, reduced service life, affecting passenger riding experience, and is not conducive to the promotion of smart cars.

Method used

The expected control rate of smart cars is designed using a limited-time convergence function and inverse step method. Combined with the event triggering framework, the control rate is updated only when necessary, reducing the frequency of control instructions and calculation burden, and reducing the adjustment frequency of mechanical components.

Benefits of technology

Complete trajectory correction within the preset convergence time, improve the controllability and adjustability of the car, extend the service life of mechanical components, improve passenger experience, reduce the computing and communication overhead of the control system, and promote the promotion of smart cars.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117922607B_ABST
    Figure CN117922607B_ABST
Patent Text Reader

Abstract

The present invention discloses a smart car control method and system, belonging to the field of vehicle control technology, the method comprises: obtaining the navigation path of the smart car; taking the navigation path as the target trajectory, the moving trajectory of the smart car as the trajectory to be corrected, determining a time-limited convergence function for approaching the trajectory to be corrected to the target trajectory within a preset convergence time; determining the tracking error of the smart car; determining the conversion error of the smart car under the time-limited convergence function; designing the expected control rate of the smart car; setting the update trigger condition of the expected control rate under the event trigger framework; determining the intermediate control rate in combination with the update trigger condition; establishing the moving equation of the smart car, and updating the expected control rate according to the intermediate control rate; controlling the smart car according to the moving equation, so that the smart car follows the navigation path. While ensuring that the smart car completes the trajectory tracking within a limited time, the control frequency is reduced, the wear of components is reduced, the life of the car is increased, and the riding experience is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of vehicle control, and in particular relates to an intelligent vehicle control method and system. Background Art

[0002] With the rapid development of computer technology, smart cars that can drive themselves are popular among consumers. Automatic driving is an important direction of smart car control. By using sensors (such as radar, camera, lidar, etc.) to perceive the surrounding environment, and using advanced algorithms and control systems, cars can achieve autonomous driving to a certain extent, reduce the burden on drivers, and improve traffic safety. In the field of smart cars, navigation paths and control systems are closely related. The control system adjusts the vehicle's direction of travel in real time according to the navigation path to track the navigation path to achieve autonomous navigation of the vehicle. The navigation path refers to the path that the vehicle generates in space based on the surrounding environment perceived by the satellite system and the car perception system. It is used to guide the trajectory of the vehicle from the starting point to the target. Once the navigation path planning is completed, the control system of the smart car needs to track the navigation path to complete the automatic driving.

[0003] In the prior art, the control system of a smart car often unnecessarily increases the control frequency of components and pursues extremely low trajectory tracking errors in order to improve the control accuracy of the smart car. During the entire automatic driving process, the control input, i.e., the control rate, is continuously received. Even if the smart car is in a safe driving state, the control input is continuously received to adjust the mechanical system. In this process, the wear of the mechanical components of the smart car is greatly increased and the service life of the mechanical components is reduced. When the driving state of the car is constantly adjusted, the riding experience of the passengers is greatly affected, which is not conducive to the promotion of smart cars. Summary of the invention

[0004] In order to solve the technical problem that the intelligent automobile control system in the prior art continuously issues control instructions, i.e., control rate, during the entire automatic driving process in order to pursue extremely low trajectory tracking error, and continuously issues control instructions to adjust the mechanical system even if the intelligent automobile is in a safe driving state, which greatly increases the wear of the mechanical parts of the intelligent automobile and reduces the service life of the mechanical parts. When the driving state of the automobile is continuously adjusted, the riding experience of the passengers is greatly affected, which is not conducive to the promotion of intelligent automobiles, the present invention provides an intelligent automobile control method and system.

[0005] First aspect

[0006] The present invention provides an intelligent vehicle control method, comprising:

[0007] S101: Obtaining a navigation path of the smart car;

[0008] S102: taking the navigation path as the target trajectory and the moving trajectory of the smart car as the trajectory to be corrected, and determining a time-limited convergence function for the trajectory to be corrected to approach the target trajectory within a preset convergence time;

[0009] S103: determining a tracking error of the smart car according to the target trajectory and the trajectory to be corrected;

[0010] S104: determining a conversion error of the intelligent vehicle under a time-limited convergence function, wherein the conversion error is an error between the corrected trajectory to be corrected and the target trajectory;

[0011] S105: taking the external disturbance as the overall variable, and designing the expected control rate of the intelligent vehicle based on the conversion error and the backstepping method;

[0012] S106: Setting an update trigger condition based on the expected control rate under the event trigger framework;

[0013] S107: Determine an intermediate control rate in combination with the update trigger condition, wherein the intermediate control rate is a control rate used in a process in which the intelligent vehicle converges from a dynamic trajectory to be corrected to a steady-state target trajectory under the update trigger condition;

[0014] S108: establishing a moving equation of the intelligent vehicle according to the expected control rate, and updating the expected control rate according to the intermediate control rate;

[0015] S109: Control the smart car according to the marching equation so that the smart car follows the navigation path.

[0016] Second aspect

[0017] The present invention provides an intelligent vehicle control system, comprising a processor and a memory for storing instructions executable by the processor; the processor is configured to call the instructions stored in the memory to execute the intelligent vehicle control method in the first aspect.

[0018] Compared with the prior art, the present invention has at least the following beneficial technical effects:

[0019] In the present invention, a time-limited convergence function is established according to the acquired navigation trajectory and the moving trajectory of the smart car, and the external uncertain disturbance is considered and incorporated as an overall variable into the conversion error for setting the control rate. The expected control rate of the smart car is designed by the backstepping method, so that the smart car can complete the trajectory correction within the preset convergence time, and then complete the trajectory tracking, improve the controllability and adjustability of the car, and reduce the design complexity and feasibility of the control rate. The event trigger framework is introduced to establish the update trigger condition of the expected control rate, and it is converted into an intermediate control rate to directly intervene and control the update frequency of the expected control rate. By using the event trigger framework based on the dynamic threshold, the calculation burden of the smart car control system is effectively reduced, and decisions are made and the mechanical state is controlled only when necessary. The control instruction update frequency is reduced under the premise of ensuring driving safety, so that the control system will only be triggered to update when the conversion error exceeds a certain threshold, so as to reduce the calculation and communication overhead, thereby reducing the adjustment frequency of the mechanical parts of the car, reducing unnecessary mechanical wear, extending the service life of the car and the passenger riding experience, and facilitating the promotion of smart cars. BRIEF DESCRIPTION OF THE DRAWINGS

[0020] The preferred implementation modes will be described below in a clear and understandable manner with reference to the accompanying drawings to further illustrate the above-mentioned characteristics, technical features, advantages and implementation methods of the present invention.

[0021] Figure 1 It is a flow chart of an intelligent vehicle control method provided by the present invention. DETAILED DESCRIPTION

[0022] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the specific implementation methods of the present invention will be described below with reference to the accompanying drawings. Obviously, the accompanying drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings and other implementation methods can be obtained based on these drawings without creative work.

[0023] In order to simplify the drawings, only the parts related to the invention are schematically shown in each figure, and they do not represent the actual structure of the product. In addition, in order to simplify the drawings and facilitate understanding, in some figures, only one of the parts with the same structure or function is schematically drawn or marked. In this article, "one" not only means "only one", but also means "more than one".

[0024] It should be further understood that the term "and / or" used in the present description and the appended claims refers to and includes any and all possible combinations of one or more of the associated listed items.

[0025] In this document, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0026] In addition, in the description of the present invention, the terms "first", "second", etc. are only used to distinguish the description and cannot be understood as indicating or implying relative importance.

[0027] Example 1

[0028] In one embodiment, the reference specification Figure 1 , showing a flow chart of the intelligent vehicle control method provided by the present invention.

[0029] The present invention provides a smart car control method, comprising:

[0030] S101: Obtaining a navigation path of the smart car.

[0031] Among them, the navigation path refers to the path that a vehicle or robot is scheduled or actually follows in space, which is used to guide the vehicle from the starting point to the target. There are many ways to obtain the navigation path, depending on the specific intelligent vehicle system and navigation technology. For example, global positioning system, navigation system, map data, sensor, environmental perception, cloud service communication, predetermined path and task planning, etc. The method of obtaining the navigation path involves multiple technologies such as location information, map data, environmental perception and communication. The integration and processing of this information can be the responsibility of the vehicle's navigation system to ensure that the vehicle can navigate according to the predetermined path. The current technology for generating navigation paths for autonomous driving vehicles is mature, and various technologies can be used to generate accurate navigation paths in real time.

[0032] S102: Taking the navigation path as the target trajectory and the moving trajectory of the smart car as the trajectory to be corrected, determining a time-limited convergence function for the trajectory to be corrected to approach the target trajectory within a preset convergence time.

[0033] Among them, the target trajectory is the ideal trajectory extracted from the navigation path, which represents the trajectory that the smart car should travel under ideal conditions. The trajectory to be corrected is the actual trajectory of the smart car, which may deviate from the target trajectory due to environmental disturbances, sensor errors, etc. The time-limited convergence function represents the process of the trajectory to be corrected approaching the target trajectory within the preset convergence time. The function usually includes information about time to ensure that the trajectory can reach a certain degree of approximation within the specified time. The purpose of setting the time-limited convergence function is to make the trajectory to be corrected approach the target trajectory within the preset convergence time.

[0034] It should be noted that those skilled in the art can set the preset convergence time according to actual needs, and the present invention does not limit this.

[0035] In a possible implementation, the time-limited convergence function is specifically p(t):

[0036]

[0037] Among them, T p represents the preset convergence time, η(t) represents the trajectory to be corrected, η(∞) represents the target trajectory, and t represents the current time.

[0038] It should be noted that, through the time-limited convergence function, the system sets a limited time window, within which the trajectory of the smart car needs to gradually approach the target trajectory. The approximation process includes adjusting the vehicle's speed, direction or other control inputs to minimize the deviation between the trajectory to be corrected and the target trajectory. Preset convergence duration: This is a pre-set time period that specifies the task of completing trajectory approximation within this time period. By setting this duration, the speed and accuracy of trajectory approximation can be balanced. By introducing a time-limited convergence function, the smart car can approach the actual trajectory to the expected target trajectory within a limited time, which helps the system make effective adjustments within a limited time and improve the efficiency of trajectory control.

[0039] S103: Determine the tracking error of the smart car according to the target trajectory and the trajectory to be corrected.

[0040] In a possible implementation manner, the tracking error is specifically:

[0041] e=R T (η(t)-η(∞)),

[0042] Where e represents the tracking error, R represents the coordinate transformation matrix between the world coordinate system and the body coordinate system, and R T Represents the transpose of the coordinate transformation matrix.

[0043] Among them, the tracking error is a quantitative indicator that represents the distance or deviation between the trajectory to be corrected and the target trajectory, and is used to describe the difference between the current trajectory of the smart car and the expected trajectory. The coordinate transformation matrix is ​​used to describe the transformation relationship between the world coordinate system and the body coordinate system. In vehicle navigation, there are usually two coordinate systems, namely the world coordinate system (global coordinate system) and the body coordinate system (body coordinate system or vehicle body coordinate system). In addition, by converting the tracking error from the body coordinate system to the world coordinate system for better comparison with the target trajectory, this helps the system to more accurately evaluate the difference between the current state of the vehicle and the expected state.

[0044] S104: Determine the conversion error of the smart car under the time-limited convergence function.

[0045] The conversion error is the error between the corrected trajectory and the target trajectory.

[0046] In a possible implementation, S104 specifically includes:

[0047] S1041: Re-determine the tracking error of the smart car in combination with the time-limited convergence function:

[0048] e'=p(t)C(z)

[0049]

[0050] Wherein, e' represents the re-determined tracking error, C(z) represents the error conversion function including the conversion error z;

[0051] S1042: Determine the conversion error according to the error conversion function:

[0052]

[0053] It should be noted that the tracking error is recalculated through the time-limited convergence function and the error conversion function, including weighted adjustment of the error to better reflect the actual situation under the time-limited convergence function, and the conversion error is calculated based on the re-determined tracking error.

[0054] It should be noted that the tracking error contains a variety of different information, such as position error, direction error, etc. By defining and calculating the conversion error, it can be made more in line with the specific control system requirements. In this way, the controller can focus more on the error terms that need attention, thereby improving the control performance of the system. The introduction of conversion error can simplify the design of the controller. The subsequent backstepping method usually requires the introduction of high-order derivatives of the system error into the control design, and the conversion error is a higher-order derivative obtained by the error conversion function, making the entire controller design clearer and simpler. In addition, the introduction of conversion error can enhance the robustness of the controller to system changes and uncertainties. By adjusting the error conversion function, it can better adapt to different working conditions and environmental changes, so that the system can remain stable under different conditions. Processing the tracking error in the required form helps to reduce the complexity of the controller, which is particularly important in practical applications because simplified controllers are easier to implement, debug and maintain.

[0055] In general, the purpose of converting the tracking error into a conversion error is to better meet the needs of control system design, making the system more adaptable and robust, and reducing the computational cost of the subsequent backstepping method to design the control rate based on the conversion error.

[0056] S105: Taking the external disturbance as the overall variable, the expected control rate of the smart car is designed based on the conversion error and the backstepping method.

[0057] In a possible implementation manner, the expression of the expected control rate is specifically:

[0058]

[0059] Where τ(t) represents the desired control rate, M represents the inertia matrix including the additional smart car mass, K1 represents the gain diagonal matrix, tanh represents the hyperbolic tangent function, Represents external disturbance The adaptive estimated value of , s = 0.01 represents the control coefficient, represents the dynamic surface control error, Represents the optimal weight coefficient vector W i *T =blockdiag[W i1 *T ,W i2 *T ,W i3 *T ], where the symbol "blockdiag[]" represents a block diagonal matrix, and the subscript symbols "1, 2, 3" represent the size of each block on the diagonal line of the block diagonal matrix. represents the adaptive update rate of the optimal weight coefficient vector, represents the adaptive update rate of the external disturbance, σ = 2 represents the design parameter of the adaptive update rate of the optimal weight coefficient vector, Π represents the positive definite gain matrix, θ = [x, y, ψ] T represents the displacement and travel angle of the smart car relative to the target trajectory in the world coordinate system, ν = [u,υ,r] T represents the linear velocity and angular velocity of the smart car in the body coordinate system, δ d =0.01 and δ w =0.01 represents the design coefficient of the corresponding adaptive update rate, Represents an intermediate variable.

[0060] Among them, the expected control rate is the control input that the system expects to apply to the smart car. The expected control rate is designed to make the behavior of the smart car tend to the expected trajectory. The gain diagonal matrix is ​​a diagonal matrix used to adjust the gains of different states in the system. The elements on the diagonal represent the weights of different states. By adjusting these weights, the system's response to different states can be affected. The hyperbolic tangent function is used to map real numbers to an interval range to limit the range of the expected control rate.

[0061] The adaptive estimate of the external disturbance represents the estimated value of the external disturbance, which can be obtained through system identification. This estimate is used to offset the impact of the external disturbance on the system. The dynamic surface control error is a dynamic surface control error based on the conversion error. It is a linear combination of the conversion error and its derivative. The design of the dynamic surface control error takes into account the dynamic characteristics of the system. The adaptive estimate of the optimal weight coefficient vector is an estimate of the optimal weight coefficient vector, which is used to adjust the weights of different states in the system to optimize the design of the expected control rate. The update rate of the adaptive estimate and the stability of the system are adjusted comprehensively. In general, by considering the conversion error, external disturbance and system dynamics, an expected control rate is designed so that the intelligent vehicle can approach the target trajectory within a limited time and is robust to external disturbances. The design of this formula takes into account the dynamic characteristics and control requirements of the system to improve the performance and stability of the system.

[0062] S106: Setting an update trigger condition based on the expected control rate under the event trigger framework.

[0063] In a possible implementation manner, S106 specifically includes:

[0064] S1061: With the goal of making the intermediate control rate reach the expected control rate at every two update triggering moments, the update protocol of the intermediate control rate is determined as follows:

[0065] τ(t)=λ(t k ), t k ≤t<t k+1 , k=0,1,…

[0066] Among them, t k represents the triggering time of the kth update, t k+1 represents the k+1th update triggering time, λ(t) represents the intermediate control rate between two update triggering times, λ(t k ) represents the intermediate control rate at the update triggering moment;

[0067] S1062: Determine the update error between the intermediate control rate and the expected control rate between two update triggering moments:

[0068] ξ(t)=λ(t)-τ(t)

[0069] Among them, ξ(t) represents the update error at time t;

[0070] S1063: Setting an update error threshold for the expected control rate and determining an update trigger condition for the expected control rate:

[0071] t k+1 = inf{t>t k ||ξ(t)|≥E}

[0072] E=γ1|τ(t)|+γ2, 0<γ1<1, γ2>0

[0073] Wherein, E represents the update error threshold, |ξ(t)| represents the absolute value of the update error, the symbol “inf” represents the minimum lower bound, |τ(t)| represents the absolute value of the expected control rate, and γ1 and γ2 represent the first dynamic threshold and the second dynamic threshold, respectively.

[0074] It should be noted that the update error between the intermediate control rate and the expected control rate is the control rate deviation of the system at each moment. This update error reflects the degree of deviation between the actual control rate and the expected control rate. In addition, the conditions for triggering the update of the expected control rate are set. Only when the absolute value of the update error is greater than the set threshold E, the update of the expected control rate will be triggered. This mechanism realizes the controller update based on event triggering, and the update will only be performed when necessary. The update strategy based on event triggering can reduce the computational overhead of the system. The update will only be triggered when the system undergoes a large change or deviates from the expectation, avoiding unnecessary calculations. By setting the update trigger conditions, it can be ensured that the system is updated when it deviates greatly from the expectation, thereby improving the stability of the system and its robustness to external disturbances. This strategy provides flexibility for the controller response frequency. By adjusting the update trigger conditions, the computing performance and control quality can be balanced according to the specific application scenarios and performance requirements, which helps to improve the efficiency and stability of the system, while reducing the computing burden, and is suitable for scenarios that require real-time performance and computing efficiency in practical applications. It can be understood that the update trigger conditions determined with the participation of the time-limited convergence function can control the trajectory of the smart car to be corrected to the navigation trajectory according to the preset requirements, that is, the preset convergence time, under various complex working conditions, ensuring the safety of autonomous driving. The introduction of the update trigger condition reduces the control frequency of the control system, thereby avoiding the continuous issuance of control instructions to adjust the mechanical parts, reducing the wear of mechanical parts, and increasing the service life of the smart car. The time-limited convergence function and the update trigger condition are combined through the expected control rate to control the smart car, while ensuring the safety of the car operation, reducing the regulation frequency, reducing the wear of mechanical parts, and improving the passenger experience.

[0075] S107: Determine the intermediate control rate in combination with the update trigger condition.

[0076] Among them, the intermediate control rate is the control rate used in the process of the intelligent vehicle converging from the dynamic trajectory to be corrected to the steady-state target trajectory under the update trigger condition.

[0077] In a possible implementation manner, the intermediate control rate is specifically:

[0078]

[0079] Among them, γ3 represents the associated dynamic threshold.

[0080] It should be noted that the intermediate control rate is determined by combining the update trigger condition. This is the control rate used in the process of the intelligent vehicle converging from the dynamic trajectory to be corrected to the steady-state target trajectory under the update trigger condition. The advantage of this design is that the formulation of the intermediate control rate fully considers the dynamic response of the system, external disturbances and the adaptability of the controller parameters. By introducing a dynamic threshold, the response of the controller can be flexibly adjusted when the system needs it to adapt to different working conditions and requirements.

[0081] Specifically, the specific values ​​of the first dynamic threshold, the second dynamic threshold and the associated dynamic threshold may be: γ1=0.1, γ2=0.5, γ3=3.

[0082] It should be noted that those skilled in the art can set the first dynamic threshold, the second dynamic threshold and the associated dynamic threshold according to actual needs, and the present invention is not limited thereto.

[0083] S108: Establishing a moving equation of the smart car according to the expected control rate, and updating the expected control rate according to the intermediate control rate.

[0084] In a possible implementation, the marching equation is specifically:

[0085]

[0086] Among them, R represents the coordinate transformation matrix between the world coordinate system and the body coordinate system, τ d represents external disturbance, τ(t) represents the expected control rate, i.e., the control input of the smart car.

[0087] It should be noted that the marching equation describes the motion of the smart car in the world coordinate system, including the rate of change of position and orientation. The coordinate transformation matrix is ​​used to transform the control input to the body coordinate system to ensure that the control input is consistent with the orientation and direction of motion of the car. External disturbances take into account the uncertainty in the system and the influence of the external environment. The expected control rate is updated at each moment through the intermediate control rate to ensure that the system is controlled under the guidance of the intermediate control rate, and then the expected control rate is updated at each moment to adapt to the dynamic motion requirements and changes in the external environment.

[0088] S109: Control the smart car according to the marching equation so that the smart car follows the navigation path.

[0089] In a possible implementation, it further includes:

[0090] S110: Monitor the deviation state of the smart car from the navigation path, and issue a warning when the deviation state is greater than a preset deviation state.

[0091] It should be noted that the system monitors the deviation status of the smart car relative to the navigation path. The deviation status refers to the position deviation of the car in the lateral or longitudinal direction relative to the expected trajectory. If the deviation status is greater than the preset deviation threshold, the system will issue a warning to indicate that there is a problem or that measures need to be taken to correct the trajectory of the car. The warning mechanism helps ensure that the smart car can stay within a reasonable trajectory range while following the navigation path. The monitoring and warning of the deviation status can improve the safety and stability of the system and prevent the car from deviating from the intended path and causing potential problems.

[0092] Compared with the prior art, the present invention has at least the following beneficial technical effects:

[0093] In the present invention, a time-limited convergence function is established according to the acquired navigation trajectory and the moving trajectory of the smart car, and the external uncertain disturbance is considered and incorporated as an overall variable into the conversion error for setting the control rate. The expected control rate of the smart car is designed by the backstepping method, so that the smart car can complete the trajectory correction within the preset convergence time, and then complete the trajectory tracking, improve the controllability and adjustability of the car, and reduce the design complexity and feasibility of the control rate. The event trigger framework is introduced to establish the update trigger condition of the expected control rate, and it is converted into an intermediate control rate to directly intervene and control the update frequency of the expected control rate. By using the event trigger framework based on the dynamic threshold, the calculation burden of the smart car control system is effectively reduced, and decisions are made and the mechanical state is controlled only when necessary. The control instruction update frequency is reduced under the premise of ensuring driving safety, so that the control system will only be triggered to update when the conversion error exceeds a certain threshold, so as to reduce the calculation and communication overhead, thereby reducing the adjustment frequency of the mechanical parts of the car, reducing unnecessary mechanical wear, extending the service life of the car and the passenger riding experience, and facilitating the promotion of smart cars.

[0094] Example 2

[0095] In one embodiment, the present invention provides an intelligent vehicle control system, including a processor and a memory for storing processor executable instructions; the processor is configured to call instructions stored in the memory to execute the intelligent vehicle control method in Example 1.

[0096] An intelligent vehicle control system provided by the present invention can implement the steps and effects of the intelligent vehicle control method in the above-mentioned embodiment 1. To avoid repetition, the present invention will not go into details.

[0097] Compared with the prior art, the present invention has at least the following beneficial technical effects:

[0098] In the present invention, a time-limited convergence function is established according to the acquired navigation trajectory and the moving trajectory of the smart car, and the external uncertain disturbance is considered and incorporated as an overall variable into the conversion error for setting the control rate. The expected control rate of the smart car is designed by the backstepping method, so that the smart car can complete the trajectory correction within the preset convergence time, and then complete the trajectory tracking, improve the controllability and adjustability of the car, and reduce the design complexity and feasibility of the control rate. The event trigger framework is introduced to establish the update trigger condition of the expected control rate, and it is converted into an intermediate control rate to directly intervene and control the update frequency of the expected control rate. By using the event trigger framework based on the dynamic threshold, the calculation burden of the smart car control system is effectively reduced, and decisions are made and the mechanical state is controlled only when necessary. The control instruction update frequency is reduced under the premise of ensuring driving safety, so that the control system will only be triggered to update when the conversion error exceeds a certain threshold, so as to reduce the calculation and communication overhead, thereby reducing the adjustment frequency of the mechanical parts of the car, reducing unnecessary mechanical wear, extending the service life of the car and the passenger riding experience, and facilitating the promotion of smart cars.

[0099] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above 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.

[0100] The above embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for those 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 smart car control method, characterized in that: include: S101: Acquire the navigation path of the smart car; S102: taking the navigation path as the target trajectory and the moving trajectory of the smart car as the trajectory to be corrected, and determining a time-limited convergence function for the trajectory to be corrected to approach the target trajectory within a preset convergence time; S103: determining a tracking error of the smart car according to the target trajectory and the trajectory to be corrected; S104: determining a conversion error of the smart car under the time-limited convergence function, wherein the conversion error is an error between the corrected trajectory to be corrected and the target trajectory; S105: taking the external disturbance as the overall variable, and designing the expected control rate of the smart car according to the conversion error in combination with the backstepping method; S106: Setting an update trigger condition of the expected control rate based on the event trigger framework; S107: Determine an intermediate control rate in combination with the update trigger condition, wherein the intermediate control rate is a control rate used in a process in which the smart car converges from a dynamic trajectory to be corrected to a steady-state target trajectory under the update trigger condition; S108: establishing a moving equation of the smart car according to the expected control rate, and updating the expected control rate according to the intermediate control rate; S109: controlling the smart car according to the marching equation so that the smart car follows the navigation path; The time-limited convergence function is specifically p(t): Among them, T p represents the preset convergence time, η(t) represents the trajectory to be corrected, η(∞) represents the target trajectory, and t represents the current time; The tracking error is specifically: e=R T (η(t)-η(∞)), Wherein, e represents the tracking error, R represents the coordinate transformation matrix between the world coordinate system and the body coordinate system, and R T represents the transpose of the coordinate transformation matrix; Wherein, the S104 specifically includes: S1041: Re-determine the tracking error of the smart car in combination with the time-limited convergence function: e'=p(t)C(z) Wherein, e' represents the re-determined tracking error, and C(z) represents the error conversion function including the conversion error z; S1042: Determine the conversion error according to the error conversion function: The expression of the expected control rate is specifically: Wherein, τ(t) represents the desired control rate, M represents the inertia matrix including the additional smart car mass, K1 represents the gain diagonal matrix, tanh represents the hyperbolic tangent function, Represents external disturbance The adaptive estimated value of , s = 0.01 represents the control coefficient, represents the dynamic surface control error, Represents the optimal weight coefficient vector W i *T =blockdiag[W i1 *T ,W i2 *T ,W i3 *T ] is an adaptive estimate of "blockdiag[]" represents a block diagonal matrix, and the subscripts "1, 2, 3" represent the size of each block on the diagonal line of the block diagonal matrix. represents the adaptive update rate of the optimal weight coefficient vector, represents the adaptive update rate of the external disturbance, σ=2 represents the design parameter of the adaptive update rate of the optimal weight coefficient vector, Π represents the positive definite gain matrix, θ=[x, y, ψ] T represents the displacement and travel angle of the smart car relative to the target trajectory in the world coordinate system, ν = [u,υ,r] T represents the linear velocity and angular velocity of the smart car in the body coordinate system, δ d =0.01 and δ w =0.01 represents the design coefficient of the corresponding adaptive update rate, represents an intermediate variable; Wherein, the S106 specifically includes: S1061: With the goal of making the intermediate control rate reach the expected control rate at every two update triggering moments, the update protocol of the intermediate control rate is determined as follows: τ(t)=λ(t k ),t k ≤t<t k+1 ,k=0,1,... Among them, t k represents the triggering time of the kth update, t k+1 represents the k+1th update triggering time, λ(t) represents the intermediate control rate between two update triggering times, λ(t k ) represents the intermediate control rate at the update triggering moment; S1062: Determine an update error between the intermediate control rate between the two update triggering moments and the expected control rate: ξ(t)=λ(t)-τ(t) Among them, ξ(t) represents the update error at time t; S1063: Setting an update error threshold for the expected control rate and determining an update trigger condition for the expected control rate: t k+1 =inf{t>t k ‖ξ(t)|≥E} E=γ1τ(t)|+γ2,0<γ1<1,γ2>0 Wherein, E represents the update error threshold, |ξ(t)| represents the absolute value of the update error, the symbol "inf" represents the minimum lower bound, τ(t)| represents the absolute value of the desired control rate, γ1 and γ2 represent the first dynamic threshold and the second dynamic threshold, respectively; Wherein, the intermediate control rate is specifically: Among them, γ3 represents the dynamic threshold of association; The marching equation is specifically: Among them, R represents the coordinate transformation matrix between the world coordinate system and the body coordinate system, τ d represents the external disturbance, τ(t) represents the expected control rate, that is, the control input of the smart car.

2. The intelligent vehicle control method according to claim 1, characterized in that: Also includes: S110: monitoring the deviation state of the smart car from the navigation path, and issuing an early warning when the deviation state is greater than a preset deviation state.

3. An intelligent automobile control system, characterized in that: It comprises a processor and a memory for storing processor executable instructions; the processor is configured to call the instructions stored in the memory to execute the intelligent vehicle control method according to any one of claims 1 to 2.

Citation Information

Patent Citations

  • Four-rotor unmanned aerial vehicle state constraint control method and state constraint control system

    CN107247464A

  • Underwater robot formation control method with preset performance and connection retention

    CN108983612A

  • Unmanned surface vehicle preset performance tracking control method based on RISE technology

    CN109839934A

  • Unmanned ship trajectory tracking optimal control method with specified performance and input saturation limitation

    CN112327638A

  • Vehicle trajectory planning method and device, storage medium and equipment

    CN112677995A