Path planning method, device and storage medium for four-wheel independent steering configuration vehicle
By constructing multiple steering kinematic models and integrating parking constraint models, and optimizing path planning using a hybrid integer logic method, the problem of insufficient utilization of multi-type steering modes in the four-wheel independent steering configuration vehicle path planning technology is solved, and efficient Development of path planning and autonomous driving technology.
Patent Information
- Application Number
- CN202410169292.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-02-06
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-02-06
AI Technical Summary
The existing path planning technology is difficult to make full use of the multi-type steering mode of four-wheel independent steering configuration vehicles, and cannot exert its high flexibility and high passability, resulting in limited development of autonomous driving technology.
By constructing multiple steering kinematic models, including Ackerman steering motion mode, oblique motion mode and near zero steering motion mode, and integrating these models to obtain a comprehensive motion mode model, combining map information and parking constraint model for solving, The hybrid integer logic method uniformly models and optimizes the multi-type steering mode.
The optimal path planning of four-wheel independent steering configuration vehicles has been achieved, giving full play to its high flexibility and high passability, improving the efficiency of path planning, and breaking through the difficulties of traditional methods.
Smart Images

Figure CN118031966B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of autonomous driving technology, and in particular to a path planning method for a four-wheel independent steering configuration vehicle, a path planning device for a four-wheel independent steering configuration vehicle, and a storage medium. Background Art
[0002] In recent years, the rapid development of autonomous driving technology has become an important strategic development direction of the global automotive industry, and is of great significance in solving problems such as traffic congestion, operational safety, and driving efficiency. Vehicles with four-wheel independent steering (4WIS) configuration are expected to become a new carrier for the development of autonomous driving technology due to their high passability and high flexibility.
[0003] Path planning is a key part of the autonomous driving technology framework. Its main function is to help the vehicle find a collision-free, smooth, and efficient desired path curve from start to finish, which plays a key role in the efficient and safe operation of the vehicle. However, most of the existing path planning technologies are designed for vehicles with front-wheel steering configurations. It is difficult to fully consider the various steering modes of 4WIS configuration vehicles, and it is also impossible to give full play to its high maneuverability advantages, which limits the development of 4WIS configuration autonomous driving technology. Therefore, the path planning technology issues for 4WIS new configuration vehicles need to be solved urgently.
[0004] At present, there are three main methods for studying the path planning problem of 4WIS configuration vehicles: 1) curve fitting-based methods, that is, using interpolation points and fixed type curves to fit and generate paths; 2) graph search-based methods, that is, using the constructed grid map to search for path curves that meet the requirements; 3) optimization-based methods, that is, considering the vehicle's motion characteristics, collision avoidance conditions and other constraints in the optimization problem to obtain the optimal expected path. These three methods all have their own shortcomings. For example, the first method based on curve fitting cannot give full play to the high flexibility and high passability of 4WIS vehicles, nor can it fully consider multiple steering modes in the path planning process; the second method, like the curve fitting-based method, cannot give full play to the high maneuverability of 4WIS vehicles in the planning process, and does not have the planning ability of multiple steering mode sequences, so it cannot fully utilize all the motion modes of 4WIS configuration vehicles; the third method also cannot fully reflect the advantages of 4WIS configuration vehicles. In addition, the trajectory planning optimization problem of four-wheel steering vehicles has many decision variables and is difficult to solve. Generally, the original problem needs to be simplified or transformed, and solved in combination with intelligent algorithms. The process is cumbersome and not conducive to actual engineering deployment.
[0005] Therefore, how to make full use of the multi-steering modes of the 4WIS configuration vehicle to improve the vehicle's high flexibility and high passability has become a technical problem that needs to be urgently solved by technical personnel in this field. Summary of the invention
[0006] The present invention provides a path planning method for a four-wheel independent steering configuration vehicle, a path planning device and a storage medium for a four-wheel independent steering configuration vehicle, which solve the problem in the related art that the multi-type steering modes of a 4WIS configuration vehicle cannot be fully utilized to improve the vehicle's high flexibility and high passability.
[0007] As a first aspect of the present invention, a path planning method for a vehicle with a four-wheel independent steering configuration is provided, which comprises:
[0008] Obtain the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment;
[0009] Constructing multiple steering kinematic models of the four-wheel independent steering configuration vehicle according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode;
[0010] Integrate multiple steering kinematic models of four-wheel independent steering vehicles to obtain a comprehensive motion pattern model;
[0011] Building a parking constraint model based on map information and target parking information;
[0012] The comprehensive motion pattern model is solved according to the parking constraint model to obtain the optimal parking path planning information.
[0013] Furthermore, multiple steering kinematic models of the four-wheel independent steering configuration vehicle are constructed according to the current posture information and the obstacle information of the environment, including:
[0014] The Ackerman steering motion model is constructed based on the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle.
[0015] The oblique motion mode model is constructed according to the yaw angle of the vehicle with four-wheel independent steering configuration;
[0016] A near-zero steering motion mode model is constructed based on the steering information of a vehicle with four-wheel independent steering configuration.
[0017] Furthermore, an Ackerman steering motion mode model is constructed according to the rear axle center posture, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle, including:
[0018] Determine the vehicle state and vehicle control quantity according to the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle;
[0019] The Ackerman steering motion mode model is determined according to the vehicle state quantity and the vehicle control quantity, wherein the expression of the Ackerman steering motion mode model is:
[0020]
[0021] in, represents the vehicle state, [δ r ,p] represents the vehicle control amount, p represents the direction of vehicle movement, p∈{-1,1}, and p=1 represents the vehicle moving forward, p=-1 represents the vehicle moving backward, Δd represents the product of the wheel linear velocity and the time interval, l r Represents the distance from the center of mass to the rear axle of the vehicle, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0022] Furthermore, an oblique motion mode model is constructed according to the yaw angle of the four-wheel independent steering configuration vehicle, including:
[0023] Ensure that the four wheels of a vehicle with four-wheel independent steering configuration maintain the same direction;
[0024] When the yaw angle of the four-wheel independent steering vehicle remains unchanged, an oblique motion mode model is obtained, wherein the expression of the oblique motion mode model is:
[0025]
[0026] in, represents the vehicle state, [δ r ,p] represents the vehicle control quantity, p represents the direction of vehicle movement, p∈{-1,1}, and p=1 represents the vehicle moving forward, p=-1 represents the vehicle moving backward, Δd represents the product of the wheel linear velocity and the time interval, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0027] Furthermore, a near-zero steering motion mode model is constructed according to the steering information of the four-wheel independent steering configuration vehicle, including:
[0028] Determine the rotation of the vehicle with four-wheel independent steering configuration to a turning radius of zero;
[0029] When the four-wheel independent steering vehicle rotates with the center of mass as the instantaneous center of motion, a near-zero steering motion mode model is obtained, and the expression of the near-zero steering motion mode model is:
[0030]
[0031] in, represents the vehicle state, [δ r ,p'] represents the vehicle control amount, p' represents the vehicle rotation direction, p'∈{-1,1}, and p'=1 represents the vehicle rotating clockwise, p'=-1 represents the vehicle rotating counterclockwise, Δd represents the product of the wheel linear velocity and the time interval, l r represents the distance from the center of mass to the rear axle of the vehicle, w represents the wheelbase, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0032] Furthermore, multiple steering kinematic models of the four-wheel independent steering configuration vehicle are integrated to obtain a comprehensive motion mode model, including:
[0033] The switching affine logic of multiple steering kinematic models is determined, and the expression of the switching affine logic is:
[0034]
[0035]
[0036]
[0037] Among them, α1+α2+α3=1, Represents the vehicle state, u=[δ r ,p] represents the vehicle control amount, ζ i (k+1), i∈{1,2,3} represents the intermediate state quantity at time k+1;
[0038] The comprehensive motion pattern model is obtained according to the switching affine logic, and the expression of the comprehensive motion pattern model is:
[0039]
[0040] Where M represents ζ i The upper bound of (k+1), m represents ζ i The lower bound of (k+1).
[0041] Furthermore, a parking constraint model is constructed according to the map information and the target parking information, including:
[0042] Boundary constraints, motion capability constraints, collision avoidance constraints and vehicle kinematic constraints are determined based on map information and target parking information, wherein the boundary constraints can determine the starting state and terminal state of the vehicle, the motion capability constraints can determine the motion capability of the vehicle, the collision avoidance constraints can determine the conditions under which the vehicle does not collide with obstacles, and the vehicle kinematic constraints can coordinate with the integrated motion mode model.
[0043] Furthermore, the expression of the boundary value constraint is:
[0044]
[0045] V i (N)∈P2,i∈{A,B,C,D},
[0046] δ r (N) = 0;
[0047] The expression of the motion capability constraint is:
[0048] δ min ≤δ r ≤δ max ;
[0049] The expression of the collision avoidance constraint is:
[0050]
[0051] The expression of the vehicle kinematic constraint is:
[0052]
[0053] As another aspect of the present invention, a path planning device for a four-wheel independent steering configuration vehicle is provided, which is used to implement the path planning method for a four-wheel independent steering configuration vehicle as described above, wherein the device comprises:
[0054] An acquisition module is used to acquire the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment;
[0055] A first construction module is used to construct multiple steering kinematic models of the four-wheel independent steering configuration vehicle according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode;
[0056] An integration module is used to integrate multiple steering kinematic models of a four-wheel independent steering configuration vehicle to obtain a comprehensive motion mode model;
[0057] A second building module is used to build a parking constraint model according to the map information and the target parking information;
[0058] The solution module is used to solve the comprehensive motion mode model according to the parking constraint model to obtain the optimal parking path planning information.
[0059] As another aspect of the present invention, a storage medium is provided, which is used to store computer instructions, which, when loaded and executed by a processor, implement the path planning method for a four-wheel independent steering configuration vehicle as described above.
[0060] The path planning method for a four-wheel independent steering configuration vehicle provided by the present invention constructs multiple steering kinematic models through the current posture information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment, thereby obtaining a comprehensive motion mode model, and solving the constructed parking constraint model to obtain the optimal path planning information. This path planning method for a four-wheel independent steering configuration vehicle unifies the modeling of multiple steering modes by using a mixed integer logic method, realizes the coordinated optimization of the steering mode sequence and the continuous path based on a mixed integer nonlinear programming method, gives full play to the high flexibility and high passability advantages of the 4WIS vehicle, and breaks through the problem that the efficiency of the path planning of the new configuration vehicle is limited by the traditional method. BRIEF DESCRIPTION OF THE DRAWINGS
[0061] The accompanying drawings are used to provide further understanding of the present invention and constitute a part of the specification. Together with the following specific embodiments, they are used to explain the present invention, but do not constitute a limitation of the present invention.
[0062] Figure 1 A flow chart of a path planning method for a four-wheel independent steering configuration vehicle provided by the present invention.
[0063] Figure 2 A structural block diagram of a path planning system for a four-wheel independent steering configuration vehicle provided by the present invention.
[0064] Figure 3 A framework diagram of the path planning calculation unit provided by the present invention.
[0065] Figure 4 A flow chart of the method for constructing multiple steering kinematic models provided by the present invention.
[0066] Figure 5 A schematic diagram of the Ackerman steering mode provided by the present invention.
[0067] Figure 6 This is a simplified schematic diagram of the Ackerman steering mode provided by the present invention.
[0068] Figure 7 This is a schematic diagram of the oblique motion mode provided by the present invention.
[0069] Figure 8 This is a schematic diagram of the near-zero steering motion mode provided by the present invention.
[0070] Fig. 9 A schematic diagram of the parking problem provided by the present invention.
[0071] Fig.10 Schematic diagram of comparison of parking centroid paths between a traditional single-mode path planning method and the path planning method of the present invention. DETAILED DESCRIPTION
[0072] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0073] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiment of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiment of the present invention. Obviously, the described embodiment is only a part of the embodiment of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work should fall within the scope of protection of the present invention.
[0074] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so as to describe the embodiments of the present invention described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0075] The path planning methods existing in the prior art consider a relatively single vehicle motion mode, which cannot fully utilize the multi-type steering modes of 4WIS configuration vehicles, and it is also difficult to fully utilize the high flexibility and high passability advantages of new configuration vehicles.
[0076] Based on this, a path planning method for a vehicle with four-wheel independent steering configuration is provided in this embodiment. Figure 1 is a flow chart of a path planning method for a four-wheel independent steering configuration vehicle according to an embodiment of the present invention, such as Figure 1 As shown, including:
[0077] S100, obtaining current position information of the four-wheel independent steering vehicle and obstacle information of the environment;
[0078] In an embodiment of the present invention, the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment can be obtained based on the data obtained by the perception positioning system. The current position information of the four-wheel independent steering configuration vehicle can specifically include the position of the vehicle and the instantaneous center of motion of the vehicle and the center of mass of the vehicle. The obstacle information of the environment is the coordinate information of the obstacles around the vehicle.
[0079] S200, constructing multiple steering kinematic models of the vehicle with four-wheel independent steering configuration according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode;
[0080] In the embodiment of the present invention, since the vehicle speed is low during parking, the tire side slip phenomenon is not obvious, and the kinematic model can describe the vehicle dynamics with high accuracy. Therefore, the embodiment of the present invention selects the kinematic model to design the parking optimization problem, which reduces the complexity while ensuring the planning accuracy.
[0081] Specifically, since the steering kinematic model can include an Ackerman steering motion mode, an oblique motion mode, and a near-zero steering motion mode, the present invention comprehensively considers a variety of kinematic models, and constructs multiple steering kinematic models of a four-wheel independent steering configuration vehicle based on current posture information and obstacle information in the environment. This modeling method that comprehensively considers multiple steering kinematic models can establish a unified mixed integer nonlinear programming problem and realize the coordinated planning of the optimal steering mode sequence and the continuous path. At the same time, by simplifying the specific motion mode, the complexity of the optimization problem is reduced, and the real-time requirements of the online solution are met.
[0082] S300, integrating multiple steering kinematic models of a vehicle with a four-wheel independent steering configuration to obtain a comprehensive motion pattern model;
[0083] In an embodiment of the present invention, after integrating multiple steering kinematic models, a comprehensive motion pattern model is constructed, and the comprehensive motion pattern model can realize mode switching to give full play to the advantage of high maneuverability.
[0084] S400, constructing a parking constraint model according to the map information and the target parking information;
[0085] In an embodiment of the present invention, a parking constraint model is constructed according to map information and target parking information. The specific parking constraint model may include kinematic constraints, boundary value constraints, collision avoidance constraints, motion capability constraints, and the like.
[0086] S500: Solve the comprehensive motion pattern model according to the parking constraint model to obtain optimal parking path planning information.
[0087] The comprehensive motion pattern model is solved according to the constructed parking constraint model to achieve the collaborative planning of the optimal motion pattern sequence and continuous path for 4WIS configuration vehicles.
[0088] Therefore, the path planning method for a four-wheel independent steering configuration vehicle provided by the present invention constructs multiple steering kinematic models through the current posture information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment, thereby obtaining a comprehensive motion mode model, and solving the constructed parking constraint model to obtain the optimal path planning information. This path planning method for a four-wheel independent steering configuration vehicle unifies the modeling of multiple steering modes by using a mixed integer logic method, realizes the coordinated optimization of the steering mode sequence and the continuous path based on a mixed integer nonlinear programming method, gives full play to the high flexibility and high passability advantages of the 4WIS vehicle, and breaks through the problem that the efficiency of the path planning of the new configuration vehicle is limited by the traditional method.
[0089] It should be understood that path planning is an important part of the autonomous driving technology framework. The path planning module is connected to the perception positioning, mapping, and decision-making systems, and the motion control system. Its main function is to plan a smooth desired path curve that avoids collisions and is easy to track. The system to which the path planning method of the present invention is applied is as follows: Figure 2 As shown. Before solving the optimal steering mode sequence and parking path, the embodiment of the present invention is based on the acquired perception and positioning system data, the map information of the mapping module and the parking task information of the decision system. The perception and positioning system data mainly includes the posture of the vehicle and the obstacles, garages and other information in the environment. The mapping module is responsible for constructing the map information required for the parking problem, and the decision system determines the expected parking space, etc. The path planning method of the present invention calculates the optimal motion mode sequence and parking path that conforms to the 4WIS configuration based on this information. In addition to path planning, there is usually a speed planning module, which will calculate the smooth and comfortable expected speed based on the optimal mode sequence and parking task requirements. Finally, the obtained path and speed information will be synthesized together as the expected trajectory information, and passed to the motion control module to generate the expected front and rear wheel angles, throttle opening, brake pedal opening and other information to drive the vehicle to track the reference trajectory.
[0090] The embodiment of the present invention performs path planning for automatic parking. The composition framework of the path planning calculation unit system in the specific path planning is as follows: Figure 3As shown. The input of the path planning system for vehicles with multiple motion modes of the present invention is vehicle posture information, wheel angle data, map information, target parking space information, etc. After being solved by the calculation unit, the optimal motion mode sequence and the optimal parking path are obtained. Among them, the calculation unit includes a comprehensive objective function, hybrid logic kinematic constraints, boundary value constraints, collision avoidance constraints, motion capability constraints, etc. The hybrid logic kinematic constraints of the present invention use a unified mixed integer logic modeling method to characterize the multiple motion modes of 4WIS vehicles, and realize the coordinated planning of motion mode sequences and vehicle paths.
[0091] In the embodiment of the present invention, specifically, multiple steering kinematic models of a four-wheel independent steering configuration vehicle are constructed according to the current posture information and the obstacle information of the environment, such as Figure 4 As shown, including:
[0092] S210, constructing an Ackerman steering motion mode model according to the rear axle center posture, wheel speed information, and steering angle information of the four-wheel independent steering configuration vehicle;
[0093] Ackerman steering mode means that the front and rear axle wheels of the vehicle both meet the Ackerman steering relationship. Although the 4WIS configuration vehicle does not have a mechanical steering trapezoidal structure, it has good motion characteristics such as low tire wear rate when it meets the Ackerman steering relationship. In the Ackerman steering mode, the vehicle's motion diagram is as follows Figure 5 This mode includes two forms: the front and rear wheels run in opposite directions and the front and rear wheels run in the same direction.
[0094] In this model, the vehicle state variables include The control quantity includes [δ fl ,δ fr ,δ rl ,δ rr ,α fl ,α fr ,α rl ,α rr ,t]. Among them, Represents the position of the vehicle's rear axle center, v ij ,δ ij ,a ij represents the linear speed, turning angle and tangential acceleration of the front left, front right, rear left and rear right wheels, i∈{f,r}, j∈{l,r}, and t is the time taken for the parking process. In the construction of the optimization problem, the state quantity and the control quantity will be used together as optimization decision variables, making the optimization problem large-scale and highly complex.
[0095] Therefore, in the embodiment of the present invention, the following simplified Ackerman steering mode is adopted, such as Figure 6 As shown. Among them, the following two simplifications are made:
[0096] a) The line connecting the instantaneous center of motion and the center of mass of the vehicle is required to be perpendicular to the longitudinal center axis of the vehicle;
[0097] b) Simplify the four-wheel vehicle into a single-track model.
[0098] Specifically, an Ackerman steering motion mode model is constructed according to the rear axle center posture, wheel speed information and steering angle information of a four-wheel independent steering configuration vehicle, including:
[0099] Determine the vehicle state and vehicle control quantity according to the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle;
[0100] The Ackerman steering motion mode model is determined according to the vehicle state quantity and the vehicle control quantity, wherein the expression of the Ackerman steering motion mode model is:
[0101]
[0102] in, represents the vehicle state, [δ r ,p] represents the vehicle control amount, p represents the direction of vehicle movement, p∈{-1,1}, and p=1 represents the vehicle moving forward, p=-1 represents the vehicle moving backward, Δd represents the product of the wheel linear velocity and the time interval, l r Represents the distance from the center of mass to the rear axle of the vehicle, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0103] It should be noted that the discrete path may be a planned path for parking, and the path sequence points in the discrete path sequence may be each change point on the planned path from the initial position to the target position during parking. For example, if N is 10 in the path planning from the initial position to the target position during parking, it means that the target position is reached after 10 point changes in the path planning from the initial position.
[0104] Since the front and rear wheels are in the same direction, the steering mode is mostly used at high speeds to ensure driving stability. The simplified Ackerman steering mode only includes the situation where the front and rear wheels are in different directions, which can meet the needs of low-speed parking problems. At this time, the vehicle state includes The control quantity includes [δ r ,a r ,t]. Furthermore, in the present invention, the linear velocity v of the rear wheel is required to be r The product of the time interval T = t / N is a constant, denoted as Δd. Where N is the number of path points, and Δd = d / N. Thus, the time-related variables in the original kinematic relationship can be eliminated, and the state quantity is left as The remaining control amount [δr ,p]. Where p∈{-1,1} is the direction of vehicle movement, p=1 represents forward movement, and p=-1 represents backward movement. The planning based on this motion relationship can then be simplified to path planning. The simplified kinematic equation of the Ackerman steering mode is as follows:
[0105]
[0106] Among them, w represents the wheelbase, l f , l r Represents the distance from the center of mass to the front and rear axes. The remaining control quantities can be calculated using the following geometric relationships:
[0107]
[0108]
[0109] S220, constructing an oblique motion mode model according to the yaw angle of the vehicle with four-wheel independent steering configuration;
[0110] In the embodiment of the present invention, the oblique motion mode of the 4WIS vehicle means that the four wheels run in the same direction. At this time, the yaw angle of the vehicle remains unchanged, and the vehicle runs obliquely in the direction of the wheels, such as Figure 7 shown.
[0111] Specifically, the oblique motion mode model is constructed according to the yaw angle of the four-wheel independent steering configuration vehicle, including:
[0112] Ensure that the four wheels of a vehicle with four-wheel independent steering configuration maintain the same direction;
[0113] When the yaw angle of the four-wheel independent steering vehicle remains unchanged, an oblique motion mode model is obtained, wherein the expression of the oblique motion mode model is:
[0114]
[0115] in, represents the vehicle state, [δ r ,p] represents the vehicle control quantity, p represents the direction of vehicle movement, p∈{-1,1}, and p=1 represents the vehicle moving forward, p=-1 represents the vehicle moving backward, Δd represents the product of the wheel linear velocity and the time interval, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0116] It should be noted that the remaining control quantities can be obtained through the following relationship:
[0117] δ f =δ r =δfl =δ fr =δ rl =δ rr .
[0118] S230: construct a near-zero steering motion mode model according to the steering information of the vehicle with four-wheel independent steering configuration.
[0119] 4WIS vehicle's near-zero turning means that the vehicle as a whole rotates with a turning radius of nearly zero, such as Figure 8 As shown. In the present invention, the vehicle is required to rotate with the center of mass as the instantaneous center of motion, p'=1 means the vehicle rotates clockwise, and p'=-1 means the vehicle rotates counterclockwise. The near-zero steering mode gives the vehicle extremely high flexibility and passability, enabling it to pass through narrow terrain and significantly reducing the number of forward and reverse switching times of the vehicle.
[0120] Specifically, a near-zero steering motion mode model is constructed according to the steering information of a vehicle with a four-wheel independent steering configuration, including:
[0121] Determine the rotation of the vehicle with four-wheel independent steering configuration to a turning radius of zero;
[0122] When the four-wheel independent steering vehicle rotates with the center of mass as the instantaneous center of motion, a near-zero steering motion mode model is obtained, and the expression of the near-zero steering motion mode model is:
[0123]
[0124] in, represents the vehicle state, [δ r ,p'] represents the vehicle control amount, p' represents the vehicle rotation direction, p'∈{-1,1}, and p'=1 represents the vehicle rotating clockwise, p'=-1 represents the vehicle rotating counterclockwise, Δd represents the product of the wheel linear velocity and the time interval, l r represents the distance from the center of mass to the rear axle of the vehicle, w represents the wheelbase, k represents the path sequence point number in the discrete path sequence, where k∈{0,1,2,...,N-1}, and N represents the number of path points for each path planning.
[0125] In the embodiment of the present invention, the remaining rotation angle control quantities are obtained by the following relationship:
[0126]
[0127] In an embodiment of the present invention, multiple steering kinematic models of a four-wheel independent steering configuration vehicle are integrated to obtain a comprehensive motion pattern model, including:
[0128] The switching affine logic of multiple steering kinematic models is determined, and the expression of the switching affine logic is:
[0129]
[0130] Among them, α1+α2+α3=1, Represents the vehicle state, u=[δ r ,p] represents the vehicle control amount, ζ i (k+1), i∈{1,2,3} represents the intermediate state quantity at time k+1;
[0131] The comprehensive motion pattern model is obtained according to the switching affine logic, and the expression of the comprehensive motion pattern model is:
[0132]
[0133] Where M represents ζ i The upper bound of (k+1), m represents ζ i The lower bound of (k+1).
[0134] Specifically, in the present invention, the following equivalent relations are defined to characterize various types of motion modes:
[0135]
[0136] Among them, α1, α2 and α3 are all represented as Boolean type variables. Since the vehicle can only move in one motion mode at the same time, it must meet the following requirements:
[0137] α1+α2+α3=1.
[0138] The various kinematic relations are simplified into the following form:
[0139]
[0140] in, Represents the vehicle state, u=[δ r ,p] represents the vehicle control amount. The selection of multi-type motion mode has the following switching affine logic:
[0141]
[0142] Among them, i (k+1),i∈{1,2,3} represents the intermediate state quantity at time k+1, that is, the state derived from the three types of motion modes. The recursive state quantity ζ(k+1) at time k+1 is obtained by superimposing the intermediate state quantities of each type of motion mode, that is,
[0143] ζ(k+1)=ζ1(k+1)+ζ2(k+1)+ζ3(k+1).
[0144] In the present invention, the Big-M method is used to characterize the "if-then-else" relationship, that is,
[0145]
[0146] By changing the "if-then-else" logical relationship in the previous formula into an explicit inequality relationship. This inequality relationship requires the state quantity ζ i (k+1) is a bounded variable, that is, there is an upper bound M and a lower bound m. Generally speaking, the range of a parking lot is limited, and there is no situation where the parking lot boundary is infinite. Moreover, during a parking process, the amplitude of the vehicle's heading angle change is also limited, and there is no phenomenon where the vehicle's heading angle is infinite. Therefore, this requirement is reasonable in the automatic parking problem, and the expression of the comprehensive motion mode model is relatively easy to meet.
[0147] In an embodiment of the present invention, a parking constraint model is constructed according to map information and target parking information, including:
[0148] Boundary constraints, motion capability constraints, collision avoidance constraints and vehicle kinematic constraints are determined based on map information and target parking information, wherein the boundary constraints can determine the starting state and terminal state of the vehicle, the motion capability constraints can determine the motion capability of the vehicle, the collision avoidance constraints can determine the conditions under which the vehicle does not collide with obstacles, and the vehicle kinematic constraints can coordinate with the integrated motion mode model.
[0149] Specifically, the expression of the boundary value constraint is:
[0150]
[0151] V i (N)∈P2,i∈{A,B,C,D},
[0152] δ r (N) = 0;
[0153] The expression of the motion capability constraint is:
[0154] δ min ≤δ r ≤δ max ;
[0155] The expression of the collision avoidance constraint is:
[0156]
[0157] The expression of the vehicle kinematic constraint is:
[0158]
[0159] Taking parallel parking in a narrow parking space as an example, the main tasks of parking in the present invention are described, such as Fig. 9 As shown. The vehicle starts from the initial point (x s ,y s ) and finally enters parking space P2. During this period, parking spaces P1 and P3 are regarded as obstacles. In the present invention, the constraints of the optimization problem established include boundary value constraints, motion capacity constraints, collision avoidance constraints, and vehicle kinematic constraints; among which the vehicle kinematic constraints contain a multi-type motion mode of mixed logic, which is the key to realizing the coordinated planning of steering mode sequence and continuous path. For example Fig. 9 In the figure, the vehicle is in the Ackerman steering motion mode in the red path from the starting point to point M; the vehicle follows the diagonal motion mode in the blue path from point M to the parking end point. During the entire automatic parking process, a motion mode switch occurs.
[0160] 1) Boundary value constraints
[0161] In the embodiment of the present invention, the boundary value constraint is used to clarify the initial state and terminal state of the vehicle, as shown in the following formula:
[0162]
[0163] V i (N)∈P2,i∈{A,B,C,D},
[0164] δ r (N) = 0;
[0165] in, Indicates the state and control quantity of the vehicle at the initial moment. In order to enhance the solvability of the optimization problem, at the terminal moment, only the vehicle outline is required to be in the P2 parking space, without restricting the yaw angle at this time.
[0166] 2) Sports ability constraints
[0167] In an embodiment of the present invention, the following constraints are established to characterize the vehicle's motion capability:
[0168] δ min ≤δ r ≤δ max .
[0169] 3) Collision avoidance constraints
[0170] In an embodiment of the present invention, a triangle area method is used to model the collision avoidance constraint:
[0171]
[0172] This inequality relationship is a necessary and sufficient condition for the vehicle not to collide with an obstacle.
[0173] 4) Hybrid logical kinematic constraints
[0174] In an embodiment of the present invention, mixed integer logic is used to model the 4WIS polymorphic steering motion mode, and the following formula can be directly used as a kinematic constraint in the optimization problem:
[0175] α1+α2+α3=1,
[0176] ζ(k+1)=ζ1(k+1)+ζ2(k+1)+ζ3(k+1),
[0177]
[0178] 5) Mixed integer nonlinear programming problem
[0179] In the present invention, the following mixed integer nonlinear programming problem is established:
[0180]
[0181] Among them, Q, P and R are weight matrices, which penalize the total length of the planned parking path, the number of mode switching and the smoothness of the steering angle respectively. The continuous optimization decision variables are ζ1(1)~ζ1(N), ζ2(1)~ζ2(N), ζ3(1)~ζ3(N), ζ(0)~ζ(N), δ r (0)~δ r (N-1), d; the integer optimization decision variables are p(0)~p(N-1); the Boolean optimization decision variables are α1(0)~α1(N-1), α2(0)~α2(N-1), α3(0)~α3(N-1).
[0182] In this optimization problem, the continuous decision variables reflect the path of the vehicle, that is, the posture state and control quantity of each point; while the Boolean decision variables reflect the motion pattern sequence of the vehicle during the entire parking process. The two together serve as optimization variables for mixed integer nonlinear programming, which can not only optimize the parking path, but also optimize the steering motion pattern sequence.
[0183] In summary, the path planning method for a four-wheel independent steering configuration vehicle provided by the present invention reduces the complexity of the path planning problem by simplifying the typical motion of the vehicle, thereby improving the real-time performance of the planning process. At the same time, by adopting a mixed integer logic method to unify the modeling of multiple steering modes, the coordinated optimization of the steering mode sequence and the continuous path is achieved based on a mixed integer nonlinear programming method, giving full play to the high flexibility and high passability advantages of 4WIS vehicles, and breaking through the problem that the efficiency of path planning for new configuration vehicles is limited by traditional methods.
[0184] by Fig.10 The vertical parking example shown is used to illustrate the effect of the path planning method of the present invention. Fig.10 The left figure in the figure shows the simulation result of the traditional Ackerman steering single-mode path planning, and the right figure shows the simulation result of the multi-mode motion mode path planning method proposed in the present invention, where d represents the moving distance of the vehicle's center of mass. Fig.10 It can be seen that under the traditional single-mode path planning method, the vehicle adopts a strategy of first advancing and then retreating to enter the warehouse, and the overall centroid path length is 9.56m; while in the method proposed by the present invention, the vehicle first turns on the spot, and when the vehicle direction is adjusted, it directly reverses into the warehouse, and the overall centroid path length is 6.72m. The multi-mode motion mode path planning method for a four-wheel independent steering configuration vehicle proposed by the present invention can significantly improve the efficiency of path planning, give full play to the high flexibility advantage of this new configuration vehicle, and will have a wide range of applications under obstacle density and narrow space.
[0185] As another aspect of the present invention, a path planning device for a four-wheel independent steering configuration vehicle is provided, which is used to implement the path planning method for a four-wheel independent steering configuration vehicle as described above, wherein the device comprises:
[0186] An acquisition module is used to acquire the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment;
[0187] A first construction module is used to construct multiple steering kinematic models of the four-wheel independent steering configuration vehicle according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode;
[0188] An integration module is used to integrate multiple steering kinematic models of a four-wheel independent steering configuration vehicle to obtain a comprehensive motion mode model;
[0189] A second building module is used to build a parking constraint model according to the map information and the target parking information;
[0190] The solution module is used to solve the comprehensive motion mode model according to the parking constraint model to obtain the optimal parking path planning information.
[0191] The path planning device for a four-wheel independent steering configuration vehicle provided by the present invention constructs multiple steering kinematic models through the current posture information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment, thereby obtaining a comprehensive motion mode model, and solving the constructed parking constraint model to obtain the optimal path planning information. This path planning method for a four-wheel independent steering configuration vehicle unifies the modeling of multiple steering modes by using a mixed integer logic method, realizes the coordinated optimization of the steering mode sequence and the continuous path based on a mixed integer nonlinear programming method, gives full play to the high flexibility and high passability advantages of the 4WIS vehicle, and breaks through the problem that the efficiency of the path planning of the new configuration vehicle is limited by the traditional method.
[0192] The specific working principle of the path planning device for a four-wheel independent steering configuration vehicle provided by the present invention can be referred to the description of the path planning method for a four-wheel independent steering configuration vehicle in the previous text, and will not be repeated here.
[0193] As another aspect of the present invention, a storage medium is provided, which is used to store computer instructions, which, when loaded and executed by a processor, implement the path planning method for a four-wheel independent steering configuration vehicle as described above.
[0194] In an embodiment of the present invention, a non-transitory computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer-executable instructions, and the computer-executable instructions can execute the path planning method for a four-wheel independent steering configuration vehicle in any of the above method embodiments. Wherein, the storage medium can be a disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), a flash memory, a hard disk (HDD) or a solid-state drive (SSD), etc.; the storage medium can also include a combination of the above types of memories.
[0195] As another aspect of the present invention, the present invention provides a path planning system for a vehicle with a four-wheel independent steering configuration, which may specifically include the path planning device, perception and positioning system, mapping module, decision system and motion control module for the vehicle with a four-wheel independent steering configuration as described above, wherein the perception and positioning system can perceive the vehicle and environmental information, and obtain the vehicle posture and obstacle information, the mapping module is responsible for constructing the map information required for the parking problem, and the decision system determines the desired parking space, etc. The path planning device of the vehicle with a four-wheel independent steering configuration calculates the optimal motion mode sequence and parking path that conforms to the 4WIS configuration based on this information. In addition to the path planning device of the vehicle with a four-wheel independent steering configuration, there is generally a speed planning module, which will calculate the smooth and comfortable expected speed based on the optimal mode sequence and the parking task requirements. Finally, the obtained path and speed information will be synthesized together as the expected trajectory information, and transmitted to the motion control module to generate the expected front and rear wheel angles, throttle opening, brake pedal opening and other information to drive the vehicle to track the reference trajectory.
[0196] In summary, the path planning method, device and system for four-wheel independent steering configuration vehicles provided by the present invention are aimed at the mixed integer modeling method of multiple motion modes, and the switching affine logic is used to realize the unified description of various types of motion modes, which is the key to give full play to the high flexibility and high passability of 4WIS vehicles; the mixed integer nonlinear programming method and system for the coordinated planning of motion mode sequences and continuous paths realize the self-optimization of steering motion modes in the path planning process, and improve the efficiency of path planning; the simplified strategy for typical motion modes effectively reduces the dimension of the mixed integer logic system and the computational complexity of the path planning optimization problem, and meets the real-time requirements of online solution.
[0197] It is to be understood that the above embodiments are merely exemplary embodiments used to illustrate the principles of the present invention, but the present invention is not limited thereto. For those of ordinary skill in the art, various modifications and improvements can be made without departing from the spirit and essence of the present invention, and these modifications and improvements are also considered to be within the scope of protection of the present invention.
Claims
1. A path planning method for a vehicle with four-wheel independent steering configuration, characterized in that: include: Obtain the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment; Constructing multiple steering kinematic models of the four-wheel independent steering configuration vehicle according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode; Integrate multiple steering kinematic models of four-wheel independent steering vehicles to obtain a comprehensive motion pattern model; Building a parking constraint model based on map information and target parking information; Solving the comprehensive motion pattern model according to the parking constraint model to obtain optimal parking path planning information; Multiple steering kinematic models of four-wheel independent steering vehicles are integrated to obtain a comprehensive motion mode model, including: The switching affine logic of multiple steering kinematic models is determined, and the expression of the switching affine logic is: , in, , Represents the vehicle state quantity, represents the vehicle control quantity, express The intermediate state quantity at the moment; The comprehensive motion pattern model is obtained according to the switching affine logic, and the expression of the comprehensive motion pattern model is: , Among them, M represents The upper bound of m represents The lower bound of .
2. The path planning method for a four-wheel independent steering vehicle according to claim 1, characterized in that: According to the current posture information and the obstacle information in the environment, multiple steering kinematic models of the four-wheel independent steering configuration vehicle are constructed, including: The Ackerman steering motion model is constructed based on the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle. The oblique motion mode model is constructed according to the yaw angle of the vehicle with four-wheel independent steering configuration; A near-zero steering motion mode model is constructed based on the steering information of a vehicle with four-wheel independent steering configuration.
3. The path planning method for a four-wheel independent steering vehicle according to claim 2, characterized in that: The Ackerman steering motion mode model is constructed based on the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle, including: Determine the vehicle state and vehicle control quantity according to the rear axle center position, wheel speed information and steering angle information of the four-wheel independent steering configuration vehicle; The Ackerman steering motion mode model is determined according to the vehicle state quantity and the vehicle control quantity, wherein the expression of the Ackerman steering motion mode model is: , in, Represents the vehicle state quantity, represents the vehicle control quantity, Indicates the direction of vehicle movement. ,and Indicates that the vehicle is moving forward. Indicates that the vehicle is moving backward. It represents the constant value of the product of the wheel linear speed and the time interval. represents the distance from the center of mass to the rear axle of the vehicle, Represents the path sequence point number in the discrete path sequence, where , Indicates the number of path points for each path planning.
4. The path planning method for a four-wheel independent steering vehicle according to claim 2, characterized in that: The oblique motion mode model is constructed according to the yaw angle of the four-wheel independent steering configuration vehicle, including: Ensure that the four wheels of a vehicle with four-wheel independent steering configuration maintain the same direction; When the yaw angle of the four-wheel independent steering vehicle remains unchanged, an oblique motion mode model is obtained, wherein the expression of the oblique motion mode model is: , in, Represents the vehicle state quantity, represents the vehicle control quantity, Indicates the direction of vehicle movement. ,and Indicates that the vehicle is moving forward. Indicates that the vehicle is moving backward. It represents the constant value of the product of the wheel linear speed and the time interval. Represents the path sequence point number in the discrete path sequence, where , Indicates the number of path points for each path planning.
5. The path planning method for a four-wheel independent steering vehicle according to claim 2, characterized in that: A near-zero steering motion mode model is constructed based on the steering information of a four-wheel independent steering configuration vehicle, including: Determine the turning radius of a vehicle with four-wheel independent steering configuration to be zero; When the four-wheel independent steering vehicle rotates with the center of mass as the instantaneous center of motion, a near-zero steering motion mode model is obtained, and the expression of the near-zero steering motion mode model is: , in, Represents the vehicle state quantity, represents the vehicle control quantity, Indicates the direction of vehicle rotation. ,and Indicates that the vehicle rotates clockwise. Indicates that the vehicle rotates counterclockwise. It represents the constant value of the product of the wheel linear speed and the time interval. represents the distance from the center of mass to the rear axle of the vehicle, Indicates wheelbase, Represents the path sequence point number in the discrete path sequence, where , Indicates the number of path points for each path planning.
6. The path planning method for a four-wheel independent steering vehicle according to any one of claims 1 to 5, characterized in that: A parking constraint model is constructed based on the map information and the target parking information, including: Boundary constraints, motion capability constraints, collision avoidance constraints and vehicle kinematic constraints are determined based on map information and target parking information, wherein the boundary constraints can determine the starting state and terminal state of the vehicle, the motion capability constraints can determine the motion capability of the vehicle, the collision avoidance constraints can determine the conditions under which the vehicle does not collide with obstacles, and the vehicle kinematic constraints can coordinate with the integrated motion mode model.
7. The path planning method for a four-wheel independent steering vehicle according to claim 6, characterized in that: The expression of the boundary value constraint is: , , ; The expression of the motion capability constraint is: ; The expression of the collision avoidance constraint is: ; The expression of the vehicle kinematic constraint is: ; in, Represents the state and control quantity of the vehicle at the initial moment.
8. A path planning device for a four-wheel independent steering vehicle, used to implement the path planning method for a four-wheel independent steering vehicle according to any one of claims 1 to 7, characterized in that: include: An acquisition module is used to acquire the current position information of the four-wheel independent steering configuration vehicle and the obstacle information of the environment; A first construction module is used to construct multiple steering kinematic models of the four-wheel independent steering configuration vehicle according to the current posture information and the obstacle information of the environment, wherein the multiple steering kinematic models at least include an Ackerman steering motion mode, an oblique motion mode and a near-zero steering motion mode; An integration module is used to integrate multiple steering kinematic models of a four-wheel independent steering configuration vehicle to obtain a comprehensive motion mode model; A second building module is used to build a parking constraint model according to the map information and the target parking information; The solution module is used to solve the comprehensive motion mode model according to the parking constraint model to obtain the optimal parking path planning information.
9. A storage medium, characterized in that: Used to store computer instructions, when the computer instructions are loaded and executed by a processor, to implement the path planning method for a four-wheel independent steering configuration vehicle as described in any one of claims 1 to 7.
