Automatic parking path following processing method, system, vehicle and storage medium

Abstract

The invention discloses an automatic parking path following processing method, system, vehicle and storage medium, comprising: step 1, planning out the arc-line path required for parking based on the parking space information, and obtaining the control point P of the path planning i , i=0,1,2,...n; step 2, based on the cubic spline interpolation function to solve parametrically, using the method of chord length accumulation; for the control point P on the plane i The coordinates (x i ,y i ), find the accumulated chord length at each control point; Step 3, parameterize x, y into the equations of x(s), y(s), where s i ≤s≤s i+1 ,s i Indicates the cumulative chord length of segment i+1, s i+1 Indicates the cumulative chord length of the i+2 section; specifically: use s as a variable, x, y as a function to fit based on the principle of cubic spline interpolation function, and derive the equation of chord length cumulative cubic spline curve and its first order Derivative and second-order derivative equations; step 4, the boundary condition adopts the constraint equation of fixed boundary, and solves the first-order derivative of the parametric equation. The invention solves the problem of discontinuous curvature of the arc straight path.

Description

technical field

[0001] The invention belongs to the technical field of automatic parking, and in particular relates to an automatic parking path following processing method, system, vehicle and storage medium. Background technique

[0002] In recent years, with the exponential increase in car ownership, the problem of parking difficulties has become more prominent. This issue has attracted a lot of attention from the outside world, especially major OEMs. At the current stage, OEMs have realized the mass production of fully automatic parking technology based on the fusion of imaging and ultrasound, and the market response has been good. The market prospect of fully automatic parking is promising. Deep digging technology, the basic principle of parking path planning is mainly based on the principle of arcs and straight lines for path planning to ensure that vehicles enter the warehouse, or the path planning method of B-spline curves.

[0003] At present, the arc and straight...

Examples

Embodiment Construction

[0045] The present invention will be further described below in conjunction with accompanying drawing.

[0046] In this embodiment, an automatic parking path following processing method includes the following steps:

[0047] Step 1. Based on the parking space information, plan the arc-line path required for parking, and obtain the control point P for path planning. i , i=0,1,2,...n;

[0048] Step 2, based on the cubic spline interpolation function for parametric solution, using the method of chord length accumulation; for the control point P on the plane i The coordinates (x i ,y i ), calculate the cumulative chord length at each control point;

[0049] The cumulative chord length at each control point is expressed as:

[0050] the s 0 =0

[0051]

[0052]

[0053]

[0054]

[0055] In the formula: l i Indicates the chord length of the i segment, k=i-1.

[0056] Step 3, parameterize x and y as equations of x(s) and y(s) respectively, where s i ≤s≤s i+1 ,...

technical field

[0001] The invention belongs to the technical field of automatic parking, and in particular relates to an automatic parking path following processing method, system, vehicle and storage medium. Background technique

[0002] In recent years, with the exponential increase in car ownership, the problem of parking difficulties has become more prominent. This issue has attracted a lot of attention from the outside world, especially major OEMs. At the current stage, OEMs have realized the mass production of fully automatic parking technology based on the fusion of imaging and ultrasound, and the market response has been good. The market prospect of fully automatic parking is promising. Deep digging technology, the basic principle of parking path planning is mainly based on the principle of arcs and straight lines for path planning to ensure that vehicles enter the warehouse, or the path planning method of B-spline curves.

[0003] At present, the arc and straight...

Examples

Embodiment Construction

[0045] The present invention will be further described below in conjunction with accompanying drawing.

[0046] In this embodiment, an automatic parking path following processing method includes the following steps:

[0047] Step 1. Based on the parking space information, plan the arc-line path required for parking, and obtain the control point P for path planning. i , i=0,1,2,...n;

[0048] Step 2, based on the cubic spline interpolation function for parametric solution, using the method of chord length accumulation; for the control point P on the plane i The coordinates (x i ,y i ), calculate the cumulative chord length at each control point;

[0049] The cumulative chord length at each control point is expressed as:

[0050] the s 0 =0

[0051]

[0052]

[0053]

[0054]

[0055] In the formula: l i Indicates the chord length of the i segment, k=i-1.

[0056] Step 3, parameterize x and y as equations of x(s) and y(s) respectively, where s i ≤s≤s i+1 ,...

Images