Control method and device and intelligent driving equipment
By switching the path planning mode in the intelligent driving device and switching the planning mode according to the passable width and curvature threshold of the obstacle, the difficulty in path planning of automatic valet parking under complex road conditions is solved, and the parking success rate is improved.
Patent Information
- Application Number
- CN202310829214.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-07-06
- Publication Date
- 2025-01-14
- Estimated Expiration
- 2043-07-06
AI Technical Summary
The existing automatic valet parking technology is difficult to effectively plan the path when facing complex parking lot road conditions, resulting in vehicles being stuck and unable to continue parking.
Provide a control method and device, by switching the path planning mode in the intelligent driving device, mode switching is performed according to the passable width and curvature threshold of the obstacle, and using the first planning mode and the second planning mode to process simple and complex road conditions respectively, Ensure the vehicle can pass safely.
It improves the ability to get out of trouble during automatic parking, reduces the chance of failure of path planning caused by obstacles or complex road conditions, and improves the parking success rate.
Smart Images

Figure CN119305544A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of intelligent driving, and more specifically, to a control method, device and intelligent driving equipment. Background Art
[0002] With the rapid development of the automobile industry, many assisted driving and autonomous driving technologies have emerged, which can reduce driving pressure, improve safety and traffic efficiency. Automatic parking (AP) is a widely used assisted driving technology. AP refers to the automatic parking of the vehicle, that is, the automatic driving system can semi-automatically or fully automatically help the user park the vehicle into the parking space. Automatic parking can include auto parking assist (APA), remote parking assist (RPA) and auto valet parking (AVP).
[0003] Parking lots usually have large curvature turns, narrow channel turns, or road conditions with complex obstacle locations. Since the current AVP path planning capability cannot cope with the above complex situations, when using AVP for parking, the vehicle may be blocked and stuck.
[0004] In view of this, a control scheme that can improve the vehicle's ability to escape from trouble during automatic parking needs to be developed urgently. Summary of the invention
[0005] The present application provides a control method, device and intelligent driving equipment, which can reduce the probability of the intelligent driving equipment being unable to plan a path due to obstacles or complex road conditions during the AVP parking process, thereby helping to improve the success rate of parking.
[0006] In a first aspect, a control method is provided, which can be executed by an intelligent driving device; or, it can also be executed by a computing platform of the intelligent driving device; or, it can also be executed by a chip or circuit used for the intelligent driving device, which is not limited in this application.
[0007] The method includes: controlling an intelligent driving device to travel along a first planned path, the first planned path being planned by a first planning mode; when a first obstacle exists in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, controlling the intelligent driving device to switch from traveling along the first planned path to traveling along a second planned path, the second planned path being planned by a second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
[0008] In the above technical solution, two path planning modes with different path planning capabilities are provided. During the driving process of the intelligent driving device, the mode is switched according to the actual road conditions, which helps to improve the passing ability of the intelligent driving device under different road conditions. In particular, during the AVP parking process, it can reduce the probability that the vehicle cannot perform path planning due to narrow channels or scenes with complex obstacle positions, which helps to improve the success rate of AVP parking.
[0009] Exemplarily, the first preset threshold may be determined according to the width of the intelligent driving device; the second preset threshold may be 0.01, or 0.1, or other values.
[0010] In some possible implementations, when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, the intelligent driving device is controlled to stop driving and switch from the first planning mode to the second planning mode.
[0011] In some possible implementations, the first area may include one or more feasible paths, and the curvature of the feasible paths in the first area being greater than or equal to the second preset threshold includes: the curvature of a feasible path with the smallest curvature in the first area is greater than or equal to the second preset threshold.
[0012] In some possible implementations, the first area is determined according to the first path and the position of the first sub-obstacle.
[0013] It should be noted that the first and second planning modes have different planning capabilities for different scenarios. The first planning mode can only perform relatively simple path planning, and has low planning capabilities in areas with narrow roads, large curvatures, and complex obstacle locations; the second planning mode can perform path planning in areas with narrow roads, large curvatures, and complex obstacle locations.
[0014] In some possible implementations, the second planned path includes multiple paths with different gear combinations, for example, multiple paths with multiple driving gear and reverse gear combinations.
[0015] In combination with the first aspect, in certain implementations of the first aspect, the first area includes a head end and a tail end, the head end of the first area is an end close to the current position of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device; the method also includes: determining a first target posture of the intelligent driving device according to the first planned path; determining a second target posture according to the first target posture and the position of the first obstacle, the second target posture indicating the posture of the tail end of the intelligent driving device out of the first area; planning a second planned path according to the current posture of the intelligent driving device, the second target posture and the first obstacle.
[0016] Exemplarily, the second planned path may be planned based on a hybrid A* (A-star) algorithm or a geometric method according to the current posture of the intelligent driving device, the second target posture, and the first obstacle.
[0017] Exemplarily, determining the second target posture according to the first target posture and the position of the first obstacle includes: adjusting the lateral position and / or longitudinal position of the first target posture according to the position of the first obstacle to obtain the second target posture.
[0018] In some possible implementations, the first target posture and the second target posture are the same posture.
[0019] In the above technical solution, determining the second target posture based on the first planning path planned in the first planning mode helps to reduce the difficulty of path planning. Determining the second target posture according to the position of the first obstacle helps to achieve adaptiveness to the obstacle scale and obtain a feasible escape position across the current trapped area.
[0020] In combination with the first aspect, in certain implementations of the first aspect, the method also includes: determining a drivable area along the first planned path based on the first planned path; planning a second planned path based on the current posture and the second target posture of the intelligent driving device, including: planning the second planned path in the drivable area based on the current posture, the second target posture and the first obstacle.
[0021] In the above technical solution, the drivable area is generated based on the first planned path, which can prevent the intelligent driving device from leaving the road during driving and from entering other parking spaces during parking. In addition, the drivable area is generated based on the first planned path, which can prevent the intelligent driving device from being unable to resume cruising when switching back to the first planned mode, and can also prevent the intelligent driving device from being trapped again after being out of trouble.
[0022] In combination with the first aspect, in certain implementations of the first aspect, the method also includes: when the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, determining that the intelligent driving device avoids the first obstacle according to the second planned path.
[0023] For example, the preset range of the second target posture may be a preset range of the center point of the second target posture, which may be a range of 2 meters from the center point of the second target posture, or may be other ranges.
[0024] In the above technical solution, a method for judging whether the escape is complete is provided, which helps to switch back to the first planning mode in time after the intelligent driving device escapes from trouble, reducing the time required for mode switching, so that when switching back to the first planning mode from the second planning mode, there is no need to control the intelligent driving device to stop driving, which helps to improve traffic efficiency and user experience.
[0025] In combination with the first aspect, in certain implementations of the first aspect, the method also includes: when the intelligent driving device avoids the first obstacle according to the second planned path, controlling the intelligent driving device to switch from driving along the second planned path to driving along a third planned path, and the third planned path is planned by the first planning mode.
[0026] In the above technical solution, when the intelligent driving device completes the escape from difficulty, switching back to the first planning mode for path planning helps to improve the planning capabilities for normal road conditions.
[0027] In combination with the first aspect, in certain implementations of the first aspect, the method further includes: when the intelligent driving device avoids the first obstacle according to the second planned path, controlling the prompt device to prompt to stop the second planning mode and / or start the first planning mode.
[0028] In the above technical solution, when the planning mode is switched, a prompt is given through the prompt device. When the driver of the intelligent driving device is in the loop, it helps the driver to know the current situation of the vehicle so as to take over the intelligent driving device in time.
[0029] In combination with the first aspect, in certain implementations of the first aspect, the method also includes: when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, the control prompt device prompts to stop the first planning mode and / or start the second planning mode.
[0030] In combination with the first aspect, in some implementations of the first aspect, the second planning mode includes a hybrid A* algorithm.
[0031] In the above technical solution, when the planning mode is switched, a prompt is given through the prompt device. When the driver of the intelligent driving device is in the loop, it helps the driver to know the current situation of the vehicle so as to take over the intelligent driving device in time.
[0032] In a second aspect, a control device is provided, which includes a first processing unit and a second processing unit, wherein the first processing unit is used to: control the intelligent driving device to travel along a first planned path, and the first planned path is planned by a first planning mode; the second processing unit is used to: when there is a first obstacle in the first planned path that makes the passable width corresponding to the first area less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, control the intelligent driving device to switch from traveling along the first planned path to traveling along the second planned path, the second planned path is planned by the second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
[0033] In combination with the second aspect, in certain implementations of the second aspect, the first area includes a head end and a tail end, the head end of the first area is an end close to the current position of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device; the second processing unit is used to: determine a first target posture of the intelligent driving device according to the first planned path; determine a second target posture according to the first target posture and the position of the first obstacle, the second target posture indicating the posture of the tail end of the intelligent driving device out of the first area; plan a second planned path according to the current posture of the intelligent driving device, the second target posture and the first obstacle.
[0034] In combination with the second aspect, in certain implementations of the second aspect, the second processing unit is also used to: determine a drivable area along the first planned path based on the first planned path; and plan a second planned path in the drivable area based on the current posture, the second target posture, and the first obstacle.
[0035] In combination with the second aspect, in certain implementations of the second aspect, the second processing unit is also used to: when the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, determine that the intelligent driving device avoids the first obstacle according to the second planned path.
[0036] In combination with the second aspect, in certain implementations of the second aspect, the second processing unit is also used to: when the intelligent driving device avoids the first obstacle according to the second planned path, control the intelligent driving device to switch from driving along the second planned path to driving along the third planned path, and the third planned path is planned by the first planning mode.
[0037] In combination with the second aspect, in certain implementations of the second aspect, the second processing unit is also used to: when the intelligent driving device avoids the first obstacle according to the second planned path, control the prompt device to prompt to stop the second planning mode and / or start the first planning mode.
[0038] In combination with the second aspect, in certain implementations of the second aspect, the second processing unit is also used to: when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, control the prompt device to prompt to stop the first planning mode and / or start the second planning mode.
[0039] In combination with the second aspect, in some implementations of the second aspect, the second planning mode includes a hybrid A* algorithm.
[0040] In a third aspect, a control device is provided, comprising: a memory for storing a computer program; and a processor for executing the computer program stored in the memory, so that the device executes the method in any possible implementation of the first aspect.
[0041] In a fourth aspect, an intelligent driving device is provided, which includes an apparatus as in any possible implementation of the second aspect or the third aspect.
[0042] In combination with the fourth aspect, in certain implementations of the fourth aspect, the intelligent driving device is a vehicle.
[0043] In a fifth aspect, a computer program product is provided, the computer program product comprising: a computer program code, when the computer program code is run on a computer, the computer executes the method in any possible implementation of the first aspect.
[0044] It should be noted that the above-mentioned computer program code may be stored in whole or in part on a first storage medium, wherein the first storage medium may be packaged together with the processor or may be packaged separately from the processor.
[0045] In a sixth aspect, a computer-readable medium is provided, wherein the computer-readable medium stores instructions, and when the instructions are executed by a processor, the processor implements the method in any possible implementation manner of the first aspect.
[0046] In a seventh aspect, a chip is provided, the chip comprising a circuit, the circuit being used to execute the method in any possible implementation manner of the first aspect above. BRIEF DESCRIPTION OF THE DRAWINGS
[0047] Figure 1 It is a functional block diagram of a vehicle provided in an embodiment of the present application;
[0048] Figure 2 is a schematic diagram of the system architecture required for implementing the control method provided in the embodiment of the present application;
[0049] Figure 3 is a schematic flow chart of a control method provided in an embodiment of the present application;
[0050] Figure 4 is a schematic diagram of a driving scenario involved in an embodiment of the present application;
[0051] Figure 5 is another schematic flow chart of the control method provided in the embodiment of the present application;
[0052] Figure 6 is a schematic diagram of another driving scenario involved in an embodiment of the present application;
[0053] Figure 7 It is a schematic diagram of a planning path provided by an embodiment of the present application;
[0054] Figure 8 is a schematic diagram of an HMI provided in an embodiment of the present application;
[0055] Fig. 9 is another schematic flow chart of the control method provided in the embodiment of the present application;
[0056] Fig.10 is a schematic block diagram of a control device provided in an embodiment of the present application;
[0057] Fig.11 This is another schematic block diagram of the control device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0058] To facilitate understanding of the technical solutions of the embodiments of the present application, the concepts involved in the present application are first introduced:
[0059] Trapped: refers to the state where the vehicle is blocked by obstacles and cannot move smoothly.
[0060] Escape: It means that the vehicle is freed from the state where it is blocked by obstacles and cannot move smoothly, so that it can continue to move.
[0061] Parking cruise: refers to the state in which the vehicle travels at a lower speed when the target parking position is not determined.
[0062] The technical solutions in the embodiments of the present application will be described below in conjunction with the accompanying drawings.
[0063] Figure 1 FIG. 1 is a functional block diagram of a vehicle provided in an embodiment of the present application. Figure 1As shown, the vehicle 100 may include a perception system 120, a display device 130 and a computing platform 150, wherein the perception system 120 may include several sensors for sensing information about the environment around the vehicle 100. For example, the perception system 120 may include a positioning system, and the positioning system may be a global positioning system (GPS), or a Beidou system or other positioning systems. For another example, the perception system 120 may also include one or more of an inertial measurement unit (IMU), a laser radar, a millimeter wave radar, an ultrasonic radar, and a camera device.
[0064] Some or all functions of the vehicle 100 may be controlled by a computing platform 150. The computing platform 150 may include processors 151 to 15n. The processor is a circuit with signal processing capability. In one implementation, the processor may be a circuit with instruction reading and execution capability, such as a central processing unit (CPU), a microprocessor, a graphics processing unit (GPU) (which may be understood as a microprocessor), or a digital signal processor (DSP). In another implementation, the processor may implement certain functions through the logical relationship of a hardware circuit, and the logical relationship of the hardware circuit may be fixed or reconfigurable, such as a hardware circuit implemented by an application-specific integrated circuit (ASIC) or a programmable logic device (PLD), such as a field programmable gate array (FPGA). In a reconfigurable hardware circuit, the process of the processor loading a configuration document to implement the hardware circuit configuration may be understood as the process of the processor loading instructions to implement the functions of some or all of the above units. In addition, the processor may also be a hardware circuit designed for artificial intelligence, which may be understood as an ASIC, such as a neural network processing unit (NPU), a tensor processing unit (TPU), a deep learning processing unit (DPU), etc. In addition, the computing platform 150 may also include a memory, the memory is used to store instructions, and some or all of the processors 151 to 15n may call the instructions in the memory to implement corresponding functions.
[0065] The display device 130 in the cockpit is mainly divided into two categories. The first category is the vehicle-mounted display screen; the second category is the projection display screen, such as a head up display (HUD). The vehicle-mounted display screen is a physical display screen and an important part of the vehicle-mounted infotainment system. Multiple display screens can be set in the cockpit, such as a digital instrument display screen, a central control screen, etc. Head-up display, also known as a head-up display system. It is mainly used to display driving information such as speed and navigation on a display device in front of the driver (such as a windshield). To reduce the driver's line of sight transfer time, avoid pupil changes caused by the driver's line of sight transfer, and improve driving safety and comfort. HUD, for example, includes a combined head-up display (combiner-HUD, C-HUD) system, a windshield head-up display (windshield-HUD, W-HUD) system, and an augmented reality head-up display system (augmented reality HUD, AR-HUD). The display device may also include the interactive system 130 and may also include a human machine interface (human machine interface, HMI) for prompting the user of the switching of the planning mode.
[0066] Vehicle 100 may include an advanced driving assistant system (ADAS), which utilizes a variety of sensors on the vehicle (including but not limited to: lidar, millimeter wave radar, camera, ultrasonic sensor, global positioning system, inertial measurement unit) to obtain information from the surroundings of the vehicle, and analyzes and processes the obtained information to achieve functions such as obstacle perception, target recognition, vehicle positioning, path planning, driver monitoring / reminder, etc., thereby improving the safety, automation and comfort of vehicle driving.
[0067] In terms of logical functions, ADAS systems generally include three main functional modules: perception module, decision module and execution module. The perception module perceives the environment around the vehicle body through sensors and inputs corresponding real-time data to the decision-making layer processing center. The perception module mainly includes on-board cameras / ultrasonic radars / millimeter-wave radars / lidar, etc.; the decision module uses computing devices and algorithms to make corresponding decisions based on the information obtained by the perception module; the execution module takes corresponding actions after receiving the decision signal from the decision module, such as driving, changing lanes, steering, braking, warnings, etc.
[0068] At different levels of autonomous driving (L0-L5), ADAS can achieve different levels of autonomous driving assistance based on artificial intelligence algorithms and information obtained by multiple sensors. The above autonomous driving levels (L0-L5) are based on the grading standards of the Society of Automotive Engineers (SAE). Among them, L0 is no automation; L1 is driving assistance; L2 is partial automation; L3 is conditional automation; L4 is highly automated; L5 is fully automated. The tasks of monitoring road conditions and responding to L1 to L3 are completed by the driver and the system together, and the driver needs to take over the dynamic driving tasks. L4 and L5 levels allow the driver to completely transform into the role of a passenger. At present, the functions that ADAS can achieve mainly include but are not limited to: adaptive cruise, automatic emergency braking, automatic parking, blind spot monitoring, front intersection traffic warning / braking, rear intersection traffic warning / braking, front vehicle collision warning, lane departure warning, lane keeping assist, rear vehicle collision avoidance warning, traffic sign recognition, traffic congestion assistance, highway assistance, etc. It should be understood that the above-mentioned various functions may have specific modes under different autonomous driving levels (L0-L5), and the higher the level of autonomous driving, the smarter the corresponding mode. For example, automatic parking may include APA, RPA, and AVP. For APA, the driver does not need to operate the steering wheel, but the driver is still required to operate the vehicle in real time to monitor the vehicle status; for RPA, the driver can use a terminal (such as a mobile phone) to remotely park the vehicle outside the vehicle; for AVP, the vehicle can complete parking without a driver. In terms of the corresponding autonomous driving level, APA is approximately at the L2 level, RPA is approximately at the L2-L3 level, and AVP is approximately at the L4 level.
[0069] In an embodiment of the present application, the computing platform 150 can switch the motion planning mode according to the obstacle information in the driving path of the vehicle 100 obtained by the perception system 120, thereby improving the vehicle's travel efficiency and parking efficiency.
[0070] Figure 2 FIG. 1 is a schematic diagram showing a control system architecture provided by an embodiment of the present application. Figure 2 As shown, the system includes a perception module 210, an obstacle detection module 220, a motion planning module 230, a motion control module 240 and an actuator 250. The perception module 210 may include Figure 1 The one or more sensors in the perception system 120 shown, the obstacle detection module 220, the motion planning module 230, and the motion control module 240 can be respectively Figure 1 One or more processors in computing platform 150 are shown.
[0071] The perception module 210 is used to collect environmental information around the vehicle, which includes information such as the location and type of obstacles around the vehicle. The perception module 210 can input the obstacle information into the obstacle detection module 220 and the motion planning module 230.
[0072] The obstacle detection module 220 can determine the passable width of the vehicle's current driving path based on the obstacle information collected by the perception module 210, so that the motion planning module 230 determines the planning mode based on the passable width of the vehicle's current driving path.
[0073] The motion planning module 230 includes a normal mode planning module 231 and an escape mode planning module 232. Among them, the normal mode planning module 231 can plan a driving path based on an existing algorithm (for example, the current parking cruise algorithm) when the passable width of the driving path is greater than a preset threshold value 1. The escape mode planning module 232 can include a target posture generation module, a drivable area generation module, a path planning module and an end judgment module. The escape mode planning module 232 can plan a driving path for the vehicle when the passable width of the driving path is less than or equal to the preset threshold value 1. It should be noted that the planning capabilities of the normal mode planning module 231 and the escape mode planning module 232 are different. For example, the normal mode planning module 231 can generally only perform forward path planning, and the planning capability is weak for areas that require multiple reversing to avoid obstacles (such as areas with narrow feasible roads and areas with complex obstacle locations).
[0074] The motion control module 240 can calculate the corresponding control amount according to the path planned by the motion planning module 230, and output the control amount to the actuator 250. When the actuator 250 executes the control amount, the vehicle is controlled to travel along the planned path. In some possible implementations, the actuator may include a steering and braking control system in the vehicle 100.
[0075] Exemplarily, when the vehicle is traveling according to the driving path 1 planned by the conventional mode planning module 231, and the obstacle detection module 220 determines that the passable width of the driving path ahead of the vehicle is less than or equal to the preset threshold 1, the motion control module 240 controls the vehicle to stop, and the motion planning module 230 switches to the escape mode planning module 232 for path planning. Specifically, the target posture generation module can generate one or more target postures according to the driving path 1 and / or the position of the obstacle, and perform collision detection according to the obstacle detected by the perception module 210, and select the target posture 1 that can pass through the position of the obstacle and does not collide with the obstacle from one or more target postures; the drivable area generation module generates a drivable area according to the driving path 1 and the obstacles detected by the perception module 210; the path planning module generates a driving path 2 for the vehicle in the drivable area according to the target posture 1 and the posture of the vehicle when it is parked, and inputs the driving path 2 into the motion control module 240 to control the vehicle to travel along the driving path 2. When the vehicle is traveling along the driving path 2, the end judgment module monitors the driving position of the vehicle. When it is determined that the vehicle passes a position where the passable width is less than or equal to the preset threshold 1, the motion planning module 230 switches from the escape module planning module 232 back to the normal mode planning module 231 to continue path planning.
[0076] It should be understood that the above modules are only examples, and in actual applications, the above modules may be added or deleted according to actual needs. Figure 2 In the system architecture shown in , the motion planning module 230 and the motion control module 240 can be combined into one module; or, the obstacle detection module 220 and the motion planning module 230 can be combined into one module. For another example, the above system also includes a prompt module, which receives information from the motion planning module 230. When the motion planning module 230 switches modes, the prompt module sends prompt information to prompt the occurrence of mode switching.
[0077] Figure 3 The schematic flow chart of the control method provided by the embodiment of the present application is shown in FIG. Figure 1 In the vehicle shown, or the method can be performed by Figure 2 Exemplarily, the following takes the method being executed by a computing platform of a vehicle as an example for explanation, and the method 300 may include:
[0078] S301, controlling a vehicle to travel along a first path based on a first planning mode, and detecting obstacles in the first path.
[0079] Exemplarily, the first planning mode may be a mode for performing path planning through the conventional mode planning module 231 , and the first path may include the driving path 1 .
[0080] In one example, when planning a driving path for a vehicle in the first planning mode, the planning can be performed based on a map stored in the vehicle. For example, when a vehicle is parked in a parking lot, if a map of the parking lot is stored in the vehicle, the vehicle can perform a first path planning based on the map and the parking conditions of each parking space collected by the vehicle in real time.
[0081] In another example, when planning a driving path for a vehicle in the first planning mode, the planning can be performed based on the surrounding environment information collected by the vehicle in real time. For example, when a vehicle is parked in a parking lot, the vehicle's sensor can collect environmental information within 200 meters in front of the vehicle, and the vehicle can plan a path from the current position of the vehicle to 200 meters in front based on the environmental information. This path can be regarded as an example of the first path.
[0082] It should be noted that the first path refers to the path from the current location of the vehicle to the destination of the vehicle, wherein the destination of the vehicle may be the final destination of the vehicle, or may be a place that the vehicle passes through when traveling to the final destination.
[0083] S302, when the first obstacle makes the passable width of a certain area of the first path less than or equal to the preset threshold 1, or when the first obstacle makes the curvature of the feasible path of a certain area of the first path greater than or equal to the preset threshold 2, switch to the second planning mode to plan the vehicle's planned driving path.
[0084] Exemplarily, the first obstacle is an obstacle in the first path, and the second planning mode may be a mode for performing path planning through the escape mode planning module 232 .
[0085] For example, the preset threshold 1 may be 2.5 meters, or 2.3 meters, or other values, such as the actual width of the vehicle. The preset threshold 2 may be 0.01, or 0.1, or other values.
[0086] It should be noted that a certain section of the first path may not be part of the path planned for the vehicle, and the section presents a special shape due to the presence of the first obstacle. A certain section of the first path can be understood as: the first path includes this section, or the vehicle must pass through this section in order to reach the destination from the current position. For example, the first path is a path planned according to the current position and destination of the vehicle, and the influence of obstacles is not considered in the path planning process. However, due to the presence of obstacles in a certain area of the first path, the passable width is too small or the curvature of the feasible path is too large, so that when the vehicle travels along the first path to this point, it is blocked by obstacles and cannot pass at the planned speed and path.
[0087] like Figure 4 As shown in (a), the driving path planned for vehicle 401 is path 405 or path 406. Due to the existence of vehicles 402, 403, and 404, the passable width of area 407 is small, and vehicle 401 may be blocked when driving to area 407 and cannot drive at the planned speed. Among them, path 405 or path 406 can be regarded as a first path, and area 407 can be regarded as a certain area passed by the above-mentioned first path.
[0088] like Figure 4 As shown in (b), the driving path planned for vehicle 410 is path 411, which passes through obstacle 412. In other words, due to the existence of obstacle 412, vehicle 410 may be blocked when driving to obstacle 412 and cannot drive at the planned speed. However, in order to move forward, vehicle 410 must pass through area 414. At this time, area 414 can be regarded as a certain area of the first path mentioned above.
[0089] Hereinafter, a certain area passed by the first path is referred to as the first area. The first area includes a head end and a tail end, the head end of the first area is the end close to the current position of the vehicle, and the tail end of the first area is the end close to the destination of the vehicle.
[0090] When the vehicle travels to the head end of the first area, the vehicle may stop due to being blocked by the first obstacle, so the position coordinates of the vehicle when it stops are recorded, and the second mode is switched to plan a driving path for the vehicle.
[0091] S303: Plan a second path through a second planning mode so that the vehicle can avoid the first obstacle when traveling along the second path.
[0092] In some possible implementations, when the passable width corresponding to the first area is less than or equal to a preset threshold 1 and greater than or equal to a preset threshold 3, a second path is planned according to the first path and the first obstacle. The preset threshold 3 may be the width of the vehicle, or may be another value greater than the width of the vehicle.
[0093] In some possible implementations, when the passable width corresponding to the first area is less than or equal to a preset threshold value 1 and less than a preset threshold value 3, in the second planning mode, a path is replanned for the vehicle according to the position of the first obstacle.
[0094] In some possible implementations, the second path includes a head end and a tail end, the head end of the second path is the starting end of the path, the tail end of the second path coincides with the tail end of the first area, or the tail end of the second path is closer to the vehicle's destination than the tail end of the first area.
[0095] S304, when the vehicle is controlled to travel along the second path, switch to the first planning mode and continue to plan a travel path for the vehicle.
[0096] Exemplarily, when the vehicle reaches the end of the second path, it is determined that the vehicle has completed traveling along the second path, and at this time, the first planning mode is switched to continue planning the driving path for the vehicle.
[0097] The following combination Figure 5 The specific method of planning the second path in the second planning mode is described. Figure 5 As shown, the method 500 may include:
[0098] S501, generating a target posture according to a first path.
[0099] Exemplarily, when the target posture generation module receives the indication information that the vehicle stops due to being blocked by an obstacle, the target posture is generated according to the first path. Exemplarily, when the vehicle stops due to being blocked by an obstacle, the state machine in the motion control module changes to a stuck flag, and the indication information may include the stuck flag of the state machine.
[0100] Exemplarily, when the vehicle stops due to being blocked by a first obstacle, one or more target postures are generated according to the position of the first obstacle and the first path. For example, a target posture is generated in which the longitudinal axis is parallel to the tangent of the first path at the first position, and the center point of the target posture is the first position. Among them, the first position is a position in the first path that is located after the first obstacle, and the position after the first obstacle can be understood as the side closer to the destination of the vehicle. For another example, multiple target postures are generated in which the longitudinal axis is parallel to the tangent of the first path at the first position. For another example, multiple postures are generated in which the longitudinal axis is parallel to the tangent of the first path at different positions, and the different positions are all located after the first obstacle and may include the first position.
[0101] In some possible implementations, the target posture may also be generated according to the distribution information of the first obstacle.
[0102] Among them, the longitudinal axis of the target posture is parallel to the longitudinal symmetry plane of the vehicle (or called the Y reference plane).
[0103] S502, performing a collision check on the target posture, and performing feasibility verification on the target posture that passes the collision check.
[0104] Exemplarily, a collision check may be performed on each of the one or more target postures, that is, to determine whether the vehicle will collide with the first obstacle when in the target posture.
[0105] For example, collision detection may be performed using a GJK (Gilbert–Johnson–Keerthi) algorithm, or using a separating axis theorem (SAT), or other methods may be used for collision detection.
[0106] Furthermore, feasibility verification is performed on one or more target postures that pass the collision detection.
[0107] It should be noted that in the embodiment of the present application, feasibility verification refers to verifying whether the target posture is passable, or verifying whether the target posture can reach the end of the first area. When the feasibility verification is passed, it means that the first obstacle will not affect the vehicle from the first end of the first area to the end of the first area.
[0108] S503: Determine whether the feasibility verification of the target posture has passed.
[0109] Specifically, when the feasibility verification of the target posture passes, execute S505; otherwise, execute S504.
[0110] For example, the feasibility of the target posture can be verified by a fast A* detection algorithm, that is, whether the vehicle can drive out of the tail end of the first area with a certain target posture.
[0111] For example, when the target posture 1 passes the feasibility verification, the target posture 1 can be used as the escape target posture to plan the second path. The target posture 1 is one of the one or more target postures mentioned above.
[0112] It should be noted that the escape target posture indicates the posture of the vehicle when it leaves the rear end of the first area.
[0113] S504: Adjust the lateral position and / or longitudinal position of the target posture.
[0114] Exemplarily, for a target posture that does not satisfy the collision check or does not pass the feasibility verification, an adjustment is performed by first lateral translation and then longitudinal translation to avoid the first obstacle.
[0115] S505 : Determine virtual boundary 1 and virtual boundary 2 according to the first path.
[0116] Exemplarily, virtual boundary 1 and virtual boundary 2 are respectively generated at preset distances on both sides of the first path.
[0117] Exemplarily, the preset distance may be 2 meters, or 2.5 meters, or other values.
[0118] S506, eliminating abnormal boundary points with large curvature angles.
[0119] In some possible implementations, the first region includes a large curvature angle, and abnormal boundary points may exist when generating the virtual boundary. In this case, the abnormal boundary points need to be eliminated to generate a continuous virtual boundary.
[0120] S507 , mapping the virtual boundary 1 and the virtual boundary 2 to the obstacle map, and the area between the virtual boundary 1 and the virtual boundary 2 is a drivable area.
[0121] Exemplarily, the virtual boundary 1 and the virtual boundary 2 are mapped in the obstacle map as virtual obstacles, so that the drivable area of the vehicle can be limited to the area during planning.
[0122] It should be noted that after the virtual boundary 1 and the virtual boundary 2 are mapped in the obstacle map, the virtual boundary and the first obstacle constitute a new obstacle. When the vehicle performs path planning, the path planning needs to be performed according to the position of the new obstacle.
[0123] Vehicle 600 in Figure 6 When driving in the parking lot shown in (a) of FIG. 1 , a driving path 601 is planned for the vehicle 600 in the first planning mode. However, due to the presence of obstacles on both sides of the driving path 601, the vehicle 600 drives to Figure 6 At the position shown in (b) of FIG. 6 , the vehicle 600 is blocked by an obstacle and stops. At this time, the vehicle 600 switches to the second planning mode to continue planning, and generates a virtual boundary 602 and a virtual boundary 603 according to the driving path 601. Exemplarily, when the virtual boundary 602 and the virtual boundary 603 are mapped in the obstacle map, the obstacle map may include both the virtual boundary and the obstacle boundary (such as obstacle boundaries 604 and 605).
[0124] S508: Plan a second path in the drivable area according to the first obstacle.
[0125] Exemplarily, according to the current posture of the vehicle and the target posture 1 determined in S503 , a second path of the vehicle is planned in the drivable area.
[0126] In one example, the second path can be generated by a hybrid A* algorithm. For example, the open list and the closed list are initialized first, and the node to be expanded calculated by the vehicle kinematic constraints is generated offline as the state increment of the current node. The current posture of the vehicle is added to the open list, the node to be expanded is expanded by kinematic constraints and obstacle avoidance constraints (such as virtual boundary 1, virtual boundary 2 and the first obstacle), the parent node is set as the current node, and the starting point is deleted from the open list and added to the closed list. Then repeat the following steps: first calculate the evaluation function value of all nodes in the open list, select the node with the smallest value as the new expansion node, remove it from the open list and add it to the closed list; check the node that can be expanded by the vehicle kinematic constraints, and at the same time meet the non-collision obstacle, and is not in the closed list. If the node to be expanded is not in the open list, it is added to the open list and the current node is set as the parent node; if the node to be expanded is already in the open list, the evaluation function value of the node to be expanded under the expansion method is calculated, compared with the original evaluation function value and the smaller of the two is taken, and the parent node is updated. The completion condition of the repeated steps is that if the node to be expanded falls within a certain range of the target posture 1, the search can be regarded as successful; if the completion condition is not met until the open list is empty, it will fail and exit.
[0127] In another example, the second path can be generated by geometric methods. For example, the connection from the current posture of the vehicle to the target posture 1 is achieved by splicing multiple straight lines and arcs. The variables of the target posture 1 include the horizontal coordinate, the vertical coordinate and the heading angle. The geometric relationship between the variables after the straight line and the arc are described, and a set of linear equations is established to solve the length and splicing method of the straight line and the arc. The splicing modes of straight lines and arcs include straight line-arc, arc-straight line, straight line-arc-straight line, etc. If the path from the current posture to the target posture 1 cannot be planned at one time, it is still necessary to find an intermediate posture, divide and conquer the entire problem, and obtain a complete path by solving sub-problems. For example, the first area is segmented to obtain multiple segments, and a path is generated for each segment in the multiple segments by geometric methods. The paths in the multiple segments are spliced to obtain the second path.
[0128] For example, Figure 7 As shown, in the drivable area formed by the virtual boundary 602 and the virtual boundary 603 , the second path planned according to the first obstacle may be as shown by path 606 .
[0129] S509, when controlling the vehicle to travel along the second path, monitoring the driving state of the vehicle to determine whether the vehicle has completed the escape from trouble.
[0130] In a possible implementation, an end circle criterion or an end line criterion is designed, and when the vehicle's posture satisfies the end circle criterion or the end line criterion, it is determined that the vehicle has completed its escape from trouble.
[0131] For example, the end circle criterion may be: when the vehicle enters a certain range of the target posture 1, it is determined that the vehicle has escaped from the distress. The certain range may be a range of 2 meters from the center of the target posture 1, or may be another range. The end line criterion may be: when the vehicle passes the target posture 1, it is determined that the vehicle has escaped from the distress.
[0132] In some possible implementations, when it is determined that the vehicle has completed its escape from distress, the mode is switched back to the first planning mode to continue planning a driving path for the vehicle.
[0133] It should be noted that in the specific implementation process, it is not necessary to execute Figure 5 All operations in, for example, S504 and / or S506 may not be executed. In addition, Figure 5 The operations shown may also not be executed in the order shown in the figure, for example, S505 to S507 may be executed simultaneously with S501 to S504.
[0134] The control method provided in the embodiment of the present application provides two path planning modes. During the driving process of the vehicle, the mode is switched according to the actual road conditions, which not only helps to reduce the computing power required for path planning, but also helps to improve the vehicle's ability to escape from difficulties. In particular, during the AVP parking process, it can reduce the probability that the vehicle cannot perform path planning due to narrow passages or scenes with complex obstacle positions, which helps to improve the success rate of AVP parking.
[0135] In some possible implementations, when the vehicle switches modes, the user may be prompted to switch modes through an HMI or a sound device such as a speaker or a sound box. Figure 8 As shown in (a) of FIG. 1 , during the parking process of the vehicle, when the first planning mode (such as the normal mode) is about to be switched to the second planning mode (such as the escape mode), the central control screen may display “! About to switch to the escape mode parking” as a reminder. Figure 8 As shown in (b) of FIG. 1 , when the vehicle is out of trouble and is about to switch from the second planning mode back to the first planning mode, the central control screen may display “! Out of trouble completed, about to switch to normal parking mode” as a reminder. It should be understood that Figure 8 The illustration is only an exemplary description, and in a specific implementation, a prompt may also be given after the mode is switched.
[0136] Fig. 9 A schematic flow chart of a control method provided by an embodiment of the present application is shown. The method can be applied to an intelligent driving device, and the method 900 may include:
[0137] S901, control the intelligent driving device to travel along a first planned path, where the first planned path is a path planned by a first planning mode.
[0138] Exemplarily, the intelligent driving device includes the vehicle in the above embodiment, the first planned path includes the first path in the above embodiment, and the first planning mode includes the first planning mode in the above embodiment.
[0139] S902: When there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to the first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to the second preset threshold, control the intelligent driving device to switch from driving along the first planned path to driving along the second planned path, the second planned path is planned by the second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
[0140] Exemplarily, the second planning mode includes the second planning mode in the above embodiment, and the second planning path includes the second path in the above embodiment.
[0141] Exemplarily, the first area includes the first area in the above embodiment, the first area includes a head end and a tail end, the head end of the first area is an end close to the current location of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device.
[0142] In some possible implementations, the method also includes: determining a first target posture of the intelligent driving device based on the first planned path; determining a second target posture based on the first target posture and the position of the first obstacle, the second target posture indicating the posture of the tail end of the intelligent driving device when it exits the first area; and planning a second path based on the current posture of the intelligent driving device, the second target posture, and the first obstacle.
[0143] Exemplarily, the first target posture may include the target posture generated in S501, and the second target posture may include target posture 1. The specific method of determining the second target posture according to the first target posture and the position of the first obstacle can refer to the description in S502 and S503, which will not be repeated here.
[0144] In some possible implementations, the method also includes: determining a drivable area along the first planned path based on the first planned path; planning a second planned path based on the current posture and the second target posture of the intelligent driving device, including: planning the second planned path in the drivable area based on the current posture, the second target posture and the first obstacle.
[0145] For example, the specific method of planning the second planned path in the drivable area can refer to the description in S508, which will not be repeated here.
[0146] In some possible implementations, when the intelligent driving device avoids the first obstacle according to the second planned path, the intelligent driving device is controlled to switch from driving along the second planned path to driving along a third planned path, and the third planned path is planned by the first planning mode.
[0147] Exemplarily, when the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, it is determined that the intelligent driving device avoids the first obstacle according to the second planned path.
[0148] In some possible implementations, the method further includes: when the intelligent driving device avoids the first obstacle according to the second planned path, controlling the prompt device to prompt to stop the second planning mode and / or start the first planning mode.
[0149] In some possible implementations, the method further includes: when there is a first obstacle in the first planned path that makes the passable width corresponding to the first area less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, the control prompt device prompts to stop the first planning mode and / or start the second planning mode.
[0150] The specific prompting method of the above prompting device can be referred to Figure 8 The description of the corresponding parts will not be repeated here.
[0151] The control method provided in the embodiment of the present application helps to improve the escape capability of the automatic parking function, reduce the probability that the vehicle cannot plan a path due to narrow roads or complex road conditions, and improve the parking success rate. Through the above method, the escape function can be automatically triggered when the vehicle is stuck in a narrow channel with large curvature, without the need to identify a specific scene, and has wide applicability in complex scenes.
[0152] Combined with the above Figures 1 to 9 The method provided in the embodiment of the present application is described in detail. Fig.10 and Fig.11 The device provided in the embodiment of the present application is described in detail. It should be understood that the description of the device embodiment corresponds to the description of the method embodiment, so the contents not described in detail can be referred to the method embodiment above, and for the sake of brevity, they will not be repeated here.
[0153] Fig.10A schematic block diagram of a control device 2000 provided in an embodiment of the present application is shown, and the device 2000 includes a first processing unit 2010 and a second processing unit 2020. The first processing unit 2010 is used to control the intelligent driving device to travel along a first planned path, and the first planned path is obtained by planning the first planning mode; the second processing unit 2020 is used to control the intelligent driving device to switch from traveling along the first planned path to traveling along the second planned path when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to the first preset threshold, and / or when the first obstacle causes the curvature of the feasible path in the first area to be greater than or equal to the second preset threshold. The second planned path is obtained by planning the second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
[0154] Optionally, the first area includes a head end and a tail end, the head end of the first area is an end close to the current position of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device; the second processing unit 2020 is used to: determine a first target posture of the intelligent driving device according to the first planned path; determine a second target posture according to the first target posture and the position of the first obstacle, the second target posture indicating the posture of the tail end of the intelligent driving device out of the first area; plan a second planned path according to the current posture of the intelligent driving device, the second target posture and the first obstacle.
[0155] Optionally, the second processing unit 2020 is further used to: determine a drivable area along the first planned path according to the first planned path; and plan a second planned path in the drivable area according to the current posture, the second target posture and the first obstacle.
[0156] Optionally, the second processing unit 2020 is further used to: when the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, determine that the intelligent driving device avoids the first obstacle according to the second planned path.
[0157] Optionally, the second processing unit 2020 is also used to: when the intelligent driving device avoids the first obstacle according to the second planned path, control the intelligent driving device to switch from driving along the second planned path to driving along a third planned path, and the third planned path is planned by the first planning mode.
[0158] Optionally, the second processing unit 2020 is also used to: when the intelligent driving device avoids the first obstacle according to the second planned path, control the prompt device to prompt to stop the second planning mode and / or start the first planning mode.
[0159] Optionally, the second processing unit 2020 is also used to: when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, control the prompt device to prompt to stop the first planning mode and / or start the second planning mode.
[0160] Optionally, the second planning mode includes a hybrid A* algorithm.
[0161] For example, the first processing unit 2010 and the second processing unit 2020 may be arranged in Figure 2 In the system shown in FIG. 1 , more specifically, the first processing unit 2010 may be disposed in the obstacle detection module 220, and the second processing unit 2020 may be disposed in the motion planning module 230. For example, the operations performed by the first processing unit 2010 and the second processing unit 2020 may be performed by one processor, or may be performed by different processors. In a specific implementation process, the one or more processors may be disposed in Figure 1 The processor in the vehicle 100 is shown; alternatively, the device 2000 may be a chip disposed in the vehicle 100 .
[0162] In the specific implementation process, all or part of the units in the above device can be integrated together, or can be implemented independently. In one implementation, these units are integrated together and implemented in the form of a system-on-a-chip (SoC).
[0163] Fig.11 It is a schematic block diagram of a control device provided in an embodiment of the present application. Fig.11 The control device 2100 shown may include: a processor 2110, a transceiver 2120, and a memory 2130. The processor 2110, the transceiver 2120, and the memory 2130 are connected via an internal connection path, the memory 2130 is used to store instructions, and the processor 2110 is used to execute the instructions stored in the memory 2130 to implement the methods in the above embodiments. Optionally, the memory 2130 may be coupled to the processor 2110 via an interface, or may be integrated with the processor 2110.
[0164] It should be noted that the transceiver 2120 may include but is not limited to a transceiver device such as an input / output interface to achieve communication between the device 2100 and other devices or a communication network.
[0165] The memory 2130 may be a read only memory (ROM), a static storage device, a dynamic storage device or a random access memory (RAM).
[0166] The transceiver 2120 uses a transceiver device such as but not limited to a transceiver to implement communication between the device 2100 and other devices or a communication network to receive / send data / information used to implement the methods in the above embodiments.
[0167] In the specific implementation process, the device 2100 can be set at Figure 2 In the smart device 100 shown.
[0168] An embodiment of the present application also provides an intelligent driving device, which includes the above-mentioned device 2000 or the above-mentioned device 2100.
[0169] The intelligent driving equipment involved in this application may include road vehicles, water vehicles, air vehicles, industrial equipment, agricultural equipment, or entertainment equipment, etc. For example, the intelligent driving equipment may be a vehicle, which is a vehicle in a broad sense, and may be a vehicle (such as a commercial vehicle, a passenger car, a motorcycle, a flying car, a train, etc.), an industrial vehicle (such as a forklift, a trailer, a tractor, etc.), an engineering vehicle (such as an excavator, a bulldozer, a crane, etc.), agricultural equipment (such as a mower, a harvester, etc.), amusement equipment, a toy vehicle, etc. The embodiment of this application does not specifically limit the type of vehicle. For another example, the vehicle may be a vehicle such as an airplane or a ship.
[0170] An embodiment of the present application further provides a computer program product, which includes a computer program code. When the computer program code runs on a computer, the computer implements the methods in the above embodiments of the present application.
[0171] An embodiment of the present application further provides a computer-readable storage medium, which stores computer instructions. When the computer instructions are executed on a computer, the computer implements the methods in the above embodiments of the present application.
[0172] An embodiment of the present application also provides a chip, including a circuit, for executing the methods in the above embodiments of the present application.
[0173] In the implementation process, each step of the above method can be completed by an integrated logic circuit of hardware in a processor or an instruction in the form of software. The method disclosed in conjunction with the embodiment of the present application can be directly embodied as a hardware processor for execution, or a combination of hardware and software modules in a processor for execution. The software module can be located in a storage medium mature in the art such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory, or a power-on erasable programmable memory, a register, etc. The storage medium is located in a memory, and the processor reads the information in the memory and completes the steps of the above method in conjunction with its hardware. To avoid repetition, it is not described in detail here.
[0174] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.
[0175] In the description of the embodiments of the present application, unless otherwise specified, " / " means or, for example, A / B can mean A or B; "and / or" in this article is a kind of association relationship that describes associated objects, indicating that three relationships can exist, for example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone. In this application, "at least one" means one or more, and "multiple" means two or more. "At least one of the following items" or similar expressions refers to any combination of these items, including any combination of single items or plural items. For example, at least one of a, b, or c can mean: a, b, c, ab, ac, bc, or abc, where a, b, c can be single or multiple.
[0176] The prefixes such as "first" and "second" used in the embodiments of the present application are only used to distinguish different description objects, and have no limiting effect on the position, order, priority, quantity or content of the described objects. The use of prefixes such as ordinal numbers used to distinguish description objects in the embodiments of the present application does not constitute a limitation on the described objects. For the statement of the described objects, please refer to the description in the context of the claims or embodiments, and the use of such prefixes should not constitute an unnecessary limitation.
[0177] In the several embodiments provided in the present application, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0178] In the various embodiments of the present application, unless otherwise specified or logically conflicting, the terms and / or descriptions between the various embodiments are consistent and can be referenced to each other, and the technical features in different embodiments can be combined to form new embodiments according to their inherent logical relationships.
[0179] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0180] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
[0181] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art who is familiar with the present technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.
Claims
1. A control method, characterized in that: include: Controlling the intelligent driving device to travel along a first planned path, where the first planned path is planned by a first planning mode; When there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, the intelligent driving device is controlled to switch from driving along the first planned path to driving along the second planned path, the second planned path is planned by a second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
2. The method according to claim 1, characterized in that The first area includes a head end and a tail end, the head end of the first area is an end close to the current location of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device; The method further comprises: Determine a first target position of the intelligent driving device according to the first planned path; Determining a second target posture according to the first target posture and the position of the first obstacle, wherein the second target posture indicates the posture of the tail end of the intelligent driving device when the intelligent driving device exits the first area; The second planned path is planned according to the current posture of the intelligent driving device, the second target posture, and the first obstacle.
3. The method according to claim 2, characterized in that The method further comprises: Determining a drivable area along the first planned path according to the first planned path; The planning of the second planned path according to the current posture of the intelligent driving device and the second target posture includes: The second planned path is planned in the drivable area according to the current posture, the second target posture and the first obstacle.
4. The method according to claim 2, characterized in that: The method further comprises: When the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, it is determined that the intelligent driving device avoids the first obstacle according to the second planned path.
5. The method according to any one of claims 1 to 4, characterized in that The method further comprises: When the intelligent driving device avoids the first obstacle according to the second planned path, the intelligent driving device is controlled to switch from driving along the second planned path to driving along a third planned path, where the third planned path is planned by the first planning mode.
6. The method according to claim 5, characterized in that The method further comprises: When the intelligent driving device avoids the first obstacle according to the second planned path, the control prompt device prompts to stop the second planning mode and / or start the first planning mode.
7. The method according to any one of claims 1 to 6, characterized in that The method further comprises: When there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to the first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to the second preset threshold, the control prompt device prompts to stop the first planning mode and / or start the second planning mode.
8. The method according to any one of claims 1 to 7, characterized in that The second planning mode includes a hybrid A* algorithm.
9. A control device, characterized in that: It includes a first processing unit and a second processing unit, wherein: The first processing unit is used to: control the intelligent driving device to travel along a first planned path, where the first planned path is planned by a first planning mode; The second processing unit is used to control the intelligent driving device to switch from driving along the first planned path to driving along the second planned path when there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to a first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to a second preset threshold, the second planned path is planned by a second planning mode, the first planning mode and the second planning mode are different, and the first planned path passes through the first area.
10. The device according to claim 9, characterized in that The first area includes a head end and a tail end, the head end of the first area is an end close to the current location of the intelligent driving device, and the tail end of the first area is an end close to the destination of the intelligent driving device; The second processing unit is used for: Determine a first target position of the intelligent driving device according to the first planned path; Determining a second target posture according to the first target posture and the position of the first obstacle, wherein the second target posture indicates the posture of the tail end of the intelligent driving device when the intelligent driving device exits the first area; The second planned path is planned according to the current posture of the intelligent driving device, the second target posture, and the first obstacle.
11. The device according to claim 10, characterized in that The second processing unit is further configured to: Determining a drivable area along the first planned path according to the first planned path; The second planned path is planned in the drivable area according to the current posture, the second target posture and the first obstacle.
12. The device according to claim 10, characterized in that The second processing unit is further configured to: When the intelligent driving device enters a preset range of the second target posture, or when the intelligent driving device passes the second target posture, it is determined that the intelligent driving device avoids the first obstacle according to the second planned path.
13. The device according to any one of claims 9 to 12, characterized in that The second processing unit is further configured to: When the intelligent driving device avoids the first obstacle according to the second planned path, the intelligent driving device is controlled to switch from driving along the second planned path to driving along a third planned path, where the third planned path is planned by the first planning mode.
14. The device according to claim 13, characterized in that The second processing unit is further configured to: When the intelligent driving device avoids the first obstacle according to the second planned path, the control prompt device prompts to stop the second planning mode and / or start the first planning mode.
15. The device according to any one of claims 9 to 14, characterized in that The second processing unit is further configured to: When there is a first obstacle in the first planned path so that the passable width corresponding to the first area is less than or equal to the first preset threshold, and / or when the first obstacle makes the curvature of the feasible path in the first area greater than or equal to the second preset threshold, the control prompt device prompts to stop the first planning mode and / or start the second planning mode.
16. The device according to any one of claims 9 to 15, characterized in that The second planning mode includes a hybrid A* algorithm.
17. A control device, characterized in that: include: Memory for storing computer programs; A processor, configured to execute the computer program stored in the memory, so that the apparatus performs the method according to any one of claims 1 to 8.
18. An intelligent driving device, characterized in that: The intelligent driving device comprises the apparatus as claimed in any one of claims 9 to 17.
19. A computer-readable storage medium, characterized in that: Instructions are stored thereon, and when the instructions are executed by a processor, the processor implements the method according to any one of claims 1 to 8.
20. A chip, characterized in that: The chip comprises a circuit for executing the method according to any one of claims 1 to 8.
Citation Information
Patent Citations
Apparatus and method for controlling driving of vehicle
CN104276175A
Parking path planning method, parking path planning device, vehicle and storage medium
CN113985871A
Unmanned aerial vehicle moving platform target searching method and system
CN115047917A
Path planning method and device for self-driving vehicle to get out of trouble and storage medium
CN115562280A
Apparatus and method for establishing dual path plan and determining road determination area for autonomous driving
US20200166352A1
Cited By
Control method and apparatus, and intelligent driving device
EP4711718A1