A positioning method and related equipment for automatic parking
By detecting parameters such as vehicle wheel speed pulses and steering wheel angle, and using different judgment conditions to calculate the vehicle's movement distance and heading angle change, the positioning error problem in scenarios such as rear wheel slippage in existing technologies has been solved, and the accurate positioning of the automatic parking system has been achieved.
Patent Information
- Application Number
- CN202311308505.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-10-10
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2043-10-10
AI Technical Summary
Existing automatic parking positioning solutions cannot accurately calculate changes in the vehicle's heading angle when the rear wheels slip, the steering wheel is turned while stationary, or the steering wheel is switched continuously, resulting in positioning errors.
By reading the vehicle's wheel speed pulses, steering wheel angle, gear ratio, and yaw rate, the changes in the front and rear wheel speed pulses are detected. Different judgment conditions are used to calculate the vehicle's travel distance and heading angle changes, including the first travel distance and heading angle change, the second travel distance and heading angle change, and the third heading angle change.
It achieves precise positioning under different vehicle conditions, ensuring that the automatic parking system can accurately calculate the vehicle's movement distance and heading angle change when the rear wheels slip, the steering wheel is turned while stationary, or the steering wheel is switched continuously, thus improving the accuracy of automatic parking.
Smart Images

Figure CN117325848B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of autonomous driving technology, and in particular to a positioning method and related equipment for automatic parking. Background Technology
[0002] The existing mass-produced automatic parking positioning solutions include the following two types:
[0003] Option 1: Calculate the rear axle center movement distance using the two rear wheel speed pulses, calculate the vehicle heading angle change based on the difference in movement distance between the left and right rear wheels and the rear wheel track, and then calculate the vehicle positioning based on the kinematic equations;
[0004] Option 2: Calculate the rear axle center movement distance using the two rear wheel speed pulses, calculate the vehicle heading angle change using the yaw rate output from the vehicle chassis, and then calculate the vehicle positioning based on the kinematic equations.
[0005] However, neither of the above two solutions can handle vehicle slippage scenarios. When the rear wheels slip, the rear wheel speed pulses are constantly changing, while the vehicle actually remains in roughly the same position. Therefore, the vehicle positioning calculated based on the rear wheel speed pulses is incorrect. Furthermore, when turning the steering wheel while stationary in automatic parking, the rear wheels remain stationary, and Solution 1 calculates a change in the vehicle's heading angle as 0, even though the vehicle's actual heading has changed. Additionally, when the rear wheels slip, the change in the vehicle's heading angle calculated based on the rear wheel speed pulses and the rear wheel track is also incorrect. Moreover, when the automatic parking system plans an S-shaped route and continuously switches steering, the yaw rate output by the vehicle chassis lags behind the actual heading change, causing Solution 2 to calculate a vehicle heading that is later than the actual heading.
[0006] Therefore, existing technologies still need to be improved and enhanced. Summary of the Invention
[0007] The main objective of this invention is to provide a positioning method and related equipment for automatic parking, which aims to solve the problem in the prior art that the change in the vehicle's heading angle cannot be accurately calculated when the rear wheels slip, the steering wheel is turned while stationary, or the steering wheel is switched continuously.
[0008] To achieve the above objectives, the present invention adopts the following technical solution:
[0009] A positioning method for automatic parking, comprising:
[0010] Read the vehicle's wheel speed pulse, steering wheel angle, gear ratio, rear track width, and yaw rate respectively;
[0011] The system detects whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction.
[0012] If a change in the front wheel speed pulse within a preset range is detected, and a continuous unidirectional change in the rear wheel speed pulse is detected, then the first moving distance of the vehicle is calculated based on the front wheel speed pulse, the transmission ratio, and the steering wheel angle, and the first heading angle change of the vehicle is calculated based on the sampling interval and the yaw rate.
[0013] Otherwise, the second moving distance of the vehicle is calculated based on the rear wheel speed pulse, and it is detected whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window;
[0014] If a continuous unidirectional change in the rear wheel speed pulse is detected, the change in the second heading angle of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track.
[0015] If the rear wheel speed pulse is not detected to have a continuous unidirectional change, the change in the vehicle's third heading angle is calculated based on the yaw rate.
[0016] In the automatic parking positioning method, the step of reading the vehicle's wheel speed pulses, steering wheel angle, transmission ratio, rear track width, and yaw rate includes:
[0017] The wheel speed pulses are read using a controller area network; wherein the wheel speed pulses include: the left front wheel speed pulse, the right front wheel speed pulse, the left rear wheel speed pulse, and the right rear wheel speed pulse;
[0018] The steering wheel angle and the yaw rate are read using the controller local area network.
[0019] The transmission ratio and the rear wheel track are read directly respectively.
[0020] In the automatic parking positioning method, the detection of whether the front wheel speed pulse changes within a preset range and whether the rear wheel speed pulse changes continuously in one direction within a detection time window includes:
[0021] Detect whether the left front wheel speed pulse and the right front wheel speed pulse change within a preset range within the detection time window;
[0022] Detect whether the left rear wheel speed pulse and the right rear wheel speed pulse undergo a continuous unidirectional change within the detection time window;
[0023] The front wheel speed pulses include the left front wheel speed pulse and the right front wheel speed pulse; the rear wheel speed pulses include the left rear wheel speed pulse and the right rear wheel speed pulse.
[0024] In the automatic parking positioning method, if a change in the front wheel speed pulse within a preset range is detected, and a continuous unidirectional change in the rear wheel speed pulse is detected, then the first moving distance of the vehicle is calculated based on the front wheel speed pulse, the transmission ratio, and the steering wheel angle, and the first heading angle change of the vehicle is calculated based on the sampling interval and the yaw rate, including:
[0025] If a change in the front wheel speed pulse within a preset range is detected within the detection time window, and a continuous unidirectional change in the rear wheel speed pulse is detected, then the first moving distance is calculated based on the left front wheel speed pulse, the right front wheel speed pulse, the transmission ratio, and the steering wheel angle.
[0026] The formula for calculating the first moving distance is as follows: In the formula, WP fl For the left front wheel speed pulse, WP fr δ represents the right front wheel speed pulse, δ represents the steering wheel angle, and GR represents the gear ratio.
[0027] The change in the first heading angle is calculated based on the sampling interval and the yaw rate.
[0028] The formula for calculating the change in the heading angle of the first vehicle is as follows: Δθ=ω×Δt, where ω is the yaw rate and Δt is the sampling interval, which is the time interval between two adjacent detection time windows.
[0029] In the automatic parking positioning method, the step of "otherwise" involves calculating the second moving distance of the vehicle based on the rear wheel speed pulse and detecting whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window, including:
[0030] If it is detected that the front wheel speed pulse does not change within a preset range within the detection time window, or the rear wheel speed pulse does not change continuously in one direction, the second moving distance is calculated based on the left rear wheel speed pulse and the right rear wheel speed pulse;
[0031] The formula for calculating the second moving distance is as follows: In the formula, WP bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse;
[0032] The detection checks whether the left rear wheel speed pulse and the right rear wheel speed pulse undergo a continuous unidirectional change within the detection time window.
[0033] In the automatic parking positioning method, if a continuous unidirectional change in the rear wheel speed pulse is detected, the calculation of the second heading angle change of the vehicle based on the rear wheel speed pulse and the rear wheel track includes:
[0034] If a continuous unidirectional change in the rear wheel speed pulse is detected within the detection time window, the change in the second heading angle is calculated based on the left rear wheel speed pulse, the right rear wheel speed pulse, and the rear wheel track.
[0035] The formula for calculating the second heading angle change is as follows: In the formula, WS is the rear track width, and WP is the rear track width. bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse.
[0036] In the automatic parking positioning method, if the rear wheel speed pulse is not detected to have a continuous unidirectional change, the calculation of the vehicle's third heading angle change based on the yaw rate includes:
[0037] If it is detected that the rear wheel speed pulse does not change continuously in one direction within the detection time window, the change in the third heading angle is calculated based on the yaw rate;
[0038] The formula for calculating the change in the third heading angle is as follows: Δθ=ω×Δt, where ω is the yaw rate and Δt is the sampling interval, which is the time interval between two adjacent detection time windows.
[0039] An automatic parking positioning system, comprising:
[0040] The data reading module is used to read the vehicle's wheel speed pulse, steering wheel angle, gear ratio, rear track width, and yaw rate, respectively.
[0041] The wheel pulse change detection module is used to detect whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction.
[0042] The first moving distance and first heading angle change calculation module is used to calculate the first moving distance of the vehicle based on the front wheel speed pulse, the transmission ratio and the steering wheel angle if the front wheel speed pulse changes within a preset range and the rear wheel speed pulse changes continuously in one direction, and to calculate the first heading angle change of the vehicle based on the sampling interval and the yaw rate.
[0043] The second movement distance calculation module is used to calculate the second movement distance of the vehicle based on the rear wheel speed pulse, and to detect whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window.
[0044] The second heading angle change calculation module is used to calculate the second heading angle change of the vehicle based on the rear wheel speed pulse and the rear wheel track if a continuous unidirectional change in the rear wheel speed pulse is detected.
[0045] The third heading angle change calculation module is used to calculate the third heading angle change of the vehicle based on the yaw rate if the rear wheel speed pulse is not detected to have a continuous unidirectional change.
[0046] An automated mobile device includes: a memory, a processor, a display, and an automated parking positioning program stored in the memory and executable on the processor, wherein the automated parking positioning program, when executed by the processor, implements the steps of the automated parking positioning method as described above.
[0047] A computer-readable storage medium storing an automatic parking positioning program, which, when executed by a processor, implements the steps of the automatic parking positioning method as described above.
[0048] Compared to existing technologies, this invention provides an automatic parking positioning method and related equipment. The method includes: reading the vehicle's wheel speed pulses, steering wheel angle, transmission ratio, rear wheel track, and yaw rate; detecting whether the front wheel speed pulses change within a preset range and whether the rear wheel speed pulses change continuously in one direction within a detection time window; if both change simultaneously, calculating the vehicle's first movement distance based on the front wheel speed pulses, transmission ratio, and steering wheel angle, and calculating the vehicle's first heading angle change based on the sampling interval and yaw rate; otherwise, calculating the vehicle's second movement distance based on the rear wheel speed pulses, and detecting whether the rear wheel speed pulses change continuously in one direction; if a change occurs, calculating the vehicle's second heading angle change based on the rear wheel speed pulses and rear wheel track; otherwise, calculating the vehicle's third heading angle change based on the yaw rate. By calculating the vehicle's heading angle change under different conditions based on different judgment results, precise positioning is achieved. Attached Figure Description
[0049] Figure 1 A flowchart illustrating a preferred embodiment of the automatic parking positioning method provided by the present invention;
[0050] Figure 2 A flowchart of step S100 in a preferred embodiment of the automatic parking positioning method provided by the present invention;
[0051] Figure 3 A flowchart of step S200 in a preferred embodiment of the automatic parking positioning method provided by the present invention;
[0052] Figure 4 A flowchart of step S300 in a preferred embodiment of the automatic parking positioning method provided by the present invention;
[0053] Figure 5 A flowchart of step S400 in a preferred embodiment of the automatic parking positioning method provided by the present invention;
[0054] Figure 6 The architecture diagram of the positioning system for automatic parking provided by this invention;
[0055] Figure 7 This is a schematic diagram of the operating environment of a preferred embodiment of the automatic mobile device provided by the present invention. Detailed Implementation
[0056] To make the objectives, technical solutions, and effects of this invention clearer and more explicit, the invention will be further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
[0057] Those skilled in the art will understand that, unless specifically stated otherwise, the singular forms “a,” “an,” “the,” and “the” used herein may also include the plural forms. It should be further understood that the term “comprising” as used in this specification means the presence of the stated features, integers, steps, operations, elements, and / or components, but does not exclude the presence or addition of one or more other features, integers, steps, operations, elements, components, and / or groups thereof. It should be understood that when we say an element is “connected” or “coupled” to another element, it can be directly connected or coupled to the other element, or there may be intermediate elements. Furthermore, “connected” or “coupled” as used herein can include wireless connections or wireless coupling. The term “and / or” as used herein includes all or any units and all combinations of one or more associated listed items.
[0058] It will be understood by those skilled in the art that, unless otherwise defined, all terms used herein (including technical and scientific terms) have the same meaning as commonly understood by one of ordinary skill in the art to which this invention pertains. It should also be understood that terms such as those defined in general dictionaries should be understood to have the same meaning as in the context of the prior art, and should not be interpreted in an idealized or overly formal sense unless specifically defined as herein.
[0059] This invention provides a positioning method and related equipment for automatic parking. The invention first determines whether the rear wheels are slipping by detecting, based on a first judgment condition: whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction. Then, based on a second judgment condition: whether the rear wheel speed pulse changes continuously in one direction within the detection time window, the invention calculates the vehicle's travel distance and heading angle change under different conditions based on the two judgment results. This allows for accurate calculation of the vehicle's travel distance and heading angle change when the rear wheels are slipping, the steering wheel is turned while stationary, or the steering wheel is continuously switched, providing accurate data for precise parking.
[0060] The design scheme of the positioning method for automatic parking is described below through specific exemplary embodiments. It should be noted that the following embodiments are only used to explain the technical solution of the invention and are not intended to limit it specifically:
[0061] Please see Figure 1 The present invention provides a positioning method for automatic parking, applicable to automated mobile devices, such as autonomous vehicles, the method comprising:
[0062] S100: Read the vehicle's wheel speed pulse, steering wheel angle, transmission ratio, rear track width, and yaw rate respectively.
[0063] The automated mobile device includes all mobile devices capable of autonomous movement, such as cars, boats, or drones. In this embodiment, parking a car is taken as an example.
[0064] Specifically, during vehicle operation, rear wheel slippage (including the left and right rear wheels) is a common occurrence. This application addresses this by first determining whether the rear wheels are slipping, and then...
[0065] After determining whether the rear wheel speed pulse has undergone a continuous unidirectional change, the vehicle's travel distance and the change in its heading angle are calculated using the corresponding formulas based on different judgment results.
[0066] Therefore, before calculating the vehicle's travel distance and the change in the vehicle's heading angle, the relevant parameters can first be read: the vehicle's wheel speed pulse, the steering wheel angle, the gear ratio, the rear wheel track, and the yaw rate, in order to proceed with further operations.
[0067] Furthermore, please refer to Figure 2 S100, which reads the vehicle's wheel speed pulse, steering wheel angle, transmission ratio, rear track width, and yaw rate respectively, includes:
[0068] S110. Read the wheel speed pulses using the controller local area network; wherein, the wheel speed pulses include: the left front wheel speed pulse, the right front wheel speed pulse, the left rear wheel speed pulse, and the right rear wheel speed pulse;
[0069] S120. Use the controller local area network to read the steering wheel angle and the yaw rate respectively;
[0070] S130, Read the transmission ratio and the rear wheel track directly respectively.
[0071] Specifically, when the vehicle is in motion, the left front wheel speed pulse, right front wheel speed pulse, left rear wheel speed pulse, and right rear wheel speed pulse displayed on the vehicle's CAN (Controller Area Network) bus, as well as the steering wheel angle and the yaw rate, are read.
[0072] Furthermore, the transmission ratio and rear track width of the vehicle are directly read from the vehicle's accompanying vehicle performance data manual.
[0073] For further information, please refer to [link / reference]. Figure 1 S200, detect whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction.
[0074] Specifically, within a detection time window, it is detected whether the front wheel speed pulse changes within a preset range, and whether the rear wheel speed pulse changes continuously in one direction within the same detection time window. By setting these two first detection conditions, it is determined whether the rear wheel is slipping based on the detection results.
[0075] Furthermore, please refer to Figure 3 S200, detecting whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction, includes:
[0076] S210. Detect whether the left front wheel speed pulse and the right front wheel speed pulse change within a preset range within the detection time window;
[0077] S220. Detect whether the left rear wheel speed pulse and the right rear wheel speed pulse undergo a continuous unidirectional change within the detection time window;
[0078] The front wheel speed pulses include the left front wheel speed pulse and the right front wheel speed pulse; the rear wheel speed pulses include the left rear wheel speed pulse and the right rear wheel speed pulse.
[0079] Specifically, after reading the relevant parameters, it detects whether the left front wheel speed pulse and the right front wheel speed pulse change within a preset range (a small range, generally ±3, depending on the actual vehicle calibration) within a continuous specified time period, i.e., within the detection time window, for example, 500ms. At the same time, it detects whether the left rear wheel speed pulse and the right rear wheel speed pulse change continuously in one direction within the detection time window, such as unidirectional increasing or decreasing changes, including increasing or decreasing after overflow, so as to determine whether the rear wheels are slipping based on the detection results.
[0080] For further information, please refer to [link / reference]. Figure 1 S300. If a change in the front wheel speed pulse within a preset range is detected, and a continuous unidirectional change in the rear wheel speed pulse is detected, the first moving distance of the vehicle is calculated based on the front wheel speed pulse, the transmission ratio, and the steering wheel angle, and the first heading angle change of the vehicle is calculated based on the sampling interval and the yaw rate.
[0081] Specifically, when detecting whether the front wheel speed pulse changes within a preset range and whether the rear wheel speed pulse changes continuously in one direction: if condition 1 is met, i.e., the front wheel speed pulse changes within a preset range and the rear wheel speed pulse changes continuously in one direction, it can be determined that the rear wheel is slipping. At this time, the change in the vehicle's first heading angle is calculated based on the sampling interval and the yaw rate. The sampling interval is the time interval between two adjacent detection time windows.
[0082] Furthermore, please refer to Figure 4 In step S300, if a change in the front wheel speed pulse within a preset range is detected, and a continuous unidirectional change in the rear wheel speed pulse is detected, then the first moving distance of the vehicle is calculated based on the front wheel speed pulse, the transmission ratio, and the steering wheel angle, and the first heading angle change of the vehicle is calculated based on the sampling interval and the yaw rate, including:
[0083] S310. If it is detected that the front wheel speed pulse changes within a preset range within the detection time window, and the rear wheel speed pulse changes continuously in one direction, then the first moving distance is calculated based on the left front wheel speed pulse, the right front wheel speed pulse, the transmission ratio, and the steering wheel angle.
[0084] The formula for calculating the first moving distance is as follows: In the formula, WP fl For the left front wheel speed pulse, WP frδ represents the right front wheel speed pulse, δ represents the steering wheel angle, and GR represents the gear ratio.
[0085] S320. Calculate the change in the first heading angle based on the sampling interval and the yaw rate;
[0086] The formula for calculating the change in the heading angle of the first vehicle is as follows: Δθ=ω×Δt, where ω is the yaw rate and Δt is the sampling interval, which is the time interval between two adjacent detection time windows.
[0087] Specifically, when detecting whether the front wheel speed pulse changes within a preset range during the detection time window, and whether the rear wheel speed pulse changes continuously in one direction:
[0088] If the front wheel speed pulse changes within a preset range within the detection time window, and the rear wheel speed pulse changes continuously in one direction, only if condition 1 is met can it be determined that the rear wheel is slipping.
[0089] At this time, the first moving distance of the vehicle is calculated based on the left front wheel speed pulse, the right front wheel speed pulse, the transmission ratio, and the steering wheel angle.
[0090] The formula for calculating the first moving distance is as follows:
[0091]
[0092] In formula (1), WP fl For the left front wheel speed pulse, WP fr δ represents the right front wheel speed pulse, δ represents the steering wheel angle, and GR represents the gear ratio.
[0093] Simultaneously, the change in the first heading angle of the vehicle is calculated based on the sampling interval and the yaw rate.
[0094] The formula for calculating the change in the heading angle of the first vehicle is as follows:
[0095] Δθ=ω×Δt (2);
[0096] In formula (2), ω is the yaw rate and Δt is the sampling interval, which is the time interval between two adjacent detection time windows.
[0097] For further information, please refer to [link / reference]. Figure 1 S400, Otherwise, calculate the second moving distance of the vehicle based on the rear wheel speed pulse, and detect whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window.
[0098] Specifically, when detecting whether the front wheel speed pulse changes within a preset range, and whether the rear wheel speed pulse changes continuously in one direction:
[0099] If condition 2 is met: that is, the front wheel speed pulse does not change within a preset range, or the rear wheel speed pulse does not change continuously in one direction, it can be determined that the rear wheel has not slipped. At this time, the second movement distance of the vehicle is calculated based on the rear wheel speed pulse.
[0100] Then, it is further detected whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window.
[0101] Furthermore, please refer to Figure 5 S400, otherwise, calculate the second moving distance of the vehicle based on the rear wheel speed pulse, and detect whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window, including:
[0102] S410. If it is detected that the front wheel speed pulse does not change within a preset range within the detection time window, or the rear wheel speed pulse does not change continuously in one direction, calculate the second moving distance based on the left rear wheel speed pulse and the right rear wheel speed pulse.
[0103] The formula for calculating the second moving distance is as follows:
[0104] In the formula, WP bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse;
[0105] S420. Detect whether the left rear wheel speed pulse and the right rear wheel speed pulse undergo a continuous unidirectional change within the detection time window.
[0106] Specifically, when detecting whether the front wheel speed pulse changes within a preset range, and whether the rear wheel speed pulse changes continuously in one direction:
[0107] If condition 2 is met: that is, the front wheel speed pulse does not change within a preset range and the rear wheel speed pulse does not change continuously in one direction; or if condition 3 is met: that is, the front wheel speed pulse does not change within a preset range and the rear wheel speed pulse changes continuously in one direction; or if condition 4 is met: that is, the front wheel speed pulse changes within a preset range and the rear wheel speed pulse does not change continuously in one direction; then it can be determined that the rear wheel is not slipping. In this case, the second moving distance is calculated based on the left rear wheel speed pulse and the right rear wheel speed pulse.
[0108] The formula for calculating the second moving distance is as follows:
[0109]
[0110] In formula (3), WP bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse.
[0111] Then, it is detected whether the left rear wheel speed pulse and the right rear wheel speed pulse both undergo continuous unidirectional changes (e.g., unidirectional increasing or decreasing changes, including increasing or decreasing after overflow) within the detection time window.
[0112] For further information, please refer to [link / reference]. Figure 1 S500. If a continuous unidirectional change in the rear wheel speed pulse is detected, the second heading angle change of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track.
[0113] Specifically, when detecting whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window:
[0114] If a continuous unidirectional change in the rear wheel speed pulse is detected, the second heading angle change of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track. That is, after filtering out conditions 1-4 using the first detection condition, the second detection condition is further used to detect and determine whether the rear wheel speed pulse is continuously changing in one direction, thereby further filtering, so that the results can be further classified and processed separately.
[0115] Furthermore, in step S500, if a continuous unidirectional change in the rear wheel speed pulse is detected, the second heading angle change of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track, including:
[0116] If a continuous unidirectional change in the rear wheel speed pulse is detected within the detection time window, the change in the second heading angle is calculated based on the left rear wheel speed pulse, the right rear wheel speed pulse, and the rear wheel track.
[0117] The formula for calculating the second heading angle change is as follows: In the formula, WS is the rear track width, and WP is the rear track width. bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse.
[0118] Specifically, when detecting whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window:
[0119] If condition 3 is detected: the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window, and the front wheel speed pulse does not change within a preset range, then the change in the second heading angle can be calculated based on the left rear wheel speed pulse, the right rear wheel speed pulse, and the rear wheel track.
[0120] The formula for calculating the second heading angle change is as follows:
[0121]
[0122] In formula (4), WS is the rear track width, and WP is the rear wheel track width. bl For the left rear wheel speed pulse, WP br This is the right rear wheel speed pulse.
[0123] For further information, please refer to [link / reference]. Figure 1 S600. If the rear wheel speed pulse is not continuously changing in one direction, the change in the third heading angle of the vehicle is calculated based on the yaw rate.
[0124] Specifically, when detecting whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window:
[0125] If the rear wheel speed pulse is not detected to have a continuous unidirectional change, the change in the vehicle's third heading angle is calculated based on the yaw rate. Similarly, after filtering out conditions 1-4 using the first detection condition, the second detection condition is used for further filtering, so that the results can be further classified and processed accordingly.
[0126] Furthermore, in step S600, if the rear wheel speed pulse is not detected to have undergone a continuous unidirectional change, the change in the vehicle's third heading angle is calculated based on the yaw rate, including:
[0127] If it is detected that the rear wheel speed pulse does not change continuously in one direction within the detection time window, the change in the third heading angle is calculated based on the yaw rate;
[0128] The formula for calculating the change in the third heading angle is as follows: Δθ=ω×Δt, where ω is the yaw rate and Δt is the sampling interval, which is the time interval between two adjacent detection time windows.
[0129] Specifically, when detecting whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window:
[0130] If condition 2 is detected: the rear wheel speed pulse does not change continuously in one direction within the detection time window, and the front wheel speed pulse does not change within a preset range; or if condition 4 is detected: the rear wheel speed pulse does not change continuously in one direction within the detection time window, and the front wheel speed pulse changes within a preset range, then in both cases, it can be determined that the vehicle is turning the steering wheel while stationary, and the change in the vehicle's third heading angle can be calculated based on the yaw rate.
[0131] The formula for calculating the change in the third heading angle is as follows:
[0132] Δθ=ω×Δt (5);
[0133] In equation (5), ω is the yaw rate and Δt is the sampling interval.
[0134] Further, please refer to Figure 6 The present invention provides an automatic parking positioning system, the automatic parking positioning system comprising:
[0135] Data reading module 1 is used to read the vehicle's wheel speed pulse, steering wheel angle, gear ratio, rear track width, and yaw rate respectively;
[0136] Wheel pulse change detection module 2 is used to detect whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction;
[0137] The first moving distance and first heading angle change calculation module 3 is used to calculate the first moving distance of the vehicle based on the front wheel speed pulse, the transmission ratio and the steering wheel angle if the front wheel speed pulse changes within a preset range and the rear wheel speed pulse changes continuously in one direction, and to calculate the first heading angle change of the vehicle based on the sampling interval and the yaw rate.
[0138] The second movement distance calculation module 4 is used to calculate the second movement distance of the vehicle based on the rear wheel speed pulse, and to detect whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window.
[0139] The second heading angle change calculation module 5 is used to calculate the second heading angle change of the vehicle based on the rear wheel speed pulse and the rear wheel track if a continuous unidirectional change in the rear wheel speed pulse is detected.
[0140] The third heading angle change calculation module 6 is used to calculate the third heading angle change of the vehicle based on the yaw rate if the rear wheel speed pulse is not continuously changing in one direction.
[0141] Specifically, the automatic parking positioning system implements the automatic parking positioning method, which is implemented as follows:
[0142] Before calculating the vehicle's travel distance and the change in its heading angle, the relevant parameters are first read: the vehicle's wheel speed pulse, the steering wheel angle, the gear ratio, the rear track width, and the yaw rate.
[0143] Then, within a detection time window, it is detected whether the front wheel speed pulse changes within a preset range, and whether the rear wheel speed pulse changes continuously in one direction within the detection time window:
[0144] If condition 1 is detected, namely, the front wheel speed pulse changes within a preset range and the rear wheel speed pulse changes continuously in one direction, it can be determined that the rear wheel is slipping. At this time, the change in the first heading angle of the vehicle is calculated based on the sampling interval and the yaw rate.
[0145] If condition 2 is met: that is, the front wheel speed pulse does not change within a preset range, or the rear wheel speed pulse does not change continuously in one direction, it can be determined that the rear wheel has not slipped. At this time, the second movement distance of the vehicle is calculated based on the rear wheel speed pulse.
[0146] Finally, it is further detected whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window:
[0147] If a continuous unidirectional change in the rear wheel speed pulse is detected, the second heading angle change of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track. If no continuous unidirectional change in the rear wheel speed pulse is detected, the third heading angle change of the vehicle is calculated based on the yaw rate.
[0148] Further, please refer to Figure 7 Based on the above-mentioned automatic parking positioning method, the present invention also provides an automatic mobile device, including a processor 10, a memory 20 and a display 30. Figure 7 Only some components of the automated mobile device are shown; however, it should be understood that it is not required to implement all of the components shown, and more or fewer components may be implemented instead.
[0149] In some embodiments, the memory 20 may be an internal storage unit of the automated mobile device, such as a hard drive or memory. In other embodiments, the memory 20 may be an external storage device of the automated mobile device, such as a plug-in hard drive, smart media card (SMC), secure digital (SD) card, flash card, etc., equipped on the automated mobile device. Further, the memory 20 may include both internal and external storage units of the automated mobile device. The memory 20 is used to store application software and various types of data installed on the automated mobile device, such as the program code installed on the automated mobile device. The memory 20 may also be used to temporarily store data that has been output or will be output. In one embodiment, the memory 20 stores an automatic parking positioning program 40, which can be executed by the processor 10 to implement the automatic parking positioning method of this application.
[0150] In some embodiments, the processor 10 may be a central processing unit (CPU), a microprocessor, or other data processing chip, used to run program code stored in the memory 20 or process data, such as executing the automatic parking positioning method.
[0151] In some embodiments, the display 30 may be an LED display, a liquid crystal display, a touch-sensitive liquid crystal display, or an OLED (Organic Light-Emitting Diode) touchscreen. The display 30 is used to display information on the automated mobile device and to display a visual user interface. The components 10-30 of the automated mobile device communicate with each other via a system bus.
[0152] In one embodiment, the steps implemented when the processor 10 executes the automatic parking positioning program 40 in the memory 20 can be referred to the corresponding description in the above-described automatic parking positioning method, and will not be repeated here.
[0153] Specifically, in this embodiment, the specific functions of each module of the automatic parking positioning system based on the polyhedral model can be referred to the corresponding description in the automatic parking positioning method described above, and will not be repeated here.
[0154] Furthermore, the present invention also provides a computer-readable storage medium, wherein the computer-readable storage medium stores an automatic parking positioning program 40, which, when executed by a processor, implements the steps of the automatic parking positioning method as described above; since the steps of the automatic parking positioning method have been described in detail above, they will not be repeated here.
[0155] In summary, this invention provides an automatic parking positioning method and related equipment. The method includes: reading the vehicle's wheel speed pulses, steering wheel angle, transmission ratio, rear wheel track, and yaw rate; detecting whether the front wheel speed pulses change within a preset range and whether the rear wheel speed pulses change continuously in one direction within a detection time window; if both change simultaneously, calculating the vehicle's first movement distance based on the front wheel speed pulses, transmission ratio, and steering wheel angle, and calculating the vehicle's first heading angle change based on the sampling interval and yaw rate; otherwise, calculating the vehicle's second movement distance based on the rear wheel speed pulses, and detecting whether the rear wheel speed pulses change continuously in one direction; if a change occurs, calculating the vehicle's second heading angle change based on the rear wheel speed pulses and rear wheel track; otherwise, calculating the vehicle's third heading angle change based on the yaw rate. By calculating the vehicle's heading angle change under different conditions based on different judgment results, accurate positioning is achieved.
[0156] It is understood that those skilled in the art can make equivalent substitutions or modifications to the technical solution and inventive concept of the present invention, and all such substitutions or modifications should fall within the protection scope of the appended claims.
Claims
1. A positioning method for automatic parking, characterized in that, The positioning method for automatic parking includes: Read the vehicle's wheel speed pulse, steering wheel angle, gear ratio, rear track width, and yaw rate respectively; The system detects whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction. If a change in the front wheel speed pulse within a preset range is detected, and a continuous unidirectional change in the rear wheel speed pulse is detected, then the first moving distance of the vehicle is calculated based on the front wheel speed pulse, the transmission ratio, and the steering wheel angle, and the first heading angle change of the vehicle is calculated based on the sampling interval and the yaw rate. Otherwise, the second moving distance of the vehicle is calculated based on the rear wheel speed pulse, and it is detected whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window; If a continuous unidirectional change in the rear wheel speed pulse is detected, the change in the second heading angle of the vehicle is calculated based on the rear wheel speed pulse and the rear wheel track. If the rear wheel speed pulse is not detected to have a continuous unidirectional change, the change in the vehicle's third heading angle is calculated based on the yaw rate.
2. The method of claim 1, wherein, The process of reading the vehicle's wheel speed pulses, steering wheel angle, gear ratio, rear track width, and yaw rate includes: The wheel speed pulses are read using the controller local area network; wherein the wheel speed pulses include: left front wheel speed pulse, right front wheel speed pulse, left rear wheel speed pulse and right rear wheel speed pulse; The steering wheel angle and the yaw rate are read using the controller local area network. The transmission ratio and the rear wheel track are read directly respectively.
3. The method of claim 2, wherein, The detection of whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction, includes: Detect whether the left front wheel speed pulse and the right front wheel speed pulse change within a preset range within the detection time window; Detect whether the left rear wheel speed pulse and the right rear wheel speed pulse undergo a continuous unidirectional change within the detection time window; The front wheel speed pulses include the left front wheel speed pulse and the right front wheel speed pulse; the rear wheel speed pulses include the left rear wheel speed pulse and the right rear wheel speed pulse.
4. The method of claim 2, wherein, If the rear wheel speed pulse is not detected to have undergone a continuous unidirectional change, the change in the vehicle's third heading angle is calculated based on the yaw rate, including: If it is detected that the rear wheel speed pulse does not change continuously in one direction within the detection time window, the change in the third heading angle is calculated based on the yaw rate; The calculation formula of the third heading angle change amount is as follows: θ = ω × t t, wherein ω is a yaw rate, t is a sampling interval, which is an interval time between two adjacent detection time windows.
5. A positioning system for automatic parking, characterized in that The positioning system for the automatic parking includes: The data reading module is used to read the vehicle's wheel speed pulse, steering wheel angle, gear ratio, rear track width, and yaw rate, respectively. The wheel pulse change detection module is used to detect whether the front wheel speed pulse changes within a preset range within a detection time window, and whether the rear wheel speed pulse changes continuously in one direction. The first moving distance and first heading angle change calculation module is used to calculate the first moving distance of the vehicle based on the front wheel speed pulse, the transmission ratio and the steering wheel angle if the front wheel speed pulse changes within a preset range and the rear wheel speed pulse changes continuously in one direction, and to calculate the first heading angle change of the vehicle based on the sampling interval and the yaw rate. The second movement distance calculation module is used to calculate the second movement distance of the vehicle based on the rear wheel speed pulse, and to detect whether the rear wheel speed pulse undergoes a continuous unidirectional change within the detection time window. The second heading angle change calculation module is used to calculate the second heading angle change of the vehicle based on the rear wheel speed pulse and the rear wheel track if a continuous unidirectional change in the rear wheel speed pulse is detected. The third heading angle change calculation module is used to calculate the third heading angle change of the vehicle based on the yaw rate if the rear wheel speed pulse is not detected to have a continuous unidirectional change.
6. An automated mobile device, comprising: The automated mobile device includes: a memory, a processor, a display, and an automated parking positioning program stored in the memory and executable on the processor, wherein the automated parking positioning program, when executed by the processor, implements the steps of the automated parking positioning method as described in any one of claims 1-4.
7. A computer readable storage medium characterized in that, The computer-readable storage medium stores an automatic parking positioning program, which, when executed by a processor, implements the steps of the automatic parking positioning method as described in any one of claims 1-4.
Citation Information
Patent Citations
Automatic parking positioning method based on wheel speed pulse interpolation smoothing
CN114435349A
Optimization algorithm for automatic parking track plotting
CN115056799A
