Tracking reversing method and device, electronic equipment and storage medium
By acquiring vehicle forward driving data, the target reversing trajectory and steering wheel angle are determined, solving the problem of reversing in narrow or complex environments, improving the accuracy and safety of reversing, and simplifying the operation process.
Patent Information
- Application Number
- CN202411202147.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-22
AI Technical Summary
When reversing in narrow or complex environments, drivers often struggle to accurately judge the vehicle's position and direction, making reversing difficult and increasing the risk of collisions with obstacles. This poses a particular challenge for novice drivers.
By acquiring the vehicle's forward driving data, including position and motion state data, the target reversing trajectory and steering wheel angle are determined, and the vehicle is controlled to reverse along the target trajectory.
It improves the accuracy and safety of reversing, simplifies the operation process, reduces the risk of accidents, and is suitable for drivers with insufficient driving experience.
Smart Images

Figure CN118991773A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of vehicle driving technology, and in particular to a tracking reverse method, device, electronic equipment and storage medium. Background Art
[0002] Reversing on narrow roads or in complex environments (such as with many obstacles) is a challenging task for drivers.
[0003] In the related technologies, it is often difficult for drivers to accurately judge the position and direction of the vehicle by intuition, especially when there is a lack of sufficient vision, reversing becomes more difficult. In addition, due to the lack of sufficient spatial perception, the driver is prone to collision with surrounding obstacles when reversing, which increases the risk of vehicle damage or even personal injury.
[0004] Furthermore, traditional reversing operations rely more on the driver's personal experience and skills, and novice drivers may find it difficult to master the correct reversing skills, and reversing in narrow roads or complex environments is a difficult problem. Summary of the invention
[0005] The present invention provides a tracking backing method, device, electronic equipment and storage medium to solve the technical problem of backing up in narrow roads or complex environments.
[0006] According to one aspect of the present invention, a method for tracking and reversing is provided, which may include:
[0007] When the tracking reverse function of the vehicle has been activated, acquiring forward driving data of the vehicle, wherein the forward driving data includes vehicle position data and motion state data;
[0008] Determine a target reversing trajectory according to the vehicle position data, and determine a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing trajectory;
[0009] The vehicle is controlled to reverse according to the target reversing trajectory according to the target steering wheel angle.
[0010] According to another aspect of the present invention, there is provided a tracking reversing device, characterized in that it comprises:
[0011] A forward driving data acquisition module, used to acquire forward driving data of the vehicle when the tracking reverse function of the vehicle has been activated, wherein the forward driving data includes vehicle position data and motion state data;
[0012] a steering wheel angle determination module, configured to determine a target reversing trajectory according to the vehicle position data, and to determine a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing trajectory;
[0013] The reverse driving control module is used to control the vehicle to reverse according to the target reverse trajectory according to the target steering wheel angle.
[0014] According to another aspect of the present invention, an electronic device is provided, the electronic device comprising:
[0015] at least one processor; and
[0016] a memory communicatively connected to the at least one processor; wherein,
[0017] The memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the tracking reversing method described in any embodiment of the present invention.
[0018] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the tracking reversing method described in any embodiment of the present invention when executed.
[0019] The technical solution of the embodiment of the present invention is as follows: first, by acquiring the forward driving data of the vehicle when the tracking reverse function of the vehicle has been activated, since the forward driving data includes the vehicle position data and the motion state data, the position and motion state data of the vehicle when traveling forward can be recorded to provide the vehicle with reversing basis data; then, a target reversing trajectory is determined according to the vehicle position data, and a target steering wheel angle corresponding to the vehicle is determined according to the vehicle position data, the motion state data and the target reversing trajectory. The target reversing trajectory and the target steering wheel angle ensure that the vehicle can accurately reverse back to its original position along the path when traveling forward, thereby improving the accuracy of tracking reverse, and simplifying the driving operation process, making reversing easier; finally, the vehicle is controlled to reverse according to the target reversing trajectory according to the target steering wheel angle. The technical solution of the embodiment of the present invention obtains the vehicle's forward driving data, determines the target reversing trajectory, and calculates the target steering wheel angle, thereby controlling the vehicle to reverse along the target reversing trajectory. This solves the problem of difficulty in reversing operations in narrow or complex environments, reduces the risk of accidents caused by improper reversing, and improves the safety and accuracy of tracking reversing.
[0020] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0022] Figure 1 is a flow chart of a tracking and reversing method provided according to Embodiment 1 of the present invention;
[0023] Figure 2 is a flow chart of a tracking backing method provided according to Embodiment 2 of the present invention;
[0024] Figure 3 is a flow chart of a tracking backing method provided according to Embodiment 3 of the present invention;
[0025] Figure 4 is a schematic structural diagram of a tracking reversing device provided according to a fourth embodiment of the present invention;
[0026] Figure 5 It is a schematic diagram of the structure of an electronic device for implementing the tracking reverse method according to an embodiment of the present invention. DETAILED DESCRIPTION
[0027] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0028] 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 that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or 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 that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0029] It should be noted that the modifications of "one" and "plurality" mentioned in the present disclosure are illustrative rather than restrictive, and those skilled in the art should understand that unless otherwise clearly indicated in the context, it should be understood as "one or more".
[0030] The names of the messages or information exchanged between multiple devices in the embodiments of the present disclosure are only used for illustrative purposes and are not used to limit the scope of these messages or information.
[0031] It is understandable that before using the technical solutions disclosed in the embodiments of the present disclosure, the types, scope of use, usage scenarios, etc. of the personal information involved in the present disclosure should be informed to the user and the user's authorization should be obtained in an appropriate manner in accordance with relevant laws and regulations.
[0032] For example, in response to receiving an active request from a user, a prompt message is sent to the user to clearly prompt the user that the operation requested to be performed will require obtaining and using the user's personal information. Thus, the user can autonomously choose whether to provide personal information to software or hardware such as an electronic device, application, server, or storage medium that performs the operation of the technical solution of the present disclosure according to the prompt message.
[0033] As an optional but non-limiting implementation, in response to receiving an active request from the user, the prompt information may be sent to the user in the form of a pop-up window, in which the prompt information may be presented in text form. In addition, the pop-up window may also carry a selection control for the user to choose "agree" or "disagree" to provide personal information to the electronic device.
[0034] It is understandable that the above notification and the process of obtaining user authorization are merely illustrative and do not constitute a limitation on the implementation of the present disclosure. Other methods that meet the relevant laws and regulations may also be applied to the implementation of the present disclosure.
[0035] It is understandable that the data involved in this technical solution (including but not limited to the data itself, the acquisition or use of the data) shall comply with the requirements of relevant laws, regulations and relevant provisions.
[0036] Embodiment 1
[0037] Figure 1 A flowchart of a tracking and reversing method is provided for the first embodiment of the present invention. This embodiment is applicable to situations where tracking and reversing can be achieved in narrow or complex environments. The method can be performed by a tracking and reversing device, which can be implemented in the form of hardware and / or software, and optionally, by an electronic device, which can be a mobile terminal, a PC, or a server.
[0038] like Figure 1 As shown, the method may specifically include:
[0039] S110. When the tracking reverse function of the vehicle has been activated, obtain forward driving data of the vehicle, wherein the forward driving data includes vehicle position data and motion state data.
[0040] Among them, the tracking and reversing function can be understood as an advanced function in the automobile auxiliary system, which can record the vehicle's driving trajectory when entering some narrow or complex environments, and realize automatic reversing according to the driving trajectory. The forward driving data can be understood as a series of data collected when the vehicle is driving forward, which is used to calculate the path and control instructions required for the vehicle to track and reverse, wherein the forward driving data may include vehicle position data and motion state data, etc. The vehicle position data can be understood as the geographical location information of the vehicle during driving, and the vehicle position data includes but is not limited to latitude and longitude coordinates (the precise geographical coordinates of the vehicle), relative position (the vehicle's position information relative to a reference point (such as the starting point or end point)) and direction (the direction of the vehicle's travel, which can be expressed in angles), etc. The motion state data can be understood as various parameters describing the vehicle's motion state, which are used to reflect the dynamic characteristics of the vehicle during driving.
[0041] Based on the above scheme, optionally, before obtaining the forward driving data of the vehicle, it also includes: when the gear position of the vehicle is in the forward gear, the speed of the vehicle is lower than the preset speed threshold and the tracking reverse function of the vehicle is enabled, recording the forward driving data of the vehicle at the preset distance.
[0042] Among them, the preset speed threshold can be understood as a set speed value. When the speed of the vehicle is lower than the preset speed threshold, the forward driving data will be recorded. The preset speed threshold is usually to ensure that the recorded forward driving data is obtained at a low speed. The data recorded at a low speed is more conducive to the accurate execution of the tracking and reversing function. Exemplarily, the preset speed threshold can be set to 30km / h. The preset distance can be understood as a specific distance range. Within this distance range, the forward driving data of the vehicle will be recorded to ensure that the recorded data is the most recent valid driving data, thereby providing the latest reference path for tracking and reversing. Exemplarily, the preset distance can be set to 50m.
[0043] On the basis of the above scheme, optionally, when the gear position of the vehicle is in the forward gear, the speed of the vehicle is lower than the preset speed threshold and the tracking reverse function of the vehicle is in the enabled state, before recording the forward driving data of the vehicle at the preset distance, it also includes: turning on the fault detection function of the vehicle, and performing fault detection on the vehicle through the fault detection function; when no fault is detected in the vehicle, performing the operation of recording the forward driving data of the vehicle at the preset distance.
[0044] The fault detection function can be understood as a vehicle self-diagnosis mechanism, which is used to detect whether the working status of various components of the vehicle is normal. Exemplarily, turning on the fault detection function means starting the vehicle's self-diagnosis program to check whether the vehicle has any potential faults. More specifically, each key component of the vehicle is checked to ensure that the key components are within the normal working range. If any fault is found, the fault will be marked and the subsequent tracking reverse function may be prevented from running.
[0045] For example, the vehicle's current speed and gear position can be collected by vehicle sensors. When the vehicle's current speed is lower than a preset speed threshold, the gear position is in the forward gear, and the tracking reverse function of the vehicle is enabled, the vehicle is subjected to fault detection to determine whether the vehicle has a fault.
[0046] The technology of the embodiment of the present invention collects the current vehicle speed and gear position, and performs fault detection on the vehicle when the current vehicle speed is lower than a preset vehicle speed threshold, the gear position is in the forward gear and the tracking reverse function of the vehicle is enabled. This can ensure that the vehicle is in good condition before the tracking reverse function is enabled, avoid safety hazards caused by vehicle failures, and improve the safety and reliability of the tracking reverse process.
[0047] Based on the above scheme, optionally, the acquiring of the forward driving data of the vehicle includes: acquiring a body yaw angle of the vehicle, and determining a heading angle of the vehicle according to the body yaw angle and a sideslip angle of the center of mass.
[0048] Among them, the body yaw angle can be understood as the deflection angle of the longitudinal axis of the vehicle relative to the forward direction of the vehicle during the driving process. The body yaw angle reflects the deviation between the actual driving direction of the vehicle and the expected direction (mainly describing the rotation state of the vehicle on the horizontal plane), which can be generated by the steering system and suspension system of the vehicle. The center of mass sideslip angle can be understood as the angular difference between the actual driving direction of the vehicle and the longitudinal axis direction of the vehicle. Exemplarily, when the vehicle turns oversteer or understeer, the center of mass sideslip angle will be generated, and the center of mass sideslip angle reflects the degree of lateral slip of the vehicle during the turning process. The heading angle can be understood as the angular deviation of the actual direction of the vehicle's driving relative to the predetermined direction. The vehicle's heading angle, that is, the actual direction of the vehicle's driving, can be determined through the body yaw angle and the center of mass sideslip angle.
[0049] In practical applications, the vehicle's yaw angle and center of mass slip angle jointly determine the vehicle's heading angle. By measuring the vehicle's yaw angle and center of mass slip angle, data support can be provided for subsequent tracking and reversing, and the actual path of the vehicle during the reversing process can be accurately determined, thereby improving the safety and accuracy of the reversing process and ensuring that the vehicle is safe along the preset trajectory.
[0050] Based on the above scheme, optionally, before obtaining the forward driving data of the vehicle, it also includes: when receiving a gear switching instruction to switch the vehicle to a reverse gear, activating a tracking reverse function.
[0051] The gear switching instruction may be understood as an instruction for switching the vehicle from a forward gear to a reverse gear. For example, the vehicle may be switched from a forward gear to a reverse gear by operating a vehicle gear lever or a shift button.
[0052] On the basis of the above scheme, further, before activating the tracking reverse function, it also includes: when the vehicle is in a stopped state, displaying target prompt information.
[0053] Wherein, the target prompt information is used to prompt the driver to switch the forward gear of the vehicle to the reverse gear. The displayed target prompt information may include: information displayed to the driver through the vehicle, and / or voice information prompted to the driver through the vehicle. The displayed target prompt information may be in the form of text, icon or light prompt. Specifically, when the vehicle is in a stopped state, the target prompt information can be displayed through the vehicle display screen or instrument panel, and / or voice prompt information can be played to the driver through the vehicle audio system. Exemplarily, when the vehicle is in a stopped state, "Please switch to reverse gear" can be played through the vehicle audio system for prompting.
[0054] S120, determining a target reversing trajectory according to the vehicle position data, and determining a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing trajectory.
[0055] The target reversing trajectory can be understood as the reversing path determined according to the position data of the vehicle when it is traveling forward, so that the vehicle can reverse back to the target position along the path when it is traveling forward. The target position is the end position of the reversing. The target steering wheel angle can be understood as the angle that the vehicle steering wheel needs to be turned during the reversing process, so as to ensure that the vehicle can reverse back to the target position along the target reversing trajectory.
[0056] S130: Control the vehicle to reverse according to the target reversing trajectory according to the target steering wheel angle.
[0057] It is understandable that, when the target steering wheel angle is determined, the target steering wheel angle can be sent to the electric power steering controller to issue an instruction to control the vehicle to perform tracking reverse.
[0058] The technical solution of the embodiment of the present invention is, firstly, by obtaining the forward driving data of the vehicle when the tracking reverse function of the vehicle has been activated, since the forward driving data includes the vehicle position data and the motion state data, the position and motion state data of the vehicle when driving forward can be recorded, and the vehicle can be provided with the reversing basis data; then, the target reversing trajectory is determined according to the vehicle position data, and the target steering wheel angle corresponding to the vehicle is determined according to the vehicle position data, the motion state data and the target reversing trajectory. The target reversing trajectory and the target steering wheel angle ensure that the vehicle can accurately reverse back to the original position along the path when driving forward, improve the accuracy of tracking reverse, and simplify the driving operation process; finally, the vehicle is controlled to reverse according to the target reversing trajectory according to the target steering wheel angle. The technical solution of the embodiment of the present invention solves the problem of difficulty in reversing operation in narrow or complex environments by obtaining the forward driving data of the vehicle, determining the target reversing trajectory, and calculating the target steering wheel angle, and then controlling the vehicle to reverse along the target reversing trajectory, thereby reducing the risk of accidents caused by improper reversing and improving the safety and accuracy of tracking reversing.
[0059] Embodiment 2
[0060] Figure 2 A flowchart of a tracking reverse method provided for the second embodiment of the present invention. The technical solution of this embodiment is based on the above embodiment, and further refines how to determine the target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reverse trajectory. Optionally, the motion state data includes the heading angle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the target preview distance corresponding to the vehicle, and the preview position corresponding to the preview point located at the target reverse trajectory; the determination of the target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reverse trajectory may include: determining the target steering wheel angle corresponding to the vehicle according to the heading angle of the vehicle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the vehicle position information, the target preview distance and the preview position. For specific implementation methods, please refer to the description of this embodiment. Among them, the technical features that are the same or similar to the above embodiments are not repeated here.
[0061] like Figure 2 As shown, the method may specifically include:
[0062] S210. When the tracking reverse function of the vehicle has been activated, obtain the forward driving data of the vehicle, wherein the forward driving data includes vehicle position data and motion state data, and the motion state data includes the heading angle, the wheelbase between the front axle and the rear axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the target preview distance corresponding to the vehicle, and the preview position corresponding to the preview point located on the target reverse trajectory.
[0063] Among them, the wheelbase can be understood as the distance between the front wheel axle and the rear wheel axle, which is used to indicate the turning radius and driving trajectory of the vehicle. Specifically, the turning radius of a vehicle with a long wheelbase is larger, while the opposite is true for a short wheelbase. The transmission ratio can be understood as the proportional relationship between the actual steering angle of the wheel and the steering wheel turning angle when the steering wheel is turned a certain angle, which is used to control the actual steering of the front wheel. The steering wheel angle can be adjusted according to the transmission ratio to achieve the desired wheel steering angle. The target preview distance can be understood as the distance between the position expected to be reached by the vehicle and the current position, which can be used to plan the target reversing trajectory of the vehicle. It can be understood that the longer the target preview distance, the smaller the change in the target steering wheel angle will be, and the smoother the control effect will be. The shorter the target preview distance, the more precise the control effect will be, but the larger the change in the target steering wheel angle will be. The preview point can be understood as the position expected to be reached when the vehicle is reversing along the track, and the preview point is a point on the target reversing trajectory. The preview position can be understood as a point selected on the target reversing trajectory, which is used to predict the future position of the vehicle and to determine the control parameters of the vehicle during the tracking reversing process, ensuring that the vehicle can accurately reverse back to its original position along the target reversing trajectory.
[0064] Based on the above solution, optionally, the obtaining of the forward driving data of the vehicle includes: obtaining the longitudinal driving speed of the vehicle, and determining the target preview distance corresponding to the vehicle according to the longitudinal driving speed. The target preview distance and the longitudinal driving speed are positively correlated. The longitudinal driving speed refers to the speed of the vehicle along the driving direction, that is, the speed when reversing while following the track.
[0065] On the basis of the above scheme, further, determining the target preview distance corresponding to the vehicle according to the longitudinal driving speed may include: determining the target preview distance corresponding to the vehicle according to the longitudinal driving speed, a preset forward preview time and a preset deviation distance.
[0066] The forward preview time can be understood as a pre-set time interval. Specifically, it can be the expected time interval from the current moment to the vehicle reaching the preview point, which is used to predict the position that the vehicle should reach after the set time interval, so as to plan and adjust the target reversing trajectory in advance to ensure driving safety and the smoothness of the target reversing trajectory. The preset deviation distance can be understood as an additional safety distance added when the target preview distance is determined, which is used to ensure that even if the longitudinal driving speed of the vehicle changes, sufficient safety margin can still be maintained to prevent collisions.
[0067] As an optional implementation of the embodiment of the present invention, the target preview distance corresponding to the vehicle may be determined according to the longitudinal speed of the vehicle, the forward preview time and the preset deviation distance based on the following formula:
[0068] l d =v x *T pre +l0,
[0069] Among them, l d is the target preview distance corresponding to the vehicle, v x is the longitudinal speed of the vehicle, T pre is the preset forward preview time, and l0 is the preset deviation distance.
[0070] Exemplarily, within a preset forward preview time, the target preview distance will be determined according to the current longitudinal speed of the vehicle and the preset deviation distance. The selection of the preview time depends on factors such as the longitudinal speed of the vehicle and is used to predict the position of the vehicle.
[0071] Based on the above scheme, optionally, the acquiring of the forward driving data of the vehicle includes: determining a preview position corresponding to a preview point located on the target reversing trajectory according to the vehicle position information, the target preview distance and the target reversing trajectory.
[0072] The above technical solution can accurately predict the position of the vehicle during the tracking and reversing process by determining the preview position corresponding to the preview point, thereby improving the accuracy of the reversing operation.
[0073] S220, determining a target steering wheel angle corresponding to the vehicle according to the heading angle of the vehicle, the wheelbase between the front axle and the rear axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheels, the vehicle position information, the target preview distance and the preview position.
[0074] As an optional implementation of the embodiment of the present invention, the target steering wheel angle corresponding to the vehicle may be determined based on the following formula according to the heading angle of the vehicle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the vehicle position information, the target preview distance and the preview position:
[0075]
[0076] in, is the target steering wheel angle corresponding to the vehicle, is the heading angle of the vehicle, L is the wheelbase between the front and rear axles of the vehicle, l d is the forward preview distance corresponding to the vehicle, i is the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, (E x , E y ) is the vehicle position information, (P x , P y ) is the preview position of the preview point on the target reversing trajectory.
[0077] As an optional implementation manner of an embodiment of the present invention, the target steering wheel angle, heading angle, wheelbase, forward preview distance, transmission ratio, vehicle position information and preview position corresponding to the vehicle can be input into a controller (such as a vehicle tracking reversing controller, etc.) to confirm the target steering wheel angle corresponding to the vehicle.
[0078] S230: Control the vehicle to reverse according to the target reversing trajectory according to the target steering wheel angle.
[0079] The technical solution of the embodiment of the present invention improves the safety of the reversing process by turning on the tracking reversing function when the vehicle is in the forward gear and the speed is lower than a preset speed threshold, and performing fault detection on the vehicle and obtaining the vehicle's forward driving data, including vehicle position data and detailed motion status data, when there is no fault. Then, by recording the forward trajectory of the vehicle when it travels to a preset distance and prompting the driver to switch to the reverse gear when the vehicle is stopped, the driver's operating process is further simplified. Finally, by calculating the target reversing trajectory and the target steering wheel angle, and controlling the vehicle to reverse along the target trajectory according to the target steering wheel angle, not only the driver's operating process is simplified, but also it is suitable for novice drivers with insufficient driving experience, and significantly improves the safety and convenience of the reversing operation.
[0080] Embodiment 3
[0081] Figure 3 The tracking and reversing method provided in the third embodiment of the present invention is an optional embodiment of the above embodiment. Figure 3As shown, the method may specifically include:
[0082] First, when the vehicle is in the forward gear and the speed is lower than the preset speed threshold, the tracking reverse function is turned on.
[0083] Then, the vehicle performs fault detection, and when no fault is detected, the forward driving data of the vehicle is obtained, the forward driving data including vehicle position data and motion state data, the motion state data including heading angle, wheelbase between front wheel axle and rear wheel axle, transmission ratio between steering angle of steering wheel and steering angle of wheel, target preview distance corresponding to the vehicle, and preview position corresponding to preview point located on the target reversing trajectory.
[0084] Next, the vehicle travels to a preset distance and records the vehicle's forward trajectory. When the vehicle is stopped, the driver is prompted to switch from the forward gear to the reverse gear and activate the tracking reverse function.
[0085] Then, a target reversing trajectory for the vehicle to reverse along the track is determined.
[0086] Next, determine the target steering wheel angle in the following ways:
[0087] 1) Determine the target preview distance corresponding to the vehicle according to the longitudinal speed of the vehicle, the forward preview time and the preset deviation distance:
[0088] l d =v x *T pre +l0,
[0089] Among them, l d is the target preview distance corresponding to the vehicle, v x is the longitudinal speed of the vehicle, T pre is the preset forward preview time of the driver, and l0 is the preset deviation distance;
[0090] The target steering wheel angle corresponding to the vehicle is determined based on the following formula:
[0091]
[0092] in, is the target steering wheel angle corresponding to the vehicle, is the heading angle of the vehicle, L is the wheelbase between the front and rear axles of the vehicle, l d is the forward preview distance corresponding to the vehicle, i is the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, (E x , E y ) is the vehicle position information, (P x , Py ) is the preview position of the preview point on the target reversing trajectory.
[0093] The calculated target steering wheel angle is sent to the electric power steering controller to control the vehicle to reverse according to the target reversing trajectory.
[0094] The technical solution of the embodiment of the present invention starts the tracking reverse function when the vehicle is in the forward gear and the speed is lower than the preset speed threshold, thereby ensuring that the function is activated at the appropriate time; secondly, the vehicle is fault-detected and the forward driving data of the vehicle is obtained in the absence of a fault, including the vehicle position data and detailed motion status data, thereby improving the safety of the reversing process; then, the forward trajectory of the vehicle is recorded when the vehicle travels to a preset distance, and the driver is prompted to switch to the reverse gear when the vehicle is stopped, thereby further simplifying the driver's operating process; finally, the target reversing trajectory and the target steering wheel angle are calculated, and the results are sent to the electric power steering controller to control the vehicle to reverse along the target trajectory, thereby improving the safety and convenience of the reversing operation.
[0095] Embodiment 4
[0096] Figure 4 This is a schematic diagram of the structure of a tracking reversing device provided in the third embodiment of the present invention. Figure 4 As shown, the device includes: a forward driving data acquisition module 410, a steering wheel angle determination module 420, and a reverse driving control module 430.
[0097] Among them, the forward driving data acquisition module 410 is used to obtain the forward driving data of the vehicle when the tracking reverse function of the vehicle has been activated, wherein the forward driving data includes vehicle position data and motion state data; the steering wheel angle determination module 420 is used to determine the target reverse trajectory according to the vehicle position data, and determine the target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reverse trajectory; the reverse driving control module 430 is used to control the vehicle to reverse according to the target steering wheel angle.
[0098] The technical solution of the embodiment of the present invention is as follows: first, the forward driving data of the vehicle is acquired through the forward driving data acquisition module 410 when the tracking reverse function of the vehicle has been activated. Since the forward driving data includes the vehicle position data and the motion state data, the position and motion state data of the vehicle when it is driving forward can be recorded to provide the vehicle with reversing basis data; then, the target reversing trajectory is determined according to the vehicle position data through the steering wheel angle determination module 420, and the target steering wheel angle corresponding to the vehicle is determined according to the vehicle position data, the motion state data and the target reversing trajectory. The target reversing trajectory and the target steering wheel angle ensure that the vehicle can accurately reverse back to the original position along the path when driving forward, improve the accuracy of tracking reverse, and simplify the driving operation process; finally, the reversing driving control module 430 controls the vehicle to reverse according to the target reversing trajectory according to the target steering wheel angle. The technical solution of the embodiment of the present invention obtains the vehicle's forward driving data, determines the target reversing trajectory, and calculates the target steering wheel angle, thereby controlling the vehicle to reverse along the target reversing trajectory. This solves the problem of difficulty in reversing operations in narrow or complex environments, reduces the risk of accidents caused by improper reversing, and improves the safety and accuracy of tracking reversing.
[0099] On the basis of the above scheme, optionally, the motion state data includes the heading angle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the target preview distance corresponding to the vehicle, and the preview position corresponding to the preview point located in the target reversing trajectory; the steering wheel angle determination module may include: a steering wheel angle determination submodule. The steering wheel angle determination submodule is used to determine the target steering wheel angle corresponding to the vehicle according to the heading angle of the vehicle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the vehicle position information, the target preview distance and the preview position.
[0100] On the basis of the above solution, optionally, the steering wheel angle determination submodule is used to determine the target steering wheel angle corresponding to the vehicle according to the heading angle of the vehicle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the vehicle position information, the target preview distance and the preview position based on the following formula:
[0101]
[0102] in, is the target steering wheel angle corresponding to the vehicle, is the heading angle of the vehicle, L is the wheelbase between the front and rear axles of the vehicle, l dis the forward preview distance corresponding to the vehicle, i is the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, (E x , E y ) is the vehicle position information, (P x , P y ) is the preview position of the preview point on the target reversing trajectory.
[0103] Based on the above solution, optionally, the steering wheel angle determination module may include: a preview distance determination submodule. The preview distance determination submodule may be used to obtain the longitudinal speed of the vehicle, and determine the target preview distance corresponding to the vehicle according to the longitudinal speed, wherein the target preview distance is positively correlated with the longitudinal speed.
[0104] Based on the above solution, optionally, the preview distance determination submodule may include: a preview distance determination unit. The preview distance determination unit is used to determine the target preview distance corresponding to the vehicle according to the longitudinal driving speed, the preset forward preview time and the preset deviation distance.
[0105] Based on the above solution, optionally, the preview distance determination unit is used to determine the target preview distance corresponding to the vehicle according to the longitudinal speed of the vehicle, the forward preview time and the preset deviation distance based on the following formula:
[0106] l d =v x *T pre +l0,
[0107] Among them, l d is the target preview distance corresponding to the vehicle, v x is the longitudinal speed of the vehicle, T pre is the preset forward preview time, and l0 is the preset deviation distance.
[0108] Based on the above solution, optionally, the forward driving data acquisition module includes: a preview position determination submodule. The preview position determination submodule is used to determine the preview position corresponding to the preview point located on the target reversing trajectory according to the vehicle position information, the target preview distance and the target reversing trajectory.
[0109] Based on the above solution, optionally, the forward driving data acquisition module includes: a heading angle determination submodule. The heading angle determination submodule is used to obtain the vehicle body yaw angle, and determine the vehicle heading angle according to the vehicle body yaw angle and the center of mass sideslip angle.
[0110] On the basis of the above solution, optionally, the tracking reverse device further comprises: a tracking reverse function activation module. The tracking reverse function activation module is used to activate the tracking reverse function when a gear switching instruction to switch the vehicle to a reverse gear is received before the forward driving data of the vehicle is obtained.
[0111] Based on the above solution, optionally, the tracking and reversing device further comprises: a prompt information display block. The prompt information display block is used to display target prompt information when the vehicle is in a stopped state before activating the tracking and reversing function, wherein the target prompt information is used to prompt the user to switch the gear of the vehicle to the reverse gear.
[0112] Based on the above solution, optionally, the tracking reverse device further includes: a forward driving data recording module. The forward driving data recording module is used to record the forward driving data of the vehicle at the preset distance before acquiring the forward driving data of the vehicle, when the gear position of the vehicle is in the forward gear position, the speed of the vehicle is lower than the preset speed threshold, and the tracking reverse function of the vehicle is in the enabled state.
[0113] On the basis of the above scheme, optionally, the tracking and reversing device further includes: a forward driving data execution and recording module. The forward driving data execution and recording module is used to enable the fault detection function of the vehicle before recording the forward driving data of the vehicle at the preset distance, and perform fault detection on the vehicle through the fault detection function when the gear position of the vehicle is in the forward gear, the speed of the vehicle is lower than the preset speed threshold, and the tracking and reversing function of the vehicle is enabled; and perform the operation of recording the forward driving data of the vehicle at the preset distance when no fault is detected in the vehicle.
[0114] The tracking and reversing device provided in the embodiment of the present invention can execute the tracking and reversing method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0115] Embodiment 5
[0116] Figure 5A schematic diagram of the structure of an electronic device 10 that can be used to implement an embodiment of the present invention is shown. The electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or required herein.
[0117] like Figure 5 As shown, the electronic device 10 includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. In the RAM 13, various programs and data required for the operation of the electronic device 10 can also be stored. The processor 11, the ROM 12, and the RAM 13 are connected to each other through a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0118] A number of components in the electronic device 10 are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0119] The processor 11 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as a tracking reversing method.
[0120] In some embodiments, a tracking backing method may be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program may be loaded and / or installed on the electronic device 10 via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the tracking backing method described above may be performed. Alternatively, in other embodiments, the processor 11 may be configured to perform a tracking backing method in any other appropriate manner (e.g., by means of firmware).
[0121] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0122] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.
[0123] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0124] To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and a pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).
[0125] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0126] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0127] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0128] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for reversing by following a track, characterized in that: include: When the tracking reverse function of the vehicle has been activated, acquiring forward driving data of the vehicle, wherein the forward driving data includes vehicle position data and motion state data; Determine a target reversing trajectory according to the vehicle position data, and determine a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing trajectory; The vehicle is controlled to reverse according to the target reversing trajectory according to the target steering wheel angle.
2. The method according to claim 1, characterized in that: The motion state data includes a heading angle, a wheelbase between a front wheel axle and a rear wheel axle, a transmission ratio between a steering angle of a steering wheel and a steering angle of a wheel, a target preview distance corresponding to the vehicle, and a preview position corresponding to a preview point located on the target reversing track; The step of determining a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing trajectory comprises: A target steering wheel angle corresponding to the vehicle is determined according to the heading angle of the vehicle, the wheelbase between the front axle and the rear axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheels, the vehicle position information, the target preview distance and the preview position.
3. The method according to claim 2, characterized in that The target steering wheel angle corresponding to the vehicle is determined based on the following formula according to the heading angle of the vehicle, the wheelbase between the front wheel axle and the rear wheel axle, the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, the vehicle position information, the target preview distance and the preview position: in, is the target steering wheel angle corresponding to the vehicle, is the heading angle of the vehicle, L is the wheelbase between the front and rear axles of the vehicle, l d is the forward preview distance corresponding to the vehicle, i is the transmission ratio between the steering angle of the steering wheel and the steering angle of the wheel, (E x , E y ) is the vehicle position information, (P x , P y ) is the preview position of the preview point on the target reversing trajectory.
4. The method according to claim 2, characterized in that: The obtaining of the forward driving data of the vehicle comprises: The longitudinal travel speed of the vehicle is acquired, and a target preview distance corresponding to the vehicle is determined according to the longitudinal travel speed, wherein the target preview distance and the longitudinal travel speed are positively correlated.
5. The method according to claim 4, characterized in that The step of determining a target preview distance corresponding to the vehicle according to the longitudinal travel speed includes: The target preview distance corresponding to the vehicle is determined according to the longitudinal travel speed, the preset forward preview time and the preset deviation distance.
6. The method according to claim 5, characterized in that The target preview distance corresponding to the vehicle is determined based on the following formula according to the longitudinal speed of the vehicle, the forward preview time and the preset deviation distance: l d =in x *T pre +l0, Among them, l d is the target preview distance corresponding to the vehicle, v x is the longitudinal speed of the vehicle, T pre is the preset forward preview time, and l0 is the preset deviation distance.
7. The method according to claim 4, characterized in that The obtaining of the forward driving data of the vehicle comprises: A preview position corresponding to a preview point located on the target reversing trajectory is determined according to the vehicle position information, the target preview distance and the target reversing trajectory.
8. The method according to claim 1, characterized in that The obtaining of the forward driving data of the vehicle comprises: The vehicle body yaw angle is obtained, and the heading angle of the vehicle is determined according to the vehicle body yaw angle and the center of mass sideslip angle.
9. The method according to claim 1, characterized in that: Before acquiring the forward driving data of the vehicle, the method further includes: When a gear shift command is received to shift the vehicle into reverse gear, the tracking reverse function is activated.
10. The method according to claim 9, characterized in that Before activating the tracking reverse function, the method further includes: When the vehicle is in a stopped state, target prompt information is displayed, wherein the target prompt information is used to prompt the user to switch the gear of the vehicle to a reverse gear.
11. The method according to claim 1, characterized in that: Before acquiring the forward driving data of the vehicle, the method further includes: When the gear position of the vehicle is in the forward gear, the speed of the vehicle is lower than a preset speed threshold, and the tracking reverse function of the vehicle is enabled, the forward driving data of the vehicle at the preset distance is recorded.
12. The method according to claim 11, characterized in that When the gear position of the vehicle is in the forward gear position, the speed of the vehicle is lower than the preset speed threshold, and the tracking reverse function of the vehicle is in an enabled state, before recording the forward driving data of the vehicle at the preset distance, the method further includes: Turning on a fault detection function of the vehicle and performing fault detection on the vehicle through the fault detection function; In a case where no fault is detected with the vehicle, an operation of recording forward driving data of the vehicle at the preset distance is performed.
13. A tracking reversing device, characterized in that: include: A forward driving data acquisition module, used to acquire forward driving data of the vehicle when the tracking reverse function of the vehicle has been activated, wherein the forward driving data includes vehicle position data and motion state data; a steering wheel angle determination module, configured to determine a target reversing trajectory according to the vehicle position data, and determine a target steering wheel angle corresponding to the vehicle according to the vehicle position data, the motion state data and the target reversing estimate; The reverse driving control module is used to control the vehicle to reverse according to the target reverse trajectory according to the target steering wheel angle.
14. An electronic device, characterized in that: The electronic device comprises: at least one processor; and a memory communicatively connected to the at least one processor; wherein, The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the tracking reversing method according to any one of claims 1-11.
15. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the tracking and reversing method described in any one of claims 1-11 when executed.
16. A computer program product, characterized in that The computer program product comprises a computer program, which, when executed by a processor, implements the tracking reversing method according to any one of claims 1-11.
