Narrow scene escape method and device, electronic equipment and readable storage medium
By obtaining vehicle profile and environmental information, determining safe distance and scene status, and planning the route to escape, the problem of automatic parking assistance system being difficult to safely disengage in narrow scenarios is solved, and the applicability and efficiency of autonomous driving technology are improved.
Patent Information
- Application Number
- CN202411431138.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-14
- Publication Date
- 2024-12-06
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing automatic parking assist system is difficult to plan a path that is both reasonable and safe when facing narrow scenarios, making it difficult for vehicles to safely get out of narrow scenarios.
By obtaining the vehicle's outline information and environmental information, determine the safe distance of the vehicle and the current scene status, and plan different routes to escape according to different scene status, including straight backward, straight forward, turn backward and turn forward, etc., to help the vehicle's safety Get out of narrow scenes.
It effectively solves the problem of vehicles safely getting out of trouble in narrow scenarios, and improves the scope and efficiency of autonomous driving and automatic parking technology.
Smart Images

Figure CN119078808A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the field of vehicle control technology, and in particular to a method, device, electronic device and readable storage medium for escaping from a narrow scene. Background Art
[0002] With the wave of intelligent technology in the 21st century, autonomous driving technology has gradually moved from a dream to reality. As an important part of it, the automatic parking assist system (APA) has become one of the key symbols of modern automobile intelligence. The APA system integrates advanced sensors and complex algorithms to enable the vehicle to autonomously identify parking spaces and perform parking operations, greatly improving the driving experience and bringing unprecedented convenience to the driver.
[0003] However, although APA parking technology has made significant progress, when faced with some narrow scenarios, such as narrow roads, cars opposite the target parking space, narrow parking spaces, etc., conventional planning algorithms often find it difficult to plan a path that is both reasonable and safe. Summary of the invention
[0004] In view of this, one or more embodiments of the present disclosure provide a method, device, electronic device and readable storage medium for escaping from a narrow scene, which can enable a vehicle to escape from a narrow scene safely and effectively.
[0005] On the one hand, the present disclosure provides a method for escaping from a narrow scene, the method comprising: acquiring contour information of a vehicle, and determining a safe distance of the vehicle based on the contour information, the safe distance comprising a front safety distance, a rear safety distance, a left body safety distance and a right body safety distance; acquiring environmental information of the vehicle, the environmental information comprising relative position information of an obstacle and the vehicle, and distance information of the obstacle and the vehicle; determining a current scene state of the vehicle based on the contour information, the safe distance and the environmental information; and determining an escape route based on the current scene state, so that the vehicle can leave the narrow scene along the escape route.
[0006] Optionally, if the distance between the front of the vehicle and the front obstacle is less than the front safety distance, and the distance between the rear of the vehicle and the rear obstacle is greater than 1 meter, it is determined that the escape route is a straight-line backward type.
[0007] Optionally, if there are side obstacles on both sides of the vehicle's body, the rear space of the vehicle is greater than one meter, and there are no side obstacles on the left and right sides of the rear half of the vehicle's body, then the escape route is determined to be a straight backward type; wherein, the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle.
[0008] Optionally, if there is a side obstacle on at least one left or right side of the vehicle body, the rear space of the vehicle is greater than one meter, the distance between the front half of the vehicle body and the side obstacle is smaller than the distance between the rear half of the vehicle body and the side obstacle, and the rear space of the vehicle is greater than 4.5 meters than the front space of the vehicle, then the escape route is determined to be a straight backward type; wherein, the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle, and the front space of the vehicle represents the distance between the front of the vehicle and the front obstacle.
[0009] Optionally, if the distance between the rear of the vehicle and the rear obstacle is less than the rear safety distance, the distance between the front of the vehicle and the front obstacle is greater than 1 meter, and there are no side obstacles on the left and right sides of the front half of the vehicle, the escape route is determined to be a straight line.
[0010] Optionally, if there is a side obstacle on at least one left or right side of the rear half of the vehicle, there is no side obstacle on the left or right sides of the front half of the vehicle, and the space in front of the vehicle is greater than half of the body length of the vehicle, then the escape route is determined to be a straight line; wherein, the space in front of the vehicle represents the distance between the front of the vehicle and the front obstacle.
[0011] Optionally, if the distance between the front of the vehicle and the front obstacle is less than 0.5 meters, the distance between the left rear or right rear of the vehicle and the rear obstacle is greater than 1 meter, and there is a side obstacle on at least one side of the front half of the vehicle, then the escape route is determined to be a turning and retreating route.
[0012] Optionally, when the distances between the left and right sides of the front half of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type.
[0013] Optionally, when the distances between the left and right sides of the front half of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if the distance between the right rear end of the vehicle and the right obstacle of the rear end is greater than the distance between the left rear end of the vehicle and the left obstacle of the rear end, it is determined that the escape route is a right turn and backward type.
[0014] Optionally, when the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, the escape route is determined to be a left turn and backward.
[0015] Optionally, when the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, the escape route is determined to be a right turn and backward.
[0016] Optionally, when the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, the escape route is determined to be a right turn and backward.
[0017] Optionally, when the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, the escape route is determined to be a left turn and backward.
[0018] Optionally, when the distances between the left and right sides of the vehicle's body and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, if there is no side obstacle on the right side of the front half of the vehicle's body, and the distance between the front of the vehicle and the obstacle on the right side of the front of the vehicle is greater than a first preset distance, then the escape route is determined to be a right turn forward type.
[0019] Optionally, when the distances between the left and right sides of the vehicle's body and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, if there is no side obstacle on the left side of the front half of the vehicle, and the distance between the front of the vehicle and the obstacle on the left side of the front is greater than the first preset distance, it is determined that the escape route is a left turn forward type.
[0020] Optionally, when the distance between the left side of the vehicle's body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle's body, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, then the escape route is determined to be a right turn forward type.
[0021] Optionally, when the distance between the left side of the vehicle's body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than a second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front, then the escape route is determined to be a right turn forward type.
[0022] Optionally, when the distance between the left side of the vehicle's body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then the escape route is determined to be a left turn forward type.
[0023] Optionally, when the distance between the left side of the vehicle's body and the side obstacle is less than the left body safety distance, if the side obstacle is on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the front safety distance, the escape route is determined to be a right turn forward type.
[0024] Optionally, when the distance between the left side of the vehicle's body and the side obstacle is less than the left body safety distance, if the side obstacle is on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is not greater than the front safety distance, then the escape route is determined to be a left turn forward type.
[0025] Optionally, when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, the escape route is determined to be a left turn forward type.
[0026] Optionally, when the distance between the right side of the vehicle's body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than a second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then the escape route is determined to be a left turn forward type.
[0027] Optionally, when the distance between the right side of the vehicle's body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front, then the escape route is determined to be a right turn forward type.
[0028] Optionally, when the distance between the right side of the vehicle's body and the side obstacle is less than the right body safety distance, if there is the side obstacle on the right side of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the front safety distance, then the escape route is determined to be a left turn forward type.
[0029] Optionally, when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if the side obstacle is on the right side of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is not greater than the front safety distance, then the escape route is determined to be a right turn forward type.
[0030] On the other hand, the present disclosure further provides a device for escaping from a narrow scene, the device comprising: a first acquisition unit, for acquiring contour information of a vehicle, and determining a safe distance of the vehicle based on the contour information, the safe distance comprising a front safety distance, a rear safety distance, a left body safety distance and a right body safety distance; a second acquisition unit, for acquiring environmental information of the vehicle, the environmental information comprising relative position information of an obstacle and the vehicle, and distance information of the obstacle and the vehicle; an information processing unit, for determining a current scene state of the vehicle based on the contour information, the safe distance and the environmental information; a route planning unit, for determining an escape route based on the current scene state, so that the vehicle can leave the current narrow scene according to the escape route.
[0031] On the other hand, the present disclosure further provides an electronic device, which includes a memory and a processor, wherein the memory is used to store a computer program, and when the computer program is executed by the processor, the above-mentioned narrow scene escape method is implemented.
[0032] On the other hand, the present disclosure further provides a computer-readable storage medium, which is used to store a computer program. When the computer program is executed by a processor, the above-mentioned narrow scene escape method is implemented.
[0033] The technical solution provided by one or more embodiments of the present disclosure can use the contour information of the vehicle to determine some safe distances of the vehicle. Subsequently, the current scene state of the vehicle can be determined by combining the contour information of the vehicle, the safe distance of the vehicle, and the obstacle information in the vehicle's surrounding environment. Different escape routes can be planned according to different vehicle scene states. In this way, when the vehicle is trapped in certain narrow scenes, the determined escape route can help the vehicle to safely and effectively leave the narrow scene. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] The features and advantages of the embodiments of the present disclosure may be more clearly understood by referring to the accompanying drawings, which are schematic and should not be construed as limiting the present disclosure in any way. In the accompanying drawings:
[0035] Figure 1 A schematic diagram showing the steps of a method for escaping from a narrow scene in one embodiment of the present disclosure is shown;
[0036] Figure 2 A schematic diagram of the safety distance of a vehicle in one embodiment of the present disclosure is shown;
[0037] Figure 3 A state diagram of an applicable scenario of a straight-line backward escape route in one embodiment of the present disclosure is shown;
[0038] Figure 4 Another applicable scenario state diagram of a straight-line backward escape route in one embodiment of the present disclosure is shown;
[0039] Figure 5 Another applicable scenario state diagram of a straight-line backward escape route in one embodiment of the present disclosure is shown; a flow chart of a method for determining degradation of a landing page;
[0040] Figure 6 A state diagram of an applicable scenario of a straight-line escape route in one embodiment of the present disclosure is shown;
[0041] Figure 7 Another applicable scenario state diagram of a straight-line escape route in one embodiment of the present disclosure is shown;
[0042] Figure 8 A state diagram of an applicable scenario of a left-turn backward escape route in one embodiment of the present disclosure is shown;
[0043] Fig. 9 A state diagram of an applicable scenario of a right-turn backward escape route in one embodiment of the present disclosure is shown;
[0044] Fig.10 A state diagram of various applicable scenarios of left-turn-backward and right-turn-backward escape routes in one embodiment of the present disclosure is shown;
[0045] Fig.11 A state diagram of an applicable scenario of a right-turn forward escape route in one embodiment of the present disclosure is shown;
[0046] Fig.12 A state diagram of an applicable scenario of a left-turn forward escape route in one embodiment of the present disclosure is shown;
[0047] Fig.13Another applicable scenario state diagram of a right-turn forward escape route in one embodiment of the present disclosure is shown;
[0048] Fig.14 Another applicable scenario state diagram of a right-turn forward escape route in one embodiment of the present disclosure is shown;
[0049] Fig.15 Another applicable scenario state diagram of a left-turn forward escape route in one embodiment of the present disclosure is shown;
[0050] Fig.16 Another applicable scenario state diagram of a right-turn forward escape route in one embodiment of the present disclosure is shown;
[0051] Fig.17 Another applicable scenario state diagram of a left-turn forward escape route in one embodiment of the present disclosure is shown;
[0052] Fig.18 Another applicable scenario state diagram of a left-turn forward escape route in one embodiment of the present disclosure is shown;
[0053] Fig.19 Another applicable scenario state diagram of a left-turn forward escape route in one embodiment of the present disclosure is shown;
[0054] Fig. 20 Another applicable scenario state diagram of a right-turn forward escape route in one embodiment of the present disclosure is shown;
[0055] Fig.21 A schematic diagram of functional units of a narrow scene escape device in one embodiment of the present disclosure is shown;
[0056] Fig. 22 A schematic structural diagram of an electronic device in one embodiment of the present disclosure is shown. DETAILED DESCRIPTION
[0057] In order to make the purpose, technical solutions and advantages of the embodiments of the present disclosure clearer, the technical solutions in the embodiments of the present disclosure will be clearly and completely described below in conjunction with the drawings in the embodiments of the present disclosure. Obviously, the described embodiments are part of the embodiments of the present disclosure, not all of the embodiments. Based on the embodiments in the present disclosure, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present disclosure.
[0058] The narrow scene escape method provided by an embodiment of the present disclosure can be applied to vehicles with automatic driving functions or APA functions. It can be used as a prerequisite technology or improved technology for existing APA technology, and can help the vehicle escape safely when the vehicle is trapped in some narrow scenes where the existing APA technology is difficult to apply.
[0059] See also Figure 1 A method for escaping from a narrow scene provided by an embodiment of the present disclosure may include the following steps.
[0060] S1: Obtaining the contour information of the vehicle, and determining the safety distance of the vehicle according to the contour information, wherein the safety distance includes the front safety distance, the rear safety distance, the left body safety distance and the right body safety distance.
[0061] In this embodiment, the narrow scene may be a scene where the road is narrow, there is a car opposite the target parking space, the parking space is narrow, etc. In a narrow scene, there are generally obstacles close to the vehicle, making it difficult for the vehicle to safely leave the scene.
[0062] In this embodiment, the vehicle profile information may include vehicle length information, vehicle width information, vehicle front profile, vehicle rear profile, left and right side profiles of the vehicle, etc. The vehicle profile may be a curved profile that fits the vehicle body, or may be a circumscribed rectangular profile that includes the vehicle body. Based on the vehicle profile information, the vehicle may be divided into shapes, thereby determining information such as the left front, right front, left rear, right rear, front half of the vehicle body, and rear half of the vehicle body.
[0063] In this embodiment, after obtaining the vehicle's profile information, the safety distances corresponding to different vehicle positions can be calculated according to preset calculation rules, or the vehicle safety distances matching the vehicle profile information can be searched locally or online.
[0064] For a practical example, see Figure 2, the vehicle can be processed into a rectangular frame with a safety distance according to the body contour, and the front and rear and left and right safety distances can be configured according to the vehicle contour parameters. The values of the front safety distance, the rear safety distance, the left body safety distance, and the right body safety distance can be the same or different. For example, the front safety distance can be defined as safe_dis_f, the rear safety distance can be defined as safe_dis_b, and the safety distances of the left body safety distance and the right body safety distance can be defined as the same safe_dis_lr. The vertex numbers of the circumscribed rectangular frame of the body contour can be 1, 2, 3, and 4 in sequence. Considering that the front half of the body has a protruding rearview mirror, the safety distance on both sides of the front half of the body can be expanded to increase the length of the rearview mirror, for example, 15cm. The line connecting M7 and M2 can cross the midpoint of the 14 line segment and the midpoint of the 23 line segment, thereby accurately dividing the front half of the body and the rear half of the body. After expanding the safety distances on both sides of the front half of the body, a polygonal border M0M1M2M3M4M5M6M7 can be formed. When an obstacle falls into the area framed by the polygonal border, the vehicle can be prompted to plan an escape route and leave the current narrow scene.
[0065] S2: Acquire environmental information of the vehicle, wherein the environmental information includes relative position information between the obstacle and the vehicle, and distance information between the obstacle and the vehicle.
[0066] In this embodiment, if the vehicle is located in a narrow scene, it means that there is at least one obstacle in the surrounding environment of the vehicle that affects the driving route of the vehicle, such as a wall, a curb, other vehicles, etc.
[0067] In this embodiment, the relative position information between the obstacle and the vehicle may indicate that the obstacle is located at the front of the vehicle, the rear of the vehicle, the left and right sides of the vehicle body, etc. Further, the relative position information between the obstacle and the vehicle may indicate that the obstacle is located at the left side of the front of the vehicle, the right side of the front of the vehicle, the left side of the rear of the vehicle, the right side of the rear of the vehicle, both sides of the front half of the vehicle body, both sides of the rear half of the vehicle body, etc.
[0068] In this embodiment, the distance information between the obstacle and the vehicle can reflect the distance between the obstacle mark point (such as the center point or the predefined boundary point) and the vehicle mark point (such as the midpoint of the front of the vehicle, the midpoint of the rear of the vehicle, the midpoint of the left side of the front half of the vehicle body, the midpoint of the right side of the rear half of the vehicle body, etc.). Obtaining the distance information between the obstacle and the vehicle can be achieved with the help of a variety of vehicle-mounted sensors, such as ultrasonic sensors, cameras, laser radars, infrared sensors, etc.
[0069] S3: Determine the current scene state of the vehicle based on the contour information, the safety distance and the environmental information.
[0070] In this embodiment, after the contour information, safety distance and environmental information are integrated, the current scene state of the vehicle can be determined. Specifically, the current scene state can be determined by a preset data matching rule, or by a pre-trained classification model to quickly and accurately determine the current scene state.
[0071] S4: Determine an escape route according to the current scene state, so that the vehicle can leave the narrow scene according to the escape route.
[0072] In this embodiment, for different scene states, corresponding escape strategies can be read or called. Subsequently, an escape route can be directly determined based on the escape strategy. According to the escape strategy, a targeted and optimized escape route can also be defined in combination with the vehicle's profile information.
[0073] In some embodiments, see Figure 3 If the distance between the front of the vehicle and the obstacle at the front is less than the front safety distance, and the distance between the rear of the vehicle and the obstacle at the rear is greater than 1 meter, it is determined that the escape route is a straight-line backward type.
[0074] In some embodiments, see Figure 4 If there are side obstacles on both sides of the vehicle body, the rear space of the vehicle is greater than one meter, and there are no side obstacles on the left and right sides of the rear half of the vehicle body, then the escape route is determined to be a straight backward type; wherein, the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle.
[0075] In some embodiments, see Figure 5 If there is a side obstacle on at least one side of the vehicle, the rear space of the vehicle is greater than one meter, the distance between the front half of the vehicle and the side obstacle is less than the distance between the rear half of the vehicle and the side obstacle, and the rear space of the vehicle is greater than 4.5 meters than the front space of the vehicle, then the escape route is determined to be a straight backward type; wherein the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle, and the front space of the vehicle represents the distance between the front of the vehicle and the front obstacle.
[0076] In some embodiments, see Figure 6 If the distance between the rear of the vehicle and the rear obstacle is less than the rear safety distance, the distance between the front of the vehicle and the front obstacle is greater than 1 meter, and there are no side obstacles on the left and right sides of the front half of the vehicle, then the escape route is determined to be a straight-line forward route.
[0077] In some embodiments, see Figure 7If there is a side obstacle on at least one left or right side of the rear half of the vehicle, and there is no side obstacle on the left or right sides of the front half of the vehicle, and the space in front of the vehicle is greater than half of the body length of the vehicle, then the escape route is determined to be a straight line; wherein the space in front of the vehicle represents the distance between the front of the vehicle and the obstacle in front of the vehicle.
[0078] In some embodiments, if the distance between the front of the vehicle and the front obstacle is less than 0.5 meters, the distance between the left rear or right rear of the vehicle and the rear obstacle is greater than 1 meter, and there is a side obstacle on at least one side of the front half of the vehicle, then the escape route is determined to be a turning and retreating route.
[0079] In an example of a practical application of this embodiment, see Figure 8 When the distances between the left and right sides of the front half of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type.
[0080] It should be noted that the maximum turning radius can be set for left turn and reverse to further ensure vehicle safety.
[0081] In an example of a practical application of this embodiment, see Fig. 9 When the distances between the left and right sides of the front half of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if the distance between the right rear end of the vehicle and the right obstacle of the rear end is greater than the distance between the left rear end of the vehicle and the left obstacle of the rear end, it is determined that the escape route is a right turn and backward type.
[0082] It should be noted that the maximum turning radius can be set for right turn and reverse to further ensure vehicle safety.
[0083] In an example of a practical application of this embodiment, see Fig.10 When the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type.
[0084] It should be noted that the turning radius of the left turn can be calculated based on the positional relationship between the vehicle body and the obstacle on the right, so as to ensure that the front of the vehicle can maintain a safe distance from the obstacle on the right when turning. In this way, the safety of the vehicle can be further ensured.
[0085] In an example of a practical application of this embodiment, see Fig.10 When the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, it is determined that the escape route is a right turn and backward type.
[0086] It should be noted that the turning radius for right turn and reverse can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0087] In an example of a practical application of this embodiment, see Fig.10 When the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, it is determined that the escape route is a right turn and backward type.
[0088] It should be noted that the turning radius of the right turn can be calculated based on the positional relationship between the vehicle body and the obstacle on the left, so as to ensure that the front of the vehicle can maintain a safe distance from the obstacle on the left when turning. In this way, the safety of the vehicle can be further ensured.
[0089] In an example of a practical application of this embodiment, see Fig.10 When the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type.
[0090] It should be noted that the turning radius for a left turn and reverse can be set to a minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0091] In some embodiments, see Fig.11 When the distances between the left and right sides of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if there is no side obstacle on the right side of the front half of the vehicle, and the distance between the front of the vehicle and the obstacle on the right side of the front of the vehicle is greater than a first preset distance, it is determined that the escape route is a right turn forward type.
[0092] It should be noted that the first preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.5 meters. The turning radius of the right turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0093] In some embodiments, see Fig.12 When the distances between the left and right sides of the vehicle and the side obstacles are both less than the left body safety distance and the right body safety distance, if there is no side obstacle on the left side of the front half of the vehicle, and the distance between the front of the vehicle and the obstacle on the left side of the front is greater than the first preset distance, it is determined that the escape route is a left turn forward type.
[0094] It should be noted that the first preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.5 meters. The turning radius of the left turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0095] In some embodiments, see Fig.13 When the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, it is determined that the escape route is a right turn forward type.
[0096] It should be noted that the turning radius for turning right can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0097] In some embodiments, see Fig.14 , when the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front, then it is determined that the escape route is a right turn forward type.
[0098] It should be noted that the second preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.3 meters. The turning radius of the right turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0099] In some embodiments, see Fig.15, when the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then it is determined that the escape route is a left turn forward type.
[0100] It should be noted that the second preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.3 meters. The turning radius of the left turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0101] In some embodiments, see Fig.16 When the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there is the side obstacle on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the front safety distance, it is determined that the escape route is a right turn forward type.
[0102] It should be noted that the turning radius for turning right can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0103] In some embodiments, see Fig.17 When the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there is the side obstacle on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is not greater than the front safety distance, it is determined that the escape route is a left turn forward type.
[0104] It should be noted that the turning radius for turning left can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0105] In some embodiments, see Fig.18 When the distance between the right side of the vehicle and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, it is determined that the escape route is a left turn forward type.
[0106] It should be noted that the turning radius for turning left can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0107] In some embodiments, see Fig.19, when the distance between the right side of the vehicle and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then it is determined that the escape route is a left turn forward type.
[0108] It should be noted that the second preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.3 meters. The turning radius of the left turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0109] In some embodiments, see Fig. 20 , when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front, then it is determined that the escape route is a right turn forward type.
[0110] It should be noted that the second preset distance can be determined based on the front safety distance, for example, the first preset distance can be set to exceed the front safety distance by 0.3 meters. The turning radius of the right turn can be set to the minimum turning radius, so as to ensure that the vehicle can get away from the obstacle in the fastest way.
[0111] In some embodiments, when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if the side obstacle is on the right side of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the front safety distance, the escape route is determined to be a left turn forward type.
[0112] It should be noted that the turning radius for turning left can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0113] In some embodiments, when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if the side obstacle is on the right side of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is not greater than the front safety distance, then the escape route is determined to be a right turn forward type.
[0114] It should be noted that the turning radius for turning right can be set to the minimum turning radius, thereby ensuring that the vehicle can escape from the obstacle in the fastest way.
[0115] The technical solution provided by one or more embodiments of the present disclosure can use the contour information of the vehicle to determine some safe distances of the vehicle. Subsequently, the current scene state of the vehicle can be determined by combining the contour information of the vehicle, the safe distance of the vehicle, and the obstacle information in the vehicle's surrounding environment. Different escape routes can be planned according to different vehicle scene states. In this way, when the vehicle is trapped in certain narrow scenes, the determined escape route can help the vehicle to safely and effectively leave the narrow scene.
[0116] See also Fig.21 The present disclosure also provides a device for escaping from a narrow scene, the device comprising:
[0117] The first acquisition unit 100 is used to acquire the contour information of the vehicle and determine the safety distance of the vehicle according to the contour information, wherein the safety distance includes the front safety distance, the rear safety distance, the left safety distance and the right safety distance of the vehicle;
[0118] A second acquisition unit 200 is used to acquire environmental information of the vehicle, wherein the environmental information includes relative position information between the obstacle and the vehicle, and distance information between the obstacle and the vehicle;
[0119] An information processing unit 300, configured to determine a current scene state of the vehicle based on the contour information, the safety distance and the environmental information;
[0120] The route planning unit 400 is used to determine an escape route according to the current scene state, so that the vehicle can leave the current narrow scene according to the escape route.
[0121] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a straight-line backward route if the distance between the front of the vehicle and the front obstacle is less than the front safety distance, and the distance between the rear of the vehicle and the rear obstacle is greater than 1 meter.
[0122] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a straight backward type if there are side obstacles on both sides of the vehicle body, the rear space of the vehicle is greater than one meter, and there are no side obstacles on the left and right sides of the rear half of the vehicle body; wherein the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle.
[0123] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a straight backward type if there is a side obstacle on at least one side of the left or right side of the vehicle body, the rear space of the vehicle is greater than one meter, the distance between the front half of the vehicle body and the side obstacle is less than the distance between the rear half of the vehicle body and the side obstacle, and the rear space of the vehicle is greater than the front space of the vehicle by 4.5 meters; wherein the rear space of the vehicle represents the distance between the rear of the vehicle and the rear obstacle, and the front space of the vehicle represents the distance between the front of the vehicle and the front obstacle.
[0124] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a straight-line route if the distance between the rear of the vehicle and the rear obstacle is less than the rear safety distance, the distance between the front of the vehicle and the front obstacle is greater than 1 meter, and there are no side obstacles on the left and right sides of the front half of the vehicle.
[0125] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a straight-line type if there is a side obstacle on at least one left or right side of the rear half of the vehicle, there is no side obstacle on the left or right sides of the front half of the vehicle, and the space in front of the vehicle is greater than half of the body length of the vehicle; wherein the space in front of the vehicle represents the distance between the front of the vehicle and the front obstacle.
[0126] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a turning and backward route if the distance between the front of the vehicle and the front obstacle is less than 0.5 meters, the distance between the left rear or right rear of the vehicle and the rear obstacle is greater than 1 meter, and there is a side obstacle on at least one side of the left and right sides of the front half of the vehicle.
[0127] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn and backward type when the distances between the left and right sides of the front half of the vehicle and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, and if the distance between the left rear end of the vehicle and the obstacle on the left side of the rear end is greater than the distance between the right rear end of the vehicle and the obstacle on the right side of the rear end.
[0128] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn and backward type when the distances between the left and right sides of the front half of the vehicle and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, and if the distance between the right rear end of the vehicle and the right obstacle of the rear is greater than the distance between the left rear end of the vehicle and the left obstacle of the rear.
[0129] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn and backward type when the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, and if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear.
[0130] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn and backward type when the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, and if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear.
[0131] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn and backward type when the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, and if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear.
[0132] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn and backward type when the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, and if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear.
[0133] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distances between the left and right sides of the vehicle body and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, if there is no side obstacle on the right side of the front half of the vehicle body, and the distance between the front of the vehicle and the obstacle on the right side of the front of the vehicle is greater than a first preset distance.
[0134] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distances between the left and right sides of the vehicle body and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, if there is no side obstacle on the left side of the front half of the vehicle body, and the distance between the front of the vehicle and the obstacle on the left side of the front of the vehicle is greater than the first preset distance.
[0135] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distance between the left side of the vehicle body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters.
[0136] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distance between the left side of the vehicle body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than a second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front.
[0137] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distance between the left side of the vehicle body and the side obstacle is less than the left body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front.
[0138] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distance between the left side of the vehicle body and the side obstacle is less than the left body safety distance, if there is the side obstacle on the left side of the front half of the vehicle body, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the front safety distance.
[0139] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distance between the left side of the vehicle body and the side obstacle is less than the left body safety distance, if there is the side obstacle on the left side of the front half of the vehicle body, and the distance between the right front of the vehicle and the obstacle on the right side of the front is not greater than the front safety distance.
[0140] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters.
[0141] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than a second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front.
[0142] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there are no side obstacles on the left and right sides of the front half of the vehicle body, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front.
[0143] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a left turn forward type when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there is the side obstacle on the right side of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the front safety distance.
[0144] In one embodiment, the route planning unit 400 is specifically used to determine that the escape route is a right turn forward type when the distance between the right side of the vehicle body and the side obstacle is less than the right body safety distance, if there is the side obstacle on the right side of the front half of the vehicle body, and the distance between the left front of the vehicle and the obstacle on the left side of the front is not greater than the front safety distance.
[0145] Each unit described in the above embodiments may be implemented by a computer chip or a product having a certain function. A typical implementation device is a computer. Specifically, the computer may be, for example, a personal computer, a laptop computer, a cellular phone, a camera phone, a smart phone, a personal digital assistant, a media player, a navigation device, an email device, a game console, a tablet computer, a wearable device, or a combination of any of these devices.
[0146] For the convenience of description, the above devices are described in terms of functions and are described separately in various units. Of course, when implementing the present application, the functions of each unit can be implemented in the same or multiple software and / or hardware.
[0147] See also Fig. 22 The present disclosure also provides an electronic device, which includes a memory and a processor, wherein the memory is used to store a computer program, and when the computer program is executed by the processor, the above-mentioned method for escaping from narrow scenarios of landing pages is implemented.
[0148] The present disclosure also provides a computer-readable storage medium, which is used to store a computer program. When the computer program is executed by a processor, the above-mentioned narrow scene escape method is implemented.
[0149] The processor may be a central processing unit (CPU). The processor may also be other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, or a combination of the above chips.
[0150] As a non-transitory computer-readable storage medium, the memory can be used to store non-transitory software programs, non-transitory computer executable programs and modules, such as program instructions / modules corresponding to the method in the embodiment of the present disclosure. The processor executes various functional applications and data processing of the processor by running the non-transitory software programs, instructions and modules stored in the memory, that is, implementing the method in the above method embodiment.
[0151] The memory may include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application required for at least one function; the data storage area may store data created by the processor, etc. In addition, the memory may include a high-speed random access memory, and may also include a non-transitory memory, such as at least one disk storage device, a flash memory device, or other non-transitory solid-state storage device. In some embodiments, the memory may optionally include a memory remotely disposed relative to the processor, and these remote memories may be connected to the processor via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.
[0152] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing the relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium, and when the program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, the storage medium can be a disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), a flash memory, a hard disk drive (HDD) or a solid-state drive (SSD), etc.; the storage medium can also include a combination of the above-mentioned types of memory.
[0153] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the embodiments of the device, equipment, and storage medium, since they are basically similar to the method embodiments, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiments.
[0154] The above is only an embodiment of the present application and is not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the scope of the claims of the present application.
[0155] Although the embodiments of the present disclosure have been described in conjunction with the accompanying drawings, those skilled in the art may make various modifications and variations without departing from the spirit and scope of the present disclosure, and such modifications and variations are all within the scope defined by the appended claims.
Claims
1. A method for escaping from a narrow scene, characterized in that: The method comprises: Obtaining the vehicle's profile information, and determining the vehicle's safety distance based on the profile information, wherein the safety distance includes the front safety distance, the rear safety distance, the left body safety distance, and the right body safety distance; Acquiring environmental information of the vehicle, the environmental information including relative position information of an obstacle and the vehicle, and distance information of the obstacle and the vehicle; Determining a current scene state of the vehicle based on the contour information, the safety distance, and the environmental information; An escape route is determined according to the current scene state, so that the vehicle can leave the narrow scene according to the escape route.
2. The method according to claim 1, characterized in that Determining an escape route according to the current scene state includes at least one of the following: If the distance between the front of the vehicle and the obstacle is less than the front safety distance, and the distance between the rear of the vehicle and the obstacle is greater than 1 meter, it is determined that the escape route is a straight-line backward type; If there are side obstacles on both sides of the vehicle, the rear space of the vehicle is greater than one meter, and there are no side obstacles on both sides of the rear half of the vehicle, then the escape route is determined to be a straight-line backward type; If there is a lateral obstacle on at least one side of the vehicle, the rear space of the vehicle is greater than one meter, the distance between the front half of the vehicle and the lateral obstacle is less than the distance between the rear half of the vehicle and the lateral obstacle, and the rear space of the vehicle is greater than the front space of the vehicle by more than 4.5 meters, then the escape route is determined to be a straight-line backward type; The rear space of the vehicle represents the distance between the rear of the vehicle and an obstacle at the rear of the vehicle, and the front space of the vehicle represents the distance between the front of the vehicle and an obstacle at the front of the vehicle.
3. The method according to claim 1, characterized in that The step of determining an escape route according to the current scene state includes at least one of the following: If the distance between the rear of the vehicle and the rear obstacle is less than the rear safety distance, the distance between the front of the vehicle and the front obstacle is greater than 1 meter, and there are no side obstacles on the left and right sides of the front half of the vehicle, then the escape route is determined to be a straight-line forward route; If the side obstacle is on at least one left or right side of the rear half of the vehicle, and there is no side obstacle on the left or right sides of the front half of the vehicle, and the space in front of the vehicle is greater than half of the length of the vehicle, then the escape route is determined to be a straight-line forward route; The space in front of the vehicle represents the distance between the front of the vehicle and an obstacle in front of the vehicle.
4. The method according to claim 1, characterized in that: Determining an escape route according to the current scene state includes: If the distance between the front of the vehicle and the front obstacle is less than 0.5 meters, the distance between the left rear or right rear of the vehicle and the rear obstacle is greater than 1 meter, and there is a side obstacle on at least one side of the front half of the vehicle, then the escape route is determined to be a turning and retreating type.
5. The method according to claim 4, characterized in that Determining that the escape route is a turning and retreating route includes at least one of the following: When the distances between the left and right sides of the front half of the vehicle and the lateral obstacle are both less than the left body safety distance and the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type; When the distances between the left and right sides of the front half of the vehicle and the lateral obstacle are both less than the left body safety distance and the right body safety distance, and if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, it is determined that the escape route is a right turn and backward type; When the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type; When the distance between the right side of the front half of the vehicle and the side obstacle is less than the right body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, it is determined that the escape route is a right turn and backward type; When the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the right rear of the vehicle and the right obstacle of the rear is greater than the distance between the left rear of the vehicle and the left obstacle of the rear, it is determined that the escape route is a right turn and backward type; When the distance between the left side of the front half of the vehicle and the side obstacle is less than the left body safety distance, if the distance between the left rear of the vehicle and the obstacle on the left side of the rear is greater than the distance between the right rear of the vehicle and the obstacle on the right side of the rear, it is determined that the escape route is a left turn and backward type.
6. The method according to claim 1, characterized in that The step of determining an escape route according to the current scene state includes at least one of the following: When the distances between the left and right sides of the vehicle and the lateral obstacles are both less than the left body safety distance and the right body safety distance, if there is no lateral obstacle on the right side of the front half of the vehicle, and the distance between the front of the vehicle and the obstacle on the right side of the front of the vehicle is greater than a first preset distance, it is determined that the escape route is a right turn forward type; When the distances between the left and right sides of the vehicle and the side obstacles are simultaneously less than the left body safety distance and the right body safety distance, if there is no side obstacle on the left side of the front half of the vehicle, and the distance between the front of the vehicle and the obstacle on the left side of the front is greater than the first preset distance, it is determined that the escape route is a left turn forward type.
7. The method according to claim 1, characterized in that The step of determining an escape route according to the current scene state includes at least one of the following: When the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there is no side obstacle on the left and right sides of the front half of the vehicle, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, it is determined that the escape route is a right turn forward type; When the distance between the left side of the vehicle and the lateral obstacle is less than the left body safety distance, if there is no lateral obstacle on the left and right sides of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the distance between the left front of the vehicle and the obstacle on the left side of the front, then it is determined that the escape route is a right turn forward type; When the distance between the left side of the vehicle and the lateral obstacle is less than the left body safety distance, if there are no lateral obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then it is determined that the escape route is a left turn forward type; When the distance between the left side of the vehicle and the lateral obstacle is less than the left body safety distance, if there is the lateral obstacle on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is greater than the front safety distance, it is determined that the escape route is a right turn forward type; When the distance between the left side of the vehicle and the side obstacle is less than the left body safety distance, if there is the side obstacle on the left side of the front half of the vehicle, and the distance between the right front of the vehicle and the obstacle on the right side of the front is not greater than the front safety distance, then the escape route is determined to be a left turn forward type.
8. The method according to claim 1, characterized in that The step of determining an escape route according to the current scene state includes at least one of the following: When the distance between the right side of the vehicle and the lateral obstacle is less than the right body safety distance, if there is no lateral obstacle on the left and right sides of the front half of the vehicle, and the distance between the front of the vehicle and the front obstacle is greater than 0.8 meters, it is determined that the escape route is a left turn forward type; When the distance between the right side of the vehicle and the lateral obstacle is less than the right body safety distance, if there are no lateral obstacles on the left and right sides of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the second preset distance, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the distance between the right front of the vehicle and the obstacle on the right side of the front, then it is determined that the escape route is a left turn forward type; When the distance between the right side of the vehicle and the lateral obstacle is less than the right body safety distance, if there are no lateral obstacles on the left and right sides of the front half of the vehicle, and the distance between the right front of the vehicle and the right obstacle of the front is greater than the second preset distance, and the distance between the right front of the vehicle and the right obstacle of the front is greater than the distance between the left front of the vehicle and the left obstacle of the front, then it is determined that the escape route is a right turn forward type; When the distance between the right side of the vehicle and the lateral obstacle is less than the right body safety distance, if there is the lateral obstacle on the right side of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is greater than the front safety distance, it is determined that the escape route is a left turn forward type; When the distance between the right side of the vehicle and the side obstacle is less than the right body safety distance, if there is the side obstacle on the right side of the front half of the vehicle, and the distance between the left front of the vehicle and the obstacle on the left side of the front is not greater than the front safety distance, then the escape route is determined to be a right turn forward type.
9. A device for escaping from a narrow scene, characterized in that: The device comprises: A first acquisition unit is used to acquire the contour information of the vehicle, and determine the safety distance of the vehicle according to the contour information, wherein the safety distance includes the front safety distance, the rear safety distance, the left body safety distance and the right body safety distance; a second acquisition unit, configured to acquire environmental information of the vehicle, wherein the environmental information includes relative position information between the obstacle and the vehicle, and distance information between the obstacle and the vehicle; an information processing unit, configured to determine a current scene state of the vehicle based on the contour information, the safety distance, and the environmental information; The route planning unit is used to determine an escape route according to the current scene state, so that the vehicle can leave the current narrow scene according to the escape route.
10. An electronic device, characterized in that: The electronic device comprises a memory and a processor, wherein the memory is used to store a computer program, and when the computer program is executed by the processor, the method according to any one of claims 1 to 8 is implemented.
11. A computer-readable storage medium, characterized in that: The computer-readable storage medium is used to store a computer program, and when the computer program is executed by a processor, the method according to any one of claims 1 to 8 is implemented.
Citation Information
Patent Citations
Determining method for chance of avoiding barriers and changing lane of vehicle and control method of avoiding barriers and changing lane
CN109987092A
Method and device for controlling robot to get out of trouble, terminal and readable storage medium
CN111650933A
Vehicle escape method and vehicle
CN116767284A
Cited By
Robot escape method and device and storage medium
CN119882538A
