WO2022205617A1 - 一种导航方法、装置、电子设备及存储介质 - Google Patents

一种导航方法、装置、电子设备及存储介质 Download PDF

Info

Publication number
WO2022205617A1
WO2022205617A1 PCT/CN2021/098686 CN2021098686W WO2022205617A1 WO 2022205617 A1 WO2022205617 A1 WO 2022205617A1 CN 2021098686 W CN2021098686 W CN 2021098686W WO 2022205617 A1 WO2022205617 A1 WO 2022205617A1
Authority
WO
WIPO (PCT)
Prior art keywords
lane
navigation
target
intersection
point
Prior art date
Application number
PCT/CN2021/098686
Other languages
English (en)
French (fr)
Inventor
李文强
刘余钱
Original Assignee
上海商汤临港智能科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 上海商汤临港智能科技有限公司 filed Critical 上海商汤临港智能科技有限公司
Priority to KR1020227029065A priority Critical patent/KR20220137034A/ko
Publication of WO2022205617A1 publication Critical patent/WO2022205617A1/zh

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • G01C21/3415Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3446Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/25Data precision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle for navigation systems

Definitions

  • the present disclosure relates to the technical field of vehicle navigation, and in particular, to a navigation method, an apparatus, an electronic device, and a storage medium.
  • a driverless car also called an autonomous car, refers to a car that can perceive the surrounding environment and drive autonomously without human participation.
  • the driverless car usually needs to rely on a pre-built high-precision map to assist with positioning and navigation. How to efficiently determine the navigation route in real time based on high-precision maps has become an urgent problem to be solved.
  • the embodiments of the present disclosure provide at least one navigation solution.
  • an embodiment of the present disclosure provides a navigation method, including:
  • the target guide line Based on the guide line, generating a target guide line for the target vehicle to reach the navigation destination from the current positioning position, and the target guide line is formed by splicing the guide lines of at least one of the lanes;
  • the target vehicle is controlled to travel according to the target guideline.
  • the navigation lines associated with each lane of the target vehicle can be pre-generated, so that the target vehicle can quickly determine the target from the current positioning position to the navigation destination according to the pre-generated navigation lines during the driving process. navigation lines to improve navigation efficiency.
  • the navigation line includes a first navigation route for guiding the driving path of the vehicle in the lane;
  • the generating, based on the navigation line, the target navigation line for the target vehicle to reach the navigation destination from the current positioning position including:
  • the target navigation lines are obtained by splicing the first navigation routes corresponding to the first lane groups according to the sequence from the current positioning position to the navigation destination.
  • the first navigation routes corresponding to at least one passing lane can be connected in sequence to quickly obtain the information for Indicates the target guideline for the target vehicle to reach the navigation destination from the current positioning position.
  • the navigation line further includes a second navigation route corresponding to the intersection connected with the lane, and the second navigation route is used to guide the vehicle to travel from the first lane connected by the intersection to the second navigation route.
  • the generating, based on the navigation line, the target navigation line for the target vehicle to reach the navigation destination from the current positioning position including:
  • the first navigation route corresponding to the second lane group and the second navigation route corresponding to the intersection set respectively are spliced according to the sequence from the current positioning position to the navigation destination to obtain the target navigation line.
  • the first navigation route corresponding to at least one lane and the second navigation corresponding to at least one intersection can be based on the passing through.
  • the routes are connected in sequence, and the target navigation line used to instruct the target vehicle to reach the navigation destination from the current positioning position is quickly obtained.
  • the generating of the target navigation line for the target vehicle to reach the navigation destination from the current positioning position based on the navigation line includes:
  • the target sub-guidelines are spliced to obtain the target guideline.
  • the road can be segmented according to the intersection information included in the road between the current positioning position and the navigation destination, and further, based on the target sub-navigation line of each road segment, the target sub-navigation line for indicating the target can be quickly obtained.
  • the target navigation line of the vehicle from the current positioning position to the navigation destination.
  • the navigation line includes a first navigation route for guiding the driving path of the vehicle in the lane and a second navigation route corresponding to the intersection connected with the lane, the second navigation route is used for guiding the vehicle to travel on a travel path from the first lane connected by the intersection to the second lane;
  • the plurality of road segments include at least one first road segment, the first road segment passing through at least one intersection;
  • the determining, based on the guidance line, a target sub-guidance line of at least one road segment in the plurality of road segments includes, for at least one first road segment:
  • the first navigation route of the target lane and the second navigation route corresponding to at least one intersection in the second intersection set are spliced according to the travel sequence in the first road section, and the target sub-section of the first road section is obtained. navigation line.
  • the second navigation route corresponding to each intersection included in the first road segment and the first road segment may be determined according to the second navigation route.
  • the first navigation route indicated by the second navigation route in the included third lane group is quickly determined to guide the target vehicle through the target sub-navigation line in the first road segment.
  • the plurality of road segments further include at least one second road segment, and the second road segment does not pass through an intersection;
  • the determining, based on the guidance line, a target sub-guidance line of at least one road segment in the plurality of road segments includes, for at least one second road segment:
  • the enlightenment in the second road segment in the process of determining the target sub-navigation line of each second road segment that does not pass through the intersection, can be determined according to the target sub-navigation line of the first road segment connected by the second road segment Lane and end lane, further according to the pre-stored lane connection relationship, the first navigation route of each lane from the start lane to the end lane in the second road segment can be spliced according to the travel sequence, and quickly determine and guide the target vehicle to pass through the first navigation route.
  • the target sub-navigation line in the second segment in the process of determining the target sub-navigation line of each second road segment that does not pass through the intersection.
  • the first navigation route is pre-generated according to the following steps:
  • a first navigation route corresponding to the lane is determined based on the geographic positions of the plurality of center location points in the road scene.
  • a plurality of position points are respectively extracted from the lane lines corresponding to the lane indicating the boundaries on both sides of the lane to form a plurality of position point pairs, including:
  • the number of position points is determined by the length of the longer lane line among the two lane lines included in the lane, and a position point pair more matching the shape of the lane can be obtained, so as to obtain a center position with higher accuracy point.
  • determining the geographic locations of multiple center location points of the lane in the road scene based on the respective geographic locations of the multiple location point pairs in the road scene include:
  • the geographic location of the center location point of the line connecting the location point pair in the road scene is determined.
  • the determining the first navigation route corresponding to the lane based on the geographic positions of the plurality of center location points in the road scene includes:
  • curve fitting is performed on the plurality of center position points to obtain a first fitting curve
  • the geographic locations of the points in the road scene extracted from the first fitting curve are used as the driving track of the first navigation route corresponding to the lane.
  • the center line of the lane can be obtained by fitting several center points of the lane, and then a plurality of points are extracted on the center line, so as to accurately obtain the driving trajectory that guides the target vehicle to drive in the same lane .
  • the lanes of different roads connected by the same intersection include a first lane and a second lane, and the second navigation route is generated according to the following steps:
  • the first center position point passed when entering the intersection from the first lane, and the second center position point passing through when entering the second lane from the intersection;
  • the first center position point is the the last center position point on the first lane, and the second center position point is the first center position point on the second lane;
  • the starting point and the ending position of the target vehicle at the intersection are planned, the direction in which the target vehicle enters the intersection from the starting position, and the direction in which it drives from the intersection to the end point.
  • the driving track of the second navigation route with higher accuracy is obtained.
  • the driving track of the second navigation route at the intersection when entering the second lane including:
  • a plurality of parameters for controlling the shape of the second navigation route are determined target control point;
  • a driving trajectory of a second navigation route at the intersection is determined when entering the second lane from the first lane.
  • the steering angle, the first center position point, the second center position point, the first direction vector, and the second direction can be driven through the first lane to the second lane first.
  • the vector is used to determine multiple target control points that control the shape of the second navigation route, so as to obtain the driving track of the second navigation route with high accuracy.
  • the determining based on the steering angle, the first center position point, the second center position point, the first direction vector and the second direction vector A plurality of target control points that control the shape of the second navigation route, including:
  • the location points constitute the plurality of target control points.
  • the first center position point, the second center position point, and the first direction vector and the second direction vector can be quickly determined. Take the second navigation route corresponding to the two lanes at the intersection.
  • the determining based on the steering angle, the first center position point, the second center position point, the first direction vector and the second direction vector A plurality of target control points that control the shape of the second navigation route, including:
  • the plurality of target control points are determined.
  • the first safety avoidance point determines the multiple target control points, including:
  • the third target point, the other plurality of target points determined, and the fourth target point constitute the plurality of target control points.
  • the determining, based on the multiple target control points, the driving trajectory of the second navigation route at the intersection when the first lane enters the second lane including:
  • the geographic locations of the points in the road scene extracted from the second fitting curve are taken as the driving track of the second navigation route at the intersection when entering the second lane from the first lane .
  • controlling the target vehicle to drive according to the target navigation line includes:
  • the target guideline is adjusted based on the geographic location of the obstacle, so as to control the target vehicle to avoid the obstacle.
  • the obstacle in the process of controlling the target vehicle to drive along the target navigation line, if a dynamic obstacle is detected, the obstacle can be avoided based on the geographic location of the dynamic obstacle in the road scene, thereby improving the driving safety.
  • an embodiment of the present disclosure provides a navigation device, including:
  • the acquisition module is used to acquire the current positioning position and navigation destination of the target vehicle and the navigation line associated with at least one lane on the road between the current positioning position and the navigation destination, wherein the navigation line is a predetermined Generated;
  • a generating module configured to generate, based on the navigation line, a target navigation line for the target vehicle to reach the navigation destination from the current positioning position, and the target navigation line is formed by splicing the navigation lines of at least one of the lanes;
  • the control module is configured to control the target vehicle to travel according to the target guideline.
  • embodiments of the present disclosure provide an electronic device, including: a processor, a memory, and a bus, where the memory stores machine-readable instructions executable by the processor, and when the electronic device runs, the processing
  • the processor communicates with the memory through a bus, and the machine-readable instructions execute the steps of the navigation method according to the first aspect when executed by the processor.
  • an embodiment of the present disclosure provides a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the steps of the navigation method according to the first aspect are executed .
  • embodiments of the present disclosure provide a computer program product, including computer-readable codes, or a non-volatile computer-readable storage medium carrying computer-readable codes, when the computer-readable codes are stored in an electronic device
  • the processor in the electronic device executes the steps of the navigation method according to the first aspect.
  • FIG. 1 shows a flowchart of a navigation method provided by an embodiment of the present disclosure
  • FIG. 2 shows a schematic diagram of an intersection in a road scene provided by an embodiment of the present disclosure
  • FIG. 3 shows a flowchart of a method for determining a first navigation route corresponding to a lane provided by an embodiment of the present disclosure
  • FIG. 4 shows a schematic diagram of a first navigation route corresponding to a lane provided by an embodiment of the present disclosure
  • FIG. 5 shows a flowchart of a method for determining a second navigation route provided by an embodiment of the present disclosure
  • FIG. 6 shows a flowchart of a specific method for determining a second navigation route provided by an embodiment of the present disclosure
  • FIG. 7 shows a flowchart of a method for controlling the driving of a target vehicle provided by an embodiment of the present disclosure
  • FIG. 8 shows a schematic structural diagram of a navigation device provided by an embodiment of the present disclosure
  • FIG. 9 shows a schematic diagram of an electronic device provided by an embodiment of the present disclosure.
  • the present disclosure provides a navigation method, which can pre-generate the navigation lines associated with each lane of the target vehicle, so that the target vehicle can quickly determine the location from the current location according to the pre-generated navigation lines during the driving process. Position to reach the target navigation line of the navigation destination, thereby improving navigation efficiency.
  • the execution subject of the navigation method provided by the embodiment of the present disclosure is generally a computer device with a certain computing capability, such as a computer device.
  • the terminal equipment can be user equipment (User Equipment, UE), mobile equipment, user terminal, terminal, computing equipment, vehicle equipment, wearable equipment and so on.
  • the navigation method may be implemented by a processor invoking computer-readable instructions stored in a memory.
  • the navigation method includes the following S101-S103:
  • S101 Obtain the current positioning position and the navigation destination of the target vehicle, and the guidance lines associated with each lane on the road between the current positioning position and the navigation destination, where the guidance lines are pre-generated.
  • the target vehicle may include an unmanned vehicle, and a variety of positioning sensors may be provided on the target vehicle, for example, an inertial measurement unit (Inertial measurement unit, IMU) and a global positioning system (Global Positioning System, GPS) may be installed on the vehicle.
  • IMU Inertial measurement unit
  • GPS Global Positioning System
  • the integrated navigation device can determine the current positioning position of the target vehicle.
  • the target vehicle may also be provided with a collection device, such as a monocular camera set on the target vehicle, which is used for shooting during the driving of the target vehicle, and the shooting direction can be preset based on the shooting method.
  • the obtained road scene image can use the visual positioning technology to obtain the current positioning position of the target vehicle.
  • the navigation line may be composed of a plurality of trajectory points for navigating the target vehicle, each trajectory point corresponds to a unique identification code and the geographic location information of the trajectory point in the road scene, and the target vehicle is in the road scene.
  • S102 based on the guide line, generate a target guide line for the target vehicle to reach the navigation destination from the current positioning position, and the target guide line is formed by splicing the guide lines of at least one lane.
  • the target navigation line for the target vehicle to reach the navigation destination from the current positioning position can be determined based on the pre-planned navigation line of the same lane;
  • the target vehicle can be determined to reach the navigation destination from the current positioning position based on the pre-planned navigation lines corresponding to different lanes and the navigation lines connecting different lanes. target navigation line.
  • the target navigation line may include the geographic locations of multiple track points in the road scene, and the target vehicle travels according to the geographic locations corresponding to the multiple track points in the target guide line, and can reach the destination from the current positioning position.
  • the target vehicle is controlled to travel according to the target navigation line.
  • the target vehicle can be controlled to travel according to the geographic location where each track point in the target navigation line is located until reaching the navigation destination.
  • the navigation lines associated with each lane of the target vehicle can be pre-generated, so that the target vehicle can quickly determine the target from the current positioning position to the navigation destination according to the pre-generated navigation lines during the driving process. navigation lines to improve navigation efficiency.
  • the navigation line includes a first navigation route for guiding the driving path of the vehicle in the lane; for the above S102, based on the navigation line, generate a target navigation for the target vehicle to reach the navigation destination from the current positioning position
  • An optional implementation manner of the line including the following S1021-S1023:
  • the lane connection relationship stored in the road scene map corresponding to the road scene includes the preceding lane and the succeeding lane of each lane, wherein the target vehicle can travel from the preceding lane to this lane, and there is this lane that drives to the succeeding lane. Therefore, based on the current lane, the target lane, and the lane connection relationship stored in the road scene map, the first lane group that the target vehicle needs to pass through to reach the navigation destination from the current positioning position can be determined.
  • the lane where the current positioning position is located is the lane S1, the subsequent lane of the lane S1 includes the lane S2, and only the subsequent lane S3 of the lane S2 includes the navigation destination, so the target vehicle reaches the navigation destination from the current positioning position.
  • the first lane group includes lane S1, lane S2 and lane S3.
  • S1022 Extract a first navigation route corresponding to each lane in the first lane group.
  • the pre-generated first navigation route of the lane may include N track points, and the N track points may be sequentially encoded according to the driving direction of the lane to obtain each track point.
  • the unique identification code of the track point, and the identification code of the track point and the geographic location in the road scene are stored in association.
  • the target vehicle driving in an east-west lane if the current positioning position of the target vehicle is the same as that in the lane One of the track points A is matched, and the target vehicle can be instructed how to start from the track point A according to the geographic location of each track point among the N track points included in the first navigation route of the lane and the sequence of the track points.
  • the next track point of the track point A is the track point B
  • the target vehicle's driving track in this lane is from the track point A to the track point B.
  • the target vehicle when the target vehicle is driving on the lane S1, the lane S2 and the lane S3, it can drive according to the driving paths indicated by the respective first navigation routes on the lane S1, the lane S2 and the lane S3, respectively, and follow the current positioning
  • the sequence in which the positions reach the navigation destination can be spliced with these first navigation routes, and a target navigation line indicating that the target vehicle arrives at the navigation destination from the current positioning position can be obtained.
  • the first navigation routes corresponding to at least one passing lane can be connected in sequence to quickly obtain the information for Indicates the target guideline for the target vehicle to reach the navigation destination from the current positioning position.
  • the navigation line further includes a second navigation route corresponding to the intersection connected by the lane, and the second navigation route is used to guide the vehicle to travel from the first lane connected by the intersection to the driving route of the second lane; for
  • an optional implementation manner of generating a target navigation line from the current positioning position of the target vehicle to the navigation destination based on the navigation line further includes the following S1024-S1026:
  • the first intersection set, the second lane group includes at least two lanes, and the first intersection set includes at least one intersection.
  • the target vehicle when the target vehicle is driving in the road scene, in many cases, it needs to pass through different roads, for example, it needs to drive from the first road to the second road, and the first road 1 and the second road need to pass through different roads. 2 are connected through the intersection as shown in Figure 2.
  • the target vehicle When the target vehicle reaches the navigation destination and needs to travel from the lane 11 in the first road 1 to the lane 21 in the second road 2, it needs to cross the Since lane 11 and lane 21 are connected at the intersection, a second navigation route between lanes of different roads connected by the same intersection can be generated in advance, for example, the driving at the intersection when entering lane 21 from lane 11 as shown in FIG. 2 can be generated in advance.
  • the second navigation route of the path here the lane entering the intersection can be called the first lane
  • the lane entering from the intersection can be called the second lane, that is, the lane 11 here is called the first lane
  • the lane 21 is called the second lane Lane.
  • the second navigation route is similar to the first navigation route, and also includes multiple track points.
  • the multiple track points can be encoded according to the driving sequence of the target vehicle between lanes of different roads to obtain
  • Each track point in the second navigation route corresponds to a unique identification code and the geographic location information of the track point in the road scene.
  • S1025 Extract a first navigation route corresponding to each lane in the second lane group, and a second navigation route corresponding to each intersection in the first intersection set.
  • the intersection can be determined as shown in Figure 2 when driving from the current lane to the next lane.
  • the driving track of the corresponding second navigation route if you do not need to switch intersections, such as the distance between the two lanes is very close, you can follow the last track point in the first navigation route of the current lane, and the first track point of the next lane. Switch lanes at the first track point in the navigation route.
  • the first navigation route corresponding to at least one lane and the second navigation corresponding to at least one intersection can be based on the passing through.
  • the routes are connected in sequence, and the target navigation line used to instruct the target vehicle to reach the navigation destination from the current positioning position is quickly obtained.
  • an optional implementation manner of generating a target navigation line for the target vehicle to reach the navigation destination from the current positioning position based on the navigation line includes the following S1027-S1030:
  • intersection information may include the number of intersections and the pre-stored ID of each intersection, which may be specifically determined according to the pre-stored lane connection relationship, for example, according to the pre-stored lane connection relationship, it is determined to reach the navigation destination from the current positioning position. Roads in between contain intersections.
  • S1028 Divide the road into a plurality of road segments according to the intersection information.
  • the road between the current positioning position and the navigation destination may be divided into multiple road segments, and among the divided multiple road segments There is a first road segment that contains an intersection and a second road segment that does not contain an intersection.
  • the target sub-navigation line of each road segment can be determined according to the type of the road segment, such as the first road segment and the second road segment mentioned above, and the target sub-navigation line of each road segment is used to guide the vehicle to start from the road segment. move from the start position to the end position of the segment.
  • the target guideline can be obtained by splicing according to the driving sequence.
  • the road can be segmented according to the intersection information included in the road between the current positioning position and the navigation destination, and further, based on the target sub-navigation line of each road segment, the target sub-navigation line for indicating the target can be quickly obtained.
  • the target navigation line of the vehicle from the current positioning position to the navigation destination.
  • the navigation line includes a first navigation route for guiding the travel path of the vehicle in the lane and a second navigation route corresponding to the intersection connected with the lane, and the second navigation route is used for guiding the vehicle in the first lane connected by the intersection driving path to the second lane;
  • the plurality of road segments include at least one first road segment, and the first road segment passes through at least one intersection;
  • S10291 Determine a third lane group and a second intersection set in the first road segment, where the third lane group includes at least two lanes, and the second intersection set includes at least one intersection.
  • S10292 Extract the second navigation route corresponding to each intersection of the second intersection set, and the first navigation route of the target lane indicated by the second navigation route in the third lane group.
  • a pre-generated second navigation route corresponding to the intersection and a first navigation route of the target lane indicated by the second navigation route in the third lane group may be extracted.
  • the second navigation route P1P2 that guides the vehicle from lane 11 to lane 21 in the intersection can be extracted, and the target lane 11 and the target lane 11 connected by the second navigation route P1P2 in the third lane group can be extracted.
  • the first navigation routes (not shown in FIG. 2 ) corresponding to the target lanes 21 respectively.
  • the traveling sequence refers to the traveling sequence of the first road segment in the process of the vehicle reaching the navigation destination from the current positioning position.
  • the first navigation route is spliced with the second navigation route P1P2, and after the second navigation route P1P2 is spliced with the first navigation route corresponding to the target lane 21, the target sub-navigation route of the first road segment is obtained.
  • the second navigation route corresponding to each intersection included in the first road segment and the first road segment may be determined according to the second navigation route.
  • the first navigation route indicated by the second navigation route in the included third lane group is quickly determined to guide the target vehicle through the target sub-navigation line in the first road segment.
  • the plurality of road segments further include at least one second road segment, and the second road segment does not pass through the intersection; determining the target sub-navigation line of each road segment in the plurality of road segments based on the navigation line, including for each second road segment:
  • S10294 Determine a start lane and an end lane in the second road segment based on the target sub-navigation line of the first road segment connected to the second road segment.
  • the lane where the end position of the target sub-navigation line of the previous first road segment connected by the second road segment is located can be used as the starting lane of the second road segment here, and the target of the next first road segment connected by the second road segment.
  • the lane where the starting position of the sub-navigation line is located can be used as the ending lane of the second road segment here.
  • the starting lane in the second road segment is specified by: The lane where the current positioning position is located is determined, and when the second road segment is the last segment of the plurality of road segments, the ending lane in the second road segment is specifically determined by the lane where the navigation destination is located.
  • the enlightenment in the second road segment in the process of determining the target sub-navigation line of each second road segment that does not pass through the intersection, can be determined according to the target sub-navigation line of the first road segment connected by the second road segment Lane and end lane, further according to the pre-stored lane connection relationship, the first navigation route of each lane from the start lane to the end lane in the second road segment can be spliced according to the travel sequence, and quickly determine and guide the target vehicle to pass through the first navigation route.
  • the target sub-navigation line in the second segment in the process of determining the target sub-navigation line of each second road segment that does not pass through the intersection.
  • the first navigation route can be pre-generated according to the following steps, including S201-S203:
  • the center line of the lane can be used as the first navigation route, the center line can be obtained by fitting a plurality of center position points, and the center position points can be obtained by a pair of lane lines on the borders on both sides of the lane. location to be determined.
  • the lane contains two lane lines, and a plurality of position points can be extracted on the two lane lines of the lane respectively, so that two position points on different lane lines constitute a position point pair, such as a lane line.
  • the position point K1 in L1 and the position point K1' in the lane line L2 form a position point pair
  • the position point K2 in the lane line L1 and the position point K2' in the lane line L2 form a position point
  • the center position point of the lane can be obtained.
  • a plurality of position points are respectively extracted from the lane lines corresponding to the lane indicating the boundaries on both sides of the lane to form a plurality of position points.
  • Time synchronization including the following S2011 ⁇ S2014:
  • the lengths of the two lane lines contained in the lane in the road scene may be obtained from a road scene map constructed in advance for the road scene, for example, the lengths of the two lane lines contained in the lane are l1 and l2, respectively. .
  • the length of the longest lane line among the two lane lines can be jointly determined in combination with the preset location point interval.
  • the ratio of the length of the lane line to the preset position point interval is taken as the number of multiple position points, wherein the preset position point interval can be obtained according to experience.
  • linear interpolation may be performed according to N on the two lane lines included in the lane to obtain N position points.
  • the multiple position points of each lane line may be sorted according to the driving direction, and in the case that the lane does not have the preset driving direction
  • the multiple position points of each lane line can be sorted according to the set driving direction, and then two position points with the same serial number in different lane lines can be formed into a position point pair.
  • the number of position points is determined by the length of the longer lane line among the two lane lines included in the lane, and a position point pair more matching the shape of the lane can be obtained, so as to obtain the center position with higher accuracy point.
  • S202 Determine the geographic locations of multiple center location points of the lane in the road scene based on the respective geographic locations of the multiple location point pairs in the road scene; each location point pair corresponds to a center location point.
  • the geographic location of the center location point of the line connecting the location point pair in the road scene is determined.
  • a world coordinate system may be constructed for the road scene in advance, and based on this, the world coordinate in the world coordinate system of each location point included on the lane line of the road may be used as the geographic location of the location point in the road scene. .
  • the center position point of the line connecting the two position points can be determined in the world coordinate system.
  • World coordinates the world coordinates of the center point of the line connecting the two position points can be obtained, which can represent the geographic location of the center point in the road scene.
  • S203 Determine a first navigation route corresponding to the lane based on the geographic positions of the plurality of center location points in the road scene.
  • S2031 to S2033 may be included:
  • curve fitting may be performed on the multiple center position points by means of cubic spline curve fitting to obtain a first fitting curve, which is:
  • the first fitted curve may represent the centerline of the lane.
  • the preset interval can be determined by the distance traveled from when the target vehicle collects its current geographic location to when the next location point is determined based on the current geographic location, and is on the first fitting curve according to the preset interval. Perform interpolation, extract multiple points on the first fitting curve, and obtain the geographic positions of the multiple points in the road scene.
  • the center line of the lane can be obtained by fitting several center points of the lane, and then a plurality of points are extracted on the center line, so as to accurately obtain the driving trajectory that guides the target vehicle to drive in the same lane .
  • the lanes of different roads connected by the same intersection include a first lane and a second lane
  • the second navigation route is generated according to the following steps, as shown in FIG. 5, which may include the following S301-S303:
  • the first lane can be used as the exit lane
  • the second lane can be used as the entry lane
  • the second navigation route at the intersection when the first lane enters the second lane can be determined here.
  • the first center position point that the first lane 11 passes through when entering the intersection may be determined during the process of determining the first navigation route of the first lane, and similarly, the second pass through the intersection when entering the second lane
  • the center position point can be determined during the process of determining the first navigation route of the second lane. As shown in FIG.
  • the first lane shown in the intersection can be lane 11, lane 12, and lane 13, and the first lane 11 corresponds to
  • the second lane may include lane 21, lane 22 and lane 23, the second lane corresponding to the first lane 12 may include lane 31, lane 32 and lane 33, and the second lane corresponding to the first lane 13 may include lane 41, lane 42 and lane 43, wherein point P1 is the first center position point of each first lane, and point P2 is the second center position point of each second lane.
  • S302 Determine, based on the respective geographic locations of two adjacent center position points including the first center position point on the first lane, a first direction vector used to represent entering the intersection from the first lane, and based on the first direction vector The geographic positions corresponding to two adjacent center position points including the second center position point on the second lane respectively are determined to represent the second direction vector for entering the second lane from the intersection.
  • the first lane includes the previous center position point C1 adjacent to the first center position point P1 as the starting point of the first direction vector, and the first center position Point P1 is used as the end point of the first direction vector, and the first direction vector as shown in Figure 2 is obtained
  • the second lane is the entry lane
  • the second direction vector shown in Figure 2 is obtained
  • the first center position point may represent the starting point of the target vehicle at the intersection
  • the second center position point may represent the end point of the target vehicle at the intersection
  • the first direction vector may indicate that the target vehicle enters the intersection from the first lane
  • the second direction vector can represent the direction when the target vehicle enters the second lane from the intersection. Based on these parameter information, the target vehicle can plan the driving trajectory of the second navigation route that safely passes through the intersection.
  • the starting point and the ending position of the target vehicle at the intersection are planned, the direction in which the target vehicle enters the intersection from the starting position, and the direction in which it drives from the intersection to the end point.
  • the driving track of the second navigation route with higher accuracy is obtained.
  • the angle between the first direction vector and the second direction vector may be used as the steering angle for driving from the first lane into the second lane, and in the case that the first lane is located on the opposite side of the second lane, As shown in Figure 2 above, when lane 11 is the first lane and lane 31 is the second lane, the steering angle is small; when the second lane is located on the right side of the first lane, lane 11 is the first lane in Figure 2 above. , when the lane 21 is the second lane, the steering angle is larger.
  • a fourth-order Bezier curve can be introduced to represent the second navigation route.
  • five target control points need to be determined, and these five target control points can be used to represent the fourth-order Bezier curve.
  • a fourth-order Bezier curve can be determined based on the geographic locations of multiple target control points in the road scene, and further, the driving trajectory of the second navigation route at the intersection when entering the second lane from the first lane can be obtained. .
  • the steering angle, the first center position point, the second center position point, the first direction vector, and the second direction can be driven through the first lane to the second lane first.
  • the vector is used to determine multiple target control points that control the shape of the second navigation route, so as to obtain the driving track of the second navigation route with high accuracy.
  • one of the plurality of target control points for controlling the shape of the second navigation route is determined based on the steering angle, the first center position point, the second center position point, the first direction vector, and the second direction vector.
  • the following S4021-S4023 are included:
  • multiple target control points are determined in the manner of determining straight-line Bessel control points, which can be based on the first center position point P1 and the second center position point P2 in the world
  • the world coordinates under the coordinate system determine the world coordinates of the midpoint M1 of the line connecting the first center position point P1 and the second center position point P2 in the world coordinate system, and based on the first center position point P1 and the second center position point
  • the world coordinates of P2 in the world coordinate system respectively determine the first distance D1 between the first center position point P1 and the second center position point P2.
  • S4022 Acquire a first target point obtained by extending the first center position point by a preset multiple of the first distance in the direction indicated by the first direction vector.
  • the first target point B1 can be obtained, where n represents a preset multiple, which can be set empirically according to the size of the intersection, and the value of n is greater than 0 and less than 1.
  • the first central position point, the first target point, the midpoint of the line connecting the first central position point and the second central position point, the second target point and the second central position point constitute a plurality of target control points.
  • the second target point B2 can be obtained.
  • the first center position point P1, the first target point B1, the midpoint M1, the second target point B2, and the second center position point P2 of the line connecting the first center position point P1 and the second center position point obtained above are used as four.
  • the first center position point, the second center position point, and the first direction vector and the second direction vector can be quickly determined. Take the second navigation route corresponding to the two lanes at the intersection.
  • the target control point determines a plurality of A possible implementation of the target control point includes the following S4024-S4026:
  • multiple target control points are determined in the manner of determining the steering Bessel control points, and before the multiple target control points are determined, the size of the target vehicle may be first determined.
  • the information and the obstacle area corresponding to the first lane are used to determine the first safe obstacle avoidance distance when the target vehicle enters the intersection from the first lane.
  • the intersection includes obstacle area A, obstacle area B, obstacle area C and obstacle area D.
  • the target vehicle consists of
  • the distance that needs to be driven forward can be called the first safe obstacle avoidance distance, especially In the case where there is no obstacle area A, the first safe obstacle avoidance distance here may be 0.
  • the first safe obstacle avoidance distance may be determined in the following manner:
  • the obstacle search direction vector is used to determine the obstacle area associated with lane 13 and the obstacle area associated with lane 43.
  • the obstacle area associated with lane 13 is A
  • the obstacle area associated with lane 43 is D.
  • the obstacle-sensitive direction vector is used to indicate the direction of the obstacle area that is likely to collide with the target vehicle.
  • the length d i is used to filter out target boundary points that are likely to collide with the target vehicle if the target vehicle does not travel forward according to the first safe obstacle avoidance distance.
  • the first preset range is greater than 0 and less than h, where h is related to the width of the vehicle body and may be equal to the width of the vehicle body, select a target that makes d i meet the preset range border point;
  • the second preset range is greater than 0 and less than m, where m is pre-set based on the size of the obstacle area and is empirically set to indicate that the obstacle area belongs to the lane 13 The obstacle area on the side
  • the N1 with the longest length that conforms to the second preset range is selected as the first safe obstacle avoidance distance, as shown in FIG. 2 .
  • the obstacle search direction vector used in the process of determining the second safe obstacle avoidance distance is:
  • the second lane is the lane 43 in the above-mentioned FIG. 2
  • the size information of the target vehicle and the obstacle search direction vector the To determine the second safe obstacle avoidance distance N2 , as shown in FIG. 2
  • the determination process is the same as the above-mentioned principle of determining the first safe obstacle avoidance distance N1 , which is not repeated here.
  • S4026 Determine multiple target control points based on the first center position point, the second center position point, the intersection of the first direction vector and the second direction vector, the first safe obstacle avoidance distance and the second safe obstacle avoidance distance.
  • one of the multiple target control points is determined based on the first center position point, the second center position point, the intersection of the first direction vector and the second direction vector, the first safe obstacle avoidance distance and the second safe obstacle avoidance distance
  • Possible implementations include the following S40261 to S40263:
  • S40261 Acquire a third target point obtained by extending the first safe obstacle avoidance distance from the first center position point in the direction indicated by the first direction vector.
  • a third target point B3 can be obtained.
  • S40262 Acquire a fourth target point obtained by extending the second safe obstacle avoidance distance from the second center position point in the direction indicated by the second direction vector.
  • the fourth target point B4 can be obtained.
  • the third target point, the other multiple determined target points, and the fourth target point constitute multiple target control points.
  • the third target point can be used as the first target control point of the steering Bezier control points
  • the fourth target point can be used as the fifth target control point among the steering Bezier control points
  • the other multiple target control points The points can respectively contain the second target control point, the third target control point, and the fourth target control point among the steering Bezier control points.
  • a possible implementation manner of determining, based on the third target point, the fourth target point, and the intersection point, other multiple target points than the third target point and the fourth target point includes:
  • Target point B6 is used as the fourth target control point in the steering Bezier control points
  • a possible embodiment of determining the driving trajectory of the second navigation route at the intersection when entering the second lane from the first lane based on multiple target control points may include the following S4031 ⁇ S4033:
  • the geographic positions of the multiple target control points in the road scene may be input into the fourth-order Bezier curve function to obtain the second fitting curve.
  • the preset interval may be determined by the distance traveled from when the target vehicle collects its current geographic location to when the next location point is determined based on the current geographic location, and is on the second fitting curve according to the preset interval. Perform interpolation, extract multiple points on the second fitting curve, and acquire the geographic positions of the multiple points in the road scene.
  • the driving trajectories of three second navigation routes are shown, which are respectively the driving trajectories U1 of the second navigation route from lane 11 to lane 21 at the intersection, and the driving trajectories of lane 12 to lane 32 at the intersection.
  • the obstacles here are dynamic obstacles, such as pedestrians, vehicles and the like.
  • the road scene image can be acquired by a collection device installed on the target vehicle, such as a monocular camera, and based on the situation where a dynamic obstacle is detected in the road scene image, the image position of the obstacle in the road scene image can be obtained. , and the conversion relationship between the image coordinate system corresponding to the road scene image captured by the predetermined monocular camera and the vehicle body coordinate system corresponding to the target vehicle, to determine the coordinate position of the obstacle in the vehicle body coordinate system, and further based on the target vehicle.
  • the location of the vehicle in the road scene determines the location of the obstacle in the road scene.
  • the target vehicle when the target vehicle is traveling along the target navigation line, if it is detected that the obstacle is located in front of the target vehicle, the target vehicle can be controlled to stop, and the target vehicle can be controlled to stop after the obstacle is detected to leave the front of the target vehicle.
  • the vehicle continues to drive according to the target navigation line, or, when an obstacle is detected in front of the target vehicle, the target vehicle can be controlled to transfer to the first navigation route corresponding to the adjacent lane to continue driving.
  • control the target vehicle to drive to the initial lane and continue to drive according to the target guideline.
  • the obstacle in the process of controlling the target vehicle to drive along the target navigation line, if a dynamic obstacle is detected, the obstacle can be avoided based on the geographic location of the dynamic obstacle in the road scene, thereby improving the driving safety.
  • the writing order of each step does not mean a strict execution order but constitutes any limitation on the implementation process, and the specific execution order of each step should be based on its function and possible Internal logic is determined.
  • the embodiment of the present disclosure also provides a navigation device corresponding to the navigation method. Since the principle of solving the problem of the device in the embodiment of the present disclosure is similar to the above-mentioned navigation method in the embodiment of the present disclosure, the implementation of the device can refer to the method implementation, and the repetition will not be repeated.
  • the navigation device 600 includes:
  • the obtaining module 601 is used to obtain the current positioning position and the navigation destination of the target vehicle and the navigation line associated with at least one lane on the road between the current positioning position and the navigation destination, wherein the navigation line is pre-generated; the generating module 602, used to generate a target guide line for the target vehicle to reach the navigation destination from the current positioning position based on the guide line, and the target guide line is formed by splicing the guide lines of at least one lane; the control module 603 is used to control the target vehicle to follow the target guide line. to drive.
  • the navigation line includes a first navigation route used to guide the driving path of the vehicle in the lane; the generating module 602 is used to generate a navigation route for the target vehicle to reach the navigation destination from the current positioning position based on the navigation line.
  • the target navigation line includes: based on the pre-stored lane connection relationship, when it is determined that the road from the current positioning position of the target vehicle to the navigation target destination does not pass through the intersection, obtaining the first time that the target vehicle passes from the current positioning position to the navigation destination.
  • Lane group the first lane group includes at least one lane; extract the first navigation route corresponding to at least one lane in the first lane group; the first navigation route corresponding to the first lane group respectively arrives at the navigation destination according to the current positioning position splicing in order to obtain the target navigation line.
  • the navigation line further includes a second navigation route corresponding to the intersection connected with the lane, and the second navigation route is used to guide the vehicle to travel from the intersection from the first lane connected to the second lane on the driving path
  • the generation module 602 is used to generate the target navigation line for the target vehicle to reach the navigation destination from the current positioning position in the following manner: Based on the pre-stored lane connection relationship, it is determined that the road of the target vehicle from the current positioning position to the navigation target place passes through the intersection.
  • the generating module 602 is configured to generate a target navigation line for the target vehicle to reach the navigation destination from the current positioning position in the following manner: obtain the road between the current positioning position and the navigation destination. According to the intersection information, the road is divided into a plurality of road sections; the target sub-navigation line of at least one section of the plurality of road sections is determined based on the navigation line; the target sub-navigation line is spliced, Get the target guideline.
  • the navigation line includes a first navigation route for guiding the driving path of the vehicle in the lane and a second navigation route corresponding to the intersection connected with the lane, the second navigation route is used for guiding a vehicle to travel on a travel path from a first lane connected by the intersection to a second lane;
  • the plurality of road segments includes at least one first road segment, and the first road segment passes through at least one intersection;
  • the generating module 602 is configured for at least one road segment A first road segment, the target sub-navigation line of at least one road segment in the plurality of road segments is determined in the following manner: a third lane group and a second intersection set in the first road segment are determined, and the third lane group includes at least two lane, the second intersection set includes at least one intersection; extract a second navigation route corresponding to at least one intersection in the second intersection set, and a target connected by the second navigation route in the third lane group The first navigation route of the lane; the first navigation route of the target lane and the second navigation route
  • the plurality of road segments further include at least one second road segment, and the second road segment does not pass through an intersection;
  • the generating module 602 is configured to, for the at least one second road segment, determine a plurality of road segments in the following manner target sub-navigation line of at least one road segment: based on the target sub-navigation line of the first road segment connected to the second road segment, determine the start lane and the end lane in the second road segment; based on the pre-stored lane connection relationship , extract the first navigation route corresponding to at least one lane from the start lane to the end lane in the second road segment; for at least one lane from the start lane to the end lane in the second road segment
  • the first navigation routes corresponding to one lane are spliced according to the traveling sequence in the second road section to obtain the target sub-navigation line of the second road section.
  • the generating module 602 is configured to generate the first navigation route in advance according to the following steps: for any lane in the road scene, extract the corresponding lane lines from the lane lines indicating the boundaries on both sides of the lane corresponding to the lane. Multiple location points to form multiple location point pairs; based on the respective geographic locations of the multiple location point pairs in the road scene, determine the geographic locations of the multiple center location points of the lane in the road scene; each location point pair Corresponding to a central position point; based on the geographic positions of the plurality of central position points in the road scene, the first navigation route corresponding to the lane is determined.
  • the generating module 602 is configured to extract a plurality of position points from the lane lines corresponding to the lane indicating the borders on both sides of the lane, respectively, to form a plurality of position point pairs in the following manner: obtain the lane The length of the two included lane lines in the road scene; based on the length of the longest lane line among the two lane lines included in the lane, determine the number of multiple location points; based on the number of multiple location points, respectively in the Extract multiple position points from the two lane lines included in the lane by interpolation; after sorting the multiple position points on at least one lane line included in the lane according to the driving direction of the lane, the same sequence number in different lane lines is sorted. Two position points constitute a position point pair.
  • the generating module 602 is configured to determine the geographic positions of the multiple center position points of the lane in the road scene based on the respective geographic positions of the multiple position point pairs in the road scene as follows: For at least one location point pair, based on the geographic location of at least one location point in the location point pair in the road scene, the geographic location of the center location point of the line connecting the location point pair in the road scene is determined.
  • the generating module 602 is used to determine the first navigation route corresponding to the lane based on the geographic positions of the multiple central location points in the road scene in the following manner: For the geographic location in the road scene, curve fitting is performed on multiple center points to obtain a first fitting curve; a plurality of points are extracted from the first fitting curve according to preset intervals, and obtained on the first fitting curve The geographic location of the extracted points in the road scene; the geographic location of the multiple points extracted on the first fitting curve in the road scene as the driving track of the first navigation route corresponding to the lane.
  • the lanes of different roads connected to the same intersection include a first lane and a second lane
  • the generating module 602 is configured to generate a second navigation route according to the following steps: respectively obtaining the first lane to enter the intersection.
  • Direction vector based on the first center position point, the second center position point, the first direction vector, and the second direction vector, determine the driving track of the second navigation route at the intersection when the first lane enters the second lane.
  • the generating module 602 is configured to determine, based on the first center position point, the second center position point, the first direction vector and the second direction vector, to enter the second lane from the first lane as follows The driving trajectory of the second navigation route at the intersection: based on the first direction vector and the second direction vector, determine the steering angle from the first lane to the second lane; based on the steering angle, the first center position point, the second The center position point, the first direction vector, and the second direction vector determine multiple target control points for controlling the shape of the second navigation route; The driving track of the second navigation route.
  • the generating module 602 is configured to determine, based on the steering angle, the first center position point, the second center position point, the first direction vector, and the second direction vector, a method for controlling the second navigation in the following manner
  • Multiple target control points of the route shape when the steering angle is smaller than the preset angle, determine the midpoint of the line connecting the first center position point and the second center position point, as well as the first center position point and the second center position point obtain the first target point obtained by extending the first center point by a preset multiple of the first distance in the direction indicated by the first direction vector; obtain the second center position point according to the reverse vector of the second direction vector The second target point obtained after the indicated direction is extended by a preset multiple of the first distance; wherein, the first center position point, the first target point, the midpoint of the line connecting the first center position point and the second center position point, the third The two target points and the second center position point constitute a plurality of target control points.
  • the generating module 602 is configured to determine, based on the steering angle, the first center position point, the second center position point, the first direction vector, and the second direction vector, a method for controlling the second navigation in the following manner Multiple target control points of the route shape: when the steering angle is greater than or equal to the preset angle, based on the size information of the target vehicle and the obstacle area corresponding to the first lane, determine the time when the target vehicle enters the intersection from the first lane.
  • the first safe obstacle avoidance distance based on the size information of the target vehicle and the obstacle area corresponding to the second lane, determine the second safe obstacle avoidance distance when the target vehicle enters the second lane from the intersection;
  • the two center position points, the intersection of the first direction vector and the second direction vector, the first safe obstacle avoidance distance and the second safe obstacle avoidance distance determine a plurality of target control points.
  • the generating module 602 is configured to, based on the first center position point, the second center position point, the intersection of the first direction vector and the second direction vector, the first safe obstacle avoidance distance and the second safe avoidance distance
  • the obstacle distance is determined, and a plurality of target control points are determined in the following manner: obtaining the third target point obtained by extending the first safe obstacle avoidance distance from the first center position point in the direction indicated by the first direction vector; and obtaining the second center position point
  • the fourth target point obtained by extending the second safe obstacle avoidance distance according to the direction indicated by the reverse vector of the second direction vector; A plurality of other target points other than the target point; wherein, the third target point, the other plurality of target points determined, and the fourth target point constitute a plurality of target control points.
  • the generating module 602 is configured to, based on multiple target control points, determine the driving trajectory of the second navigation route at the intersection when the first lane enters the second lane in the following manner: based on multiple targets Control point, determine the second fitting curve at the intersection when the first lane enters the second lane; extract a plurality of points on the second fitting curve according to preset intervals, and obtain and extract on the second fitting curve
  • the geographic location of the multiple points in the road scene; the geographic location of the multiple points extracted on the second fitting curve in the road scene is used as the second navigation at the intersection when the first lane enters the second lane The driving track of the route.
  • control module 603 is configured to control the target vehicle to drive along the target guideline in the following manner: when it is detected that there is an obstacle in the process of the target vehicle traveling along the target guideline, obtain the obstacle The geographic location in the road scene; in the process of controlling the target vehicle to drive along the target guideline, the target guideline is adjusted based on the geographic location of the obstacle to control the target vehicle to avoid the obstacle.
  • an embodiment of the present disclosure further provides an electronic device 700 .
  • a schematic structural diagram of the electronic device 700 provided by the embodiment of the present disclosure includes:
  • the processor 71 and the memory 72 communicate through the bus 73, so that the processor 71 executes the following instructions : Obtain the current positioning position and navigation destination of the target vehicle and the navigation lines associated with each lane on the road from the current positioning position to the navigation destination, where the navigation lines are pre-generated; based on the navigation lines, the target vehicle is generated by The current positioning position reaches the target guide line of the navigation destination, and the target guide line is formed by splicing the guide lines of at least one lane; the target vehicle is controlled to drive according to the target guide line.
  • Embodiments of the present disclosure further provide a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and when the computer program is run by a processor, the steps of the navigation method in the above method embodiments are executed.
  • the storage medium may be a volatile or non-volatile computer-readable storage medium.
  • Embodiments of the present disclosure also provide a computer program product, including computer-readable codes, or a non-volatile computer-readable storage medium carrying computer-readable codes, when the computer-readable codes are executed in a processor of an electronic device At the time, the processor in the electronic device executes the steps of the navigation method described in the foregoing method embodiments. For details, reference may be made to the foregoing method embodiments, which will not be repeated here.
  • the above-mentioned computer program product can be specifically implemented by means of hardware, software or a combination thereof.
  • the computer program product is embodied as a computer storage medium, and in another optional embodiment, the computer program product is embodied as a software product, such as a software development kit (Software Development Kit, SDK), etc. Wait.
  • the units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this embodiment.
  • each functional unit in each embodiment of the present disclosure may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit.
  • the functions, if implemented in the form of software functional units and sold or used as stand-alone products, may be stored in a processor-executable non-volatile computer-readable storage medium.
  • the computer software products are stored in a storage medium, including Several instructions are used to cause a computer device (which may be a personal computer, a server, or a network device, etc.) to execute all or part of the steps of the methods described in various embodiments of the present disclosure.
  • the aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disk and other media that can store program codes .

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Navigation (AREA)

Abstract

一种导航方法、装置、电子设备及存储介质,其中,导航方法包括:获取目标车辆的当前定位位置和导航目的地以及由当前定位位置到导航目的地之间的道路上的各车道关联的导航线,其中导航线是预先生成的(S101);基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线,目标导航线由至少一条车道的导航线拼接形成(S102);控制目标车辆按照目标导航线进行行驶(S103)。

Description

一种导航方法、装置、电子设备及存储介质
本申请要求在2021年03月30日提交中国专利局、申请号为202110338827.3、申请名称为“一种导航方法、装置、电子设备及存储介质”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。
技术领域
本公开涉及车辆导航技术领域,具体而言,涉及一种导航方法、装置、电子设备及存储介质。
背景技术
无人驾驶车也叫自动驾驶汽车,是指在没有人工参与的情况下,能够感知周围环境并进行自主驾驶的汽车,在无人驾驶车的行驶过程中,通常需要依赖预先构建的高精度地图来协助完成定位与导航。如何基于高精地图高效率地实时确定导航路线,成为目前一个亟待解决的问题。
发明内容
本公开实施例至少提供一种导航方案。
第一方面,本公开实施例提供了一种导航方法,包括:
获取目标车辆的当前定位位置和导航目的地以及由所述当前定位位置到达所述导航目的地之间的道路上的至少一条车道关联的导航线,其中所述导航线是预先生成的;
基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,所述目标导航线由至少一条所述车道的导航线拼接形成;
控制所述目标车辆按照所述目标导航线进行行驶。
本公开实施例中,可以预先生成目标车辆行驶的各条车道关联的导航线,这样目标车辆在行驶过程中,可以根据预先生成的导航线,快速确定出从当前定位位置到达导航目的地的目标导航线,从而提高导航效率。
在一种可能的实施方式中,所述导航线包括用于引导车辆在车道内的行驶路径的第一导航路线;
所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,包括:
基于预先存储的车道连接关系,确定所述目标车辆由所述当前定位位置到达所述导航目标地的道路不经过路口的情况下,获取所述目标车辆由所述当前定位位置到达所述导航目的地经过的第一车道组,所述第一车道组中包含至少一条车道;
提取所述第一车道组中至少一条车道对应的第一导航路线;
对所述第一车道组分别对应的所述第一导航路线按照由所述当前定位位置到达所述导航目的地的顺序进行拼接,得到所述目标导航线。
本公开实施例中,在确定目标车辆由当前定位位置到达导航目的地的过程中不经过路口的情况下,可以基于经过的至少一条车道分别对应的第一导航路线进行依次连接,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
在一种可能的实施方式中,所述导航线还包括与车道连接的路口对应的第二导航路线,所述第二导航路线用于引导车辆在由所述路口连接的第一车道行驶至第二车道的行驶路径;
所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,包括:
基于预先存储的车道连接关系,确定所述目标车辆由所述当前定位位置到达所述导航目标地的道路经过路口的情况下,获取所述目标车辆由所述当前定位位置到达所述导航目的地经过的第二车道组,以及经过的第一路口集,所述第二车道组包含至少两条车道,所述第一路口集包含至少一个路口;
提取所述第二车道组中至少一条车道对应的第一导航路线,以及所述第一路口集中至少一个路口对应的第二导航路线;
对所述第二车道组分别对应的所述第一导航路线以及所述路口集分别对应的第二导航路线按照由所述当前定位位置到达所述导航目的地的顺序进行拼接,得到所述目标导航线。
本公开实施例中,在确定目标车辆由当前定位位置到达导航目的地的过程中经过路口的情况下,可以基于经过的至少一条车道分别对应的第一导航路线以及至少一个路口对应的第二导航路线进行依次连接,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
在一种可能的实施方式中,所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航 目的地的目标导航线,包括:
获取由当前定位位置到达导航目的地的之间的道路中的路口信息;
根据所述路口信息将所述道路划分为多个路段;
基于所述导航线确定所述多个路段中至少一个路段的目标子导航线;
对所述目标子导航线进行拼接,得到所述目标导航线。
本公开实施例中,可以根据由当前定位位置到达导航目的地之间的道路包含的路口信息,对该道路进行分段,进一步可以基于每个路段的目标子导航线,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
在一种可能的实施方式中,所述导航线包括用于引导车辆在车道内的行驶路径的第一导航路线和与车道连接的路口对应的第二导航路线,所述第二导航路线用于引导车辆在由所述路口连接的第一车道行驶至第二车道的行驶路径;
所述多个路段包括至少一个第一路段,所述第一路段经过至少一个路口;
所述基于所述导航线确定所述多个路段中至少一个路段的目标子导航线,包括针对至少一个第一路段:
确定所述第一路段内的第三车道组和第二路口集,所述第三车道组包含至少两条车道,所述第二路口集包括至少一个路口;
提取所述第二路口集的至少一个路口对应的第二导航路线,以及所述第三车道组中由所述第二导航路线指示连接的目标车道的第一导航路线;
将所述目标车道的第一导航路线与所述第二路口集中的至少一个路口对应的第二导航路线按照在所述第一路段内的行经顺序进行拼接,得到所述第一路段的目标子导航线。
本公开实施例中,在确定经过至少一个路口的每个第一路段的目标子导航线的过程中,可以按照该第一路段包含的每个路口对应的第二导航路线,以及该第一路段包含的第三车道组中由第二导航路线指示连接的第一导航路线,快速确定引导目标车辆通过该第一路段中的目标子导航线。
在一种可能的实施方式中,所述多个路段还包括至少一个第二路段,所述第二路段不经过路口;
所述基于所述导航线确定所述多个路段中至少一个路段的目标子导航线,包括针对至少一个第二路段:
基于与所述第二路段连接的第一路段的目标子导航线,确定所述第二路段内的起始车道和结束车道;
基于预先存储的车道连接关系,提取所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线;
对所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线按照在所述第二路段内的行经顺序进行拼接,得到所述第二路段的目标子导航线。
本公开实施例中,在确定不经过路口的每个第二路段的目标子导航线的过程中,可以按照该第二路段连接的第一路段的目标子导航线,确定第二路段内的启示车道和结束车道,进一步按照预先存储的车道连接关系,可以对第二路段内由起始车道到达结束车道的每条车道的第一导航路线按照行经顺序进行拼接,快速确定引导目标车辆通过该第二路段中的目标子导航线。
在一种可能的实施方式中,按照以下步骤预先生成所述第一导航路线:
针对道路场景中的任一条车道,在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对;
基于所述多个位置点对分别在所述道路场景中的地理位置,确定该条车道的多个中心位置点在所述道路场景中的地理位置;每个位置点对对应一个中心位置点;
基于所述多个中心位置点在所述道路场景中的地理位置,确定该条车道对应的第一导航路线。
在一种可能的实施方式中,所述在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对,包括:
获取该条车道包含的两条车道线在所述道路场景中的长度;
基于该条车道包含的两条车道线中长度最长的车道线的长度,确定所述多个位置点数量;
基于所述多个位置点数量,分别在该条车道包含的两条车道线中按照插值方式提取所述多个位置点;
在对该条车道包含的至少一条车道线上的多个位置点按照车道行驶方向排序后,将不同车道线中序号相同的两个位置点构成一个位置点对。
本公开实施例中,通过车道包含的两条车道线中长度较长的车道线的长度来确定位置点数量, 可以得到更加与车道形状匹配的位置点对,以便得到准确度较高的中心位置点。
在一种可能的实施方式中,所述基于所述多个位置点对分别在所述道路场景中的地理位置,确定该条车道的多个中心位置点在所述道路场景中的地理位置,包括:
针对至少一个位置点对,基于该位置点对中至少一个位置点在所述道路场景中的地理位置,确定该位置点对连线的中心位置点在所述道路场景中的地理位置。
在一种可能的实施方式中,所述基于所述多个中心位置点在所述道路场景中的地理位置,确定该条车道对应的第一导航路线,包括:
基于所述多个中心位置点在所述道路场景中的地理位置,对所述多个中心位置点进行曲线拟合,得到第一拟合曲线;
按照预设间隔在所述第一拟合曲线上提取多个点,并获取在所述第一拟合曲线上提取的多个点在所述道路场景中的地理位置;
将在所述第一拟合曲线上提取的多个点在道路场景中的地理位置,作为该条车道对应的第一导航路线的行驶轨迹。
本公开实施例中,首先通过车道的若干中心位置点可以拟合得到车道的中心线,然后进一步在该中心线上提取多个点,可以准确的得到指导目标车辆在同一车道中行驶的行驶轨迹。
在一种可能的实施方式中,所述同一路口连接的不同道路的车道包括第一车道和第二车道,按照以下步骤生成所述第二导航路线:
分别获取由所述第一车道驶入该路口时经过的第一中心位置点,以及由该路口驶入所述第二车道时经过的第二中心位置点;所述第一中心位置点为所述第一车道上的最后一个中心位置点,所述第二中心位置点为所述第二车道上的第一个中心位置点;
基于所述第一车道上包含所述第一中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由所述第一车道驶入该路口的第一方向向量,以及基于所述第二车道上包含所述第二中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由该路口驶入所述第二车道的第二方向向量;
基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
本公开实施例中,在确定第二导航路线前,规划了目标车辆在路口的起点位置和终点位置、按照什么方向从起点位置驶入路口、按照什么方向从路口驶入终点,通过该方式可以得到准确度较高的第二导航路线的行驶轨迹。
在一种可能的实施方式中,所述基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹,包括:
基于所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道驶的转向角;
基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点;
基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
本公开实施例中,提出在确定第二导航路线时,可以先通过第一车道行驶至第二车道的转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定出控制第二导航路线形状的多个目标控制点,从而得到准确度较高的第二导航路线的行驶轨迹。
在一种可能的实施方式中,所述基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点,包括:
在所述转向角小于预设角度的情况下,确定所述第一中心位置点和所述第二中心位置点连线的中点,以及所述第一中心位置点和所述第二中心位置点的第一距离;
获取所述第一中心位置点按照所述第一方向向量指示的方向延长所述第一距离的预设倍数后得到的第一目标点;
获取所述第二中心位置点按照所述第二方向向量的相反向量指示的方向延长所述第一距离的预设倍数后得到的第二目标点;
其中,所述第一中心位置点、所述第一目标点、所述第一中心位置点和所述第二中心位置点连 线的中点、所述第二目标点以及所述第二中心位置点构成所述多个目标控制点。
本公开实施例中,提出在两条车道之间的转向角小于预设角度的情况下,提出可以基于第一中心位置点、第二中心位置点以及第一方向向量和第二方向向量快速确定出这两条车道在路口对应的第二导航路线。
在一种可能的实施方式中,所述基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点,包括:
在所述转向角大于或等于预设角度的情况下,基于所述目标车辆的尺寸信息和所述第一车道对应的障碍区域,确定所述目标车辆由所述第一车道驶入该路口时的第一安全避障距离;
基于所述目标车辆的尺寸信息和所述第二车道对应的障碍区域,确定所述目标车辆由该路口驶入所述第二车道时的第二安全避障距离;
基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量的交点、所述第一安全避障距离和所述第二安全避障距离确定所述多个目标控制点。
本公开实施例中,在确定与较大角度转向对应的第二导航路线的过程中,需要考虑目标车辆在该路口行驶过程中的起点和终点,以及避障距离,以提高目标车辆在路口行驶过程中的安全性。
在一种可能的实施方式中,所述基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量的交点、所述第一安全避障距离和所述第二安全避障距离确定所述多个目标控制点,包括:
获取所述第一中心位置点按照所述第一方向向量指示的方向延长所述第一安全避障距离后得到的第三目标点;以及,
获取所述第二中心位置点按照所述第二方向向量的相反向量指示的方向延长所述第二安全避障距离后得到的第四目标点;
基于所述第三目标点、所述第四目标点、以及所述交点,确定除所述第三目标点和第四目标点之外的其它多个目标点;
其中,所述第三目标点、确定的所述其它多个目标点、和所述第四目标点构成所述多个目标控制点。
在一种可能的实施方式中,所述基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹,包括:
基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在该路口的第二拟合曲线;
按照预设间隔在所述第二拟合曲线上提取多个点,并获取在所述第二拟合曲线上提取的多个点在道路场景中的地理位置;
将在所述第二拟合曲线上提取的多个点在道路场景中的地理位置,作为由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
本公开实施例中,通过在规划出的用于指示目标车辆在路口行驶过程中的第二导航路线,以及确定出第二导航路线中多个点在道路场景中的地理位置,可以准确的得到指导目标车辆在路口行驶的行驶轨迹。
在一种可能的实施方式中,所述控制所述目标车辆按照所述目标导航线进行行驶,包括:
在检测到所述目标车辆按照所述目标导航线行驶过程中存在障碍物的情况下,获取所述障碍物在道路场景中的地理位置;
在控制所述目标车辆按照所述目标导航线进行行驶的过程中,基于所述障碍物的地理位置调整所述目标导航线,以控制所述目标车辆绕开所述障碍物。
本公开实施例中,在控制目标车辆按照目标导航线行驶的过程中,若检测到动态障碍物,可以基于动态障碍物在道路场景中的地理位置进行避障,提高行驶的安全性。
第二方面,本公开实施例提供了一种导航装置,包括:
获取模块,用于获取目标车辆的当前定位位置和导航目的地以及由所述当前定位位置到所述导航目的地之间的道路上的至少一条车道关联的导航线,其中所述导航线是预先生成的;
生成模块,用于基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,所述目标导航线由至少一条所述车道的导航线拼接形成;
控制模块,用于控制所述目标车辆按照所述目标导航线进行行驶。
第三方面,本公开实施例提供了一种电子设备,包括:处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当电子设备运行时,所述处理器与所述存储器之间通过总 线通信,所述机器可读指令被所述处理器执行时执行如第一方面所述的导航方法的步骤。
第四方面,本公开实施例提供了一种计算机可读存储介质,该计算机可读存储介质上存储有计算机程序,该计算机程序被处理器运行时执行如第一方面所述的导航方法的步骤。
第五方面,本公开实施例提供了一种计算机程序产品,包括计算机可读代码,或者承载有计算机可读代码的非易失性计算机可读存储介质,当所述计算机可读代码在电子设备的处理器中运行时,所述电子设备中的处理器执行如第一方面所述的导航方法的步骤。
为使本公开的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
附图说明
为了更清楚地说明本公开实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,此处的附图被并入说明书中并构成本说明书中的一部分,这些附图示出了符合本公开的实施例,并与说明书一起用于说明本公开的技术方案。应当理解,以下附图仅示出了本公开的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1示出了本公开实施例所提供的一种导航方法的流程图;
图2示出了本公开实施例所提供的一种道路场景中路口的场景示意图;
图3示出了本公开实施例所提供的一种确定车道对应的第一导航路线的方法流程图;
图4示出了本公开实施例所提供的一种车道对应的第一导航路线的示意图;
图5示出了本公开实施例所提供的一种确定第二导航路线的方法流程图;
图6示出了本公开实施例所提供的一种确定第二导航路线的具体方法流程图;
图7示出了本公开实施例所提供的一种控制目标车辆行驶的方法流程图;
图8示出了本公开实施例所提供一种的导航装置的结构示意图;
图9示出了本公开实施例所提供的一种电子设备的示意图。
具体实施方式
为使本公开实施例的目的、技术方案和优点更加清楚,下面将结合本公开实施例中附图,对本公开实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本公开实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本公开的实施例的详细描述并非旨在限制要求保护的本公开的范围,而是仅仅表示本公开的选定实施例。基于本公开的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本公开保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
本文中术语“和/或”,仅仅是描述一种关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。另外,本文中术语“至少一种”表示多种中的任意一种或多种中的至少两种的任意组合,例如,包括A、B、C中的至少一种,可以表示包括从A、B和C构成的集合中选择的任意一个或多个元素。
无人车在道路场景中自主行驶的过程中,需要基于采集到的道路场景图像和预先构建的道路场景地图中各条道路之间的连接关系实时确定到达导航目的地的导航路线,该过程效率较低。
基于上述研究,本公开提供了一种导航方法,可以预先生成目标车辆行驶的各条车道关联的导航线,这样目标车辆在行驶过程中,可以根据预先生成的导航线,快速确定出从当前定位位置到达导航目的地的目标导航线,从而提高导航效率。
为便于对本实施例进行理解,首先对本公开实施例所公开的一种导航方法进行详细介绍,本公开实施例所提供的导航方法的执行主体一般为具有一定计算能力的计算机设备,该计算机设备例如包括:终端设备或服务器或其它处理设备,终端设备可以为用户设备(User Equipment,UE)、移动设备、用户终端、终端、计算设备、车载设备、可穿戴设备等。在一些可能的实现方式中,该导航方法可以通过处理器调用存储器中存储的计算机可读指令的方式来实现。
参见图1所示,为本公开实施例提供的导航方法的流程图,该导航方法包括以下S101~S103:
S101,获取目标车辆的当前定位位置和导航目的地以及由当前定位位置到达导航目的地之间的道路上的各车道关联的导航线,其中导航线是预先生成的。
示例性地,目标车辆可以包括无人驾驶车辆,目标车辆上可以设置有多种定位传感器,比如可 以安装有惯性测量单元(Inertial measurement unit,IMU)和全球定位系统(Global Positioning System,GPS)组成的组合导航设备,可以确定目标车辆的当前定位位置。
示例性地,目标车辆上还可以设置有采集设备,比如可以为设置在目标车辆上的单目相机,用于在目标车辆行驶过程中进行拍摄,其拍摄的方向可以预先设定好,基于拍摄得到的道路场景图像,可以采用视觉定位技术获取目标车辆的当前定位位置。
示例性地,导航线可以由多个用于对目标车辆进行导航的轨迹点构成,每个轨迹点对应有唯一标识码和该轨迹点在道路场景中的地理位置信息,目标车辆在道路场景中行驶过程中,可以按照导航线中提供的轨迹点的地理位置进行行驶,直至到达导航目的地。
S102,基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线,目标导航线由至少一条车道的导航线拼接形成。
示例性地,在当前定位位置和导航目的地位于同一车道的情况下,可以基于预先规划的该同一车道的导航线,确定目标车辆由当前定位位置到达导航目的地的目标导航线;在当前定位位置和导航目的地位于不同车道,且需要跨过路口的情况下,可以基于预先规划的不同车道分别对应的导航线、以及连接不同车道的导航线来确定目标车辆由当前定位位置到达导航目的地的目标导航线。
示例性地,目标导航线可以包含多个轨迹点在道路场景中的地理位置,目标车辆按照目标导航线中的多个轨迹点对应的地理位置行驶,可以从当前定位位置到达目的地。
S103,控制目标车辆按照目标导航线进行行驶。
示例性地,确定出目标导航线后,可以控制目标车辆按照目标导航线中各个轨迹点所在的地理位置进行行驶,直至到达导航目的地。
本公开实施例中,可以预先生成目标车辆行驶的各条车道关联的导航线,这样目标车辆在行驶过程中,可以根据预先生成的导航线,快速确定出从当前定位位置到达导航目的地的目标导航线,从而提高导航效率。
下面将结合具体实施例对上述S101~S103进行阐述。
在一种可能的实施方式中,导航线包括用于引导车辆在车道内的行驶路径的第一导航路线;针对上述S102,基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线的一种可选实现方式,包括以下S1021~S1023:
S1021,基于预先存储的车道连接关系,确定目标车辆由当前定位位置到达导航目标地的道路不经过路口的情况下,获取目标车辆由当前定位位置到达导航目的地经过的第一车道组,第一车道组中包含至少一条车道。
示例性地,基于道路场景对应的道路场景地图中存储的车道连接关系中包含每条车道的前驱车道和后继车道,其中目标车辆能够由前驱车道行驶至该车道,并且有该车道行驶至后继车道,因此可以基于当前车道、目标车道、以及道路场景地图中存储的车道连接关系,确定目标车辆由当前定位位置到达导航目的地需要经过的第一车道组。
示例性地,比如当前定位位置所在的车道为车道S1,车道S1的后继车道包含车道S2,其中,只有车道S2的后继车道S3包含导航目的地,因此目标车辆由当前定位位置到达导航目的地经过的第一车道组包括车道S1、车道S2和车道S3。
S1022,提取第一车道组中每条车道对应的第一导航路线。
示例性地,以车道为例,预先生成的该车道的第一导航路线可以包含N个轨迹点,并且可以按照该条车道的行驶方向对这N个轨迹点进行依次编码,得到每个轨迹点的唯一标识码,并将该轨迹点的标识码和在道路场景中的地理位置进行关联存储,以目标车辆行驶在一条东西走向的车道为例,假如目标车辆的当前定位位置与该条车道中的其中一个轨迹点A匹配,可以按照该条车道的第一导航路线中包含的N个轨迹点中各个轨迹点的地理位置以及各个轨迹点的顺序,指示目标车辆从轨迹点A开始如何在该条道路中进行行驶,比如按照该车道的行驶方向,该轨迹点A的下一个轨迹点为轨迹点B,则目标车辆在该条车道的行驶轨迹为从轨迹点A行驶至轨迹点B,第一导航路线的确定过程将在下文进行阐述。
S1023,对第一车道组分别对应的第一导航路线按照由当前定位位置到达导航目的地的顺序进行拼接,得到目标导航线。
示例性地,在目标车辆在车道S1、车道S2和车道S3上行驶时,可以分别按照车道S1、车道S2和车道S3上行驶各自的第一导航路线指示的行驶路径进行行驶,按照由当前定位位置到达导航目的地的顺序,可以对这些第一导航路线进行拼接,可以得到指示目标车辆由当前定位位置到达导航目的地的目标导航线。
本公开实施例中,在确定目标车辆由当前定位位置到达导航目的地的过程中不经过路口的情况下,可以基于经过的至少一条车道分别对应的第一导航路线进行依次连接,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
在一种可能的实施方式中,导航线还包括与车道连接的路口对应的第二导航路线,第二导航路线用于引导车辆由路口连接的第一车道行驶至第二车道的行驶路径;针对上述S102,基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线的一种可选实现方式,还包括以下S1024~S1026:
S1024,基于预先存储的车道连接关系,确定目标车辆由当前定位位置到达导航目标地的道路经过路口的情况下,获取目标车辆由当前定位位置到达导航目的地经过的第二车道组,以及经过的第一路口集,第二车道组包含至少两条车道,第一路口集包含至少一个路口。
示例性地,目标车辆在道路场景中进行行驶的过程中,很多情况下需要路过不同的道路,比如需要从第一条道路行驶至第二条道路,且第一条道路1和第二条道路2之间通过如图2所示的路口连接,当目标车辆到达导航目的地需要从第一条道路1中的车道11行驶至第二条道路2中的车道21的情况下,需要跨过与车道11和车道21连接的路口,因此可以预先生成同一路口连接的不同道路的车道之间的第二导航路线,比如生成从如图2所示的由车道11驶入车道21时在路口的行驶路径的第二导航路线,这里可以将驶入路口的车道称为第一车道,将由路口驶入的车道称为第二车道,即这里的车道11称为第一车道,车道21称为第二车道。
示例性地,第二导航路线与第一导航路线相似,同样包含多个轨迹点,多个轨迹点可以按照目标车辆在不同道路的车道之间的行驶顺序,对多个轨迹点进行编码,得到第二导航路线中每个轨迹点对应有唯一标识码和该轨迹点在道路场景中的地理位置信息,比如上述图2所示,若车道11为驶出车道,车道21为驶入车道,因此生成的连接车道11和车道21的第二导航路线中的多个轨迹点可以按照由车道11到车道21的方向进行依次编码,并存储各轨迹点在道路场景中的地理位置信息,这样目标车辆从车道11向车道21行驶的过程中,可以按照第二导航路线中各轨迹点指示的地理位置进行安全行驶。
S1025,提取第二车道组中每条车道对应的第一导航路线,以及第一路口集中每个路口对应的第二导航路线。
S1026,对第二车道组分别对应的第一导航路线以及路口集分别对应的第二导航路线按照由当前定位位置到达导航目的地的顺序进行拼接,得到目标导航线。
示例性地,在目标车辆需要切换车道的情况下,若需要切换的下一个车道与当前车道之间需要跨过如图2所示的路口,可以按照由当前车道驶入下一个车道时在路口对应的第二导航路线的行驶轨迹行驶,若不需要切换路口,比如两条车道之间的距离很近,可以按照当前车道的第一导航路线中的最后一个轨迹点,以及下一个车道的第一导航路线中的第一个轨迹点,进行切换车道。
本公开实施例中,在确定目标车辆由当前定位位置到达导航目的地的过程中经过路口的情况下,可以基于经过的至少一条车道分别对应的第一导航路线以及至少一个路口对应的第二导航路线进行依次连接,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
在另一种实施方式中,针对上述S102,基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线的一种可选实现方式,包括以下S1027~S1030:
S1027,获取由当前定位位置到达导航目的地的之间的道路中的路口信息。
示例性地,路口信息可以包括路口数量,以及预先存储的每个路口的ID,具体可以根据预先存储得车道连接关系确定,比如根据预先存储的车道连接关系,确定由当前定位位置到达导航目的地之间的道路包含的路口。
S1028,根据路口信息将道路划分为多个路段。
示例性地,可以根据由当前定位位置到达导航目的地的之间的道路中包含的路口,将由当前定位位置到达导航目的地的之间的道路划分为多个路段,被划分的多个路段中存在包含路口的第一路段和不包含路口的第二路段。
S1029,基于导航线确定多个路段中每个路段的目标子导航线。
示例性地,可以根据路段的种类,比如上述提到的第一路段和第二路段分别确定每个路段的目标子导航线,每个路段的目标子导航线用于引导车辆由该路段的起始位置移动至该路段的结束位置。
S1030,对目标子导航线进行拼接,得到目标导航线。
示例性地,在得到每个目标子导航线后,可以按照行驶顺序进行拼接,得到目标导航线。
本公开实施例中,可以根据由当前定位位置到达导航目的地之间的道路包含的路口信息,对该 道路进行分段,进一步可以基于每个路段的目标子导航线,快速得到用于指示目标车辆由当前定位位置到达导航目的地的目标导航线。
具体地,导航线包括用于引导车辆在车道内的行驶路径的第一导航路线和与车道连接的路口对应的第二导航路线,第二导航路线用于引导车辆在由路口连接的第一车道行驶至第二车道的行驶路径;
多个路段包括至少一个第一路段,第一路段经过至少一个路口;
基于导航线确定多个路段中每个路段的目标子导航线的一种可选实现方式,包括针对每个第一路段:
S10291,确定第一路段内的第三车道组和第二路口集,第三车道组包含至少两条车道,第二路口集包括至少一个路口。
示例性地,针对上述S1028,在根据路口信息将道路划分为多个路段后,针对其中一段包含至少一个路口的第一路段,可以基于道路场景对应的道路场景地图,确定该第一路段包含的车道以及路口。
S10292,提取第二路口集的各个路口对应的第二导航路线,以及第三车道组中由第二导航路线指示连接的目标车道的第一导航路线。
示例性地,针对该第一路段中每个路口,可以提取预先生成的该路口对应的第二导航路线,以及第三车道组中由第二导航路线指示连接的目标车道的第一导航路线,比如针对如图2中所示的路口,可以提取由该路口中引导车辆从车道11至车道21的第二导航路线P1P2,以及第三车道组中由第二导航路线P1P2连接的目标车道11和目标车道21分别对应的第一导航路线(图2中未示出)。
S10293,将目标车道的第一导航路线与第二路口集中的各个路口对应的第二导航路线按照在第一路段内的行经顺序进行拼接,得到第一路段的目标子导航线。
示例性地,行经顺序指车辆由当前定位位置到达导航目的地的过程中在该第一路段的行驶顺序,比如行经顺序为从车道11行驶至车道21的情况下,拼接方式为目标车道11对应的第一导航路线与第二导航路线P1P2拼接,第二导航路线P1P2与目标车道21对应的第一导航路线拼接后,得到第一路段的目标子导航线。
本公开实施例中,在确定经过至少一个路口的每个第一路段的目标子导航线的过程中,可以按照该第一路段包含的每个路口对应的第二导航路线,以及该第一路段包含的第三车道组中由第二导航路线指示连接的第一导航路线,快速确定引导目标车辆通过该第一路段中的目标子导航线。
在另一种方式中,多个路段还包括至少一个第二路段,第二路段不经过路口;基于导航线确定多个路段中每个路段的目标子导航线,包括针对每个第二路段:
S10294,基于与第二路段连接的第一路段的目标子导航线,确定第二路段内的起始车道和结束车道。
示例性地,该第二路段连接的上一个第一路段的目标子导航线的结束位置所在的车道可以作为这里第二路段的起始车道,该第二路段连接的下一个第一路段的目标子导航线的开始位置所在的车道可以作为这里第二路段的结束车道,特别地,在该第二路段为多个路段中的第一个路段时,该第二路段内的起始车道具体由当前定位位置所在车道确定,在该第二路段为多个路段中的最后一个路段时,该第二路段内的结束车道具体由导航目的地所在车道确定。
S10295,基于预先存储的车道连接关系,提取第二路段内由起始车道到达结束车道的每条车道对应的第一导航路线。
示例性地,若第二路段内由起始车道到达结束车道中间还包含n个车道,则这里需要提取由起始车道开始,依次经过n个车道到达结束车道的过程中每条车道对应的第一导航路线。
S10296,对第二路段内由起始车道到达结束车道的每条车道对应的第一导航路线按照在第二路段内的行经顺序进行拼接,得到第二路段的目标子导航线。
本公开实施例中,在确定不经过路口的每个第二路段的目标子导航线的过程中,可以按照该第二路段连接的第一路段的目标子导航线,确定第二路段内的启示车道和结束车道,进一步按照预先存储的车道连接关系,可以对第二路段内由起始车道到达结束车道的每条车道的第一导航路线按照行经顺序进行拼接,快速确定引导目标车辆通过该第二路段中的目标子导航线。
针对上述S101中提到的同一车道的第一导航路线,如图3所示,可以按照以下步骤预先生成第一导航路线,包括S201~S203:
S201,针对道路场景中的任一条车道,在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对。
示例性地,可以将该条车道的中心线作为第一导航路线,中心线可以由多个中心位置点来拟合得到,中心位置点可以由该条车道两侧边界的车道线上的一对位置点来确定。
示例性地,该条车道包含两条车道线,可以分别在该条车道的两条车道线上提取多个位置点,使得不同车道线上的两个位置点构成一个位置点对,比如车道线L1中的位置点K1和车道线L2中的位置点K1’构成一个位置点对,车道线L1中的位置点K2和车道线L2中的位置点K2’构成一个位置点,然后通过确定位置点对连线的中心点,可以得到该条车道的中心位置点,在提取位置点对的过程中,应该尽量使得位置点对的连线垂直于两侧的车道线,这样可以提高得到的中心位置点的准确度。
示例性地,考虑到车道在一般情况下存在弯曲,为了提取到准确的位置点对,在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对时,包括以下S2011~S2014:
S2011,获取该条车道包含的两条车道线在道路场景中的长度。
示例性地,该条车道包含的两条车道线在道路场景中的长度可以从预先针对道路场景构建的道路场景地图中得到,比如该条车道包含的两条车道线的长度分别为l1和l2。
S2012,基于该条车道包含的两条车道线中长度最长的车道线的长度,确定多个位置点数量。
示例性地,比较l1和l2,在l1大于l2的情况下,通过l1来确定多个位置点数量,在l2大于l1的情况下,通过l2来确定多个位置点数量。
示例性地,在两条车道线中长度最长的车道线的长度,确定多个位置点的数量时,可以结合预设的位置点间隔来共同确定,比如将两条车道线中长度最长的车道线的长度和预设的位置点间隔的比值,作为多个位置点数量,其中预设的位置点间隔可以根据经验获取。
S2013,基于多个位置点数量,分别在该条车道包含的两条车道线中按照插值方式提取多个位置点。
示例性地,假设得到的多个位置点数量为N,可以在该条车道包含的两条车道线上按照N进行线性插值,得到N个位置点。
S2014,在对该条车道包含的每条车道线上的多个位置点按照车道行驶方向排序后,将不同车道线中序号相同的两个位置点构成一个位置点对。
示例性地,在该条车道具有预设的行驶方向的情况下,可以按照该行驶方向对每条车道线的多个位置点进行排序,在该条车道不具有预设的行驶方向的情况下,可以按照设定的行驶方向对每条车道线的多个位置点进行排序,然后将不同车道线中序号相同的两个位置点构成一个位置点对。
本公开实施例中,通过车道包含的两条车道线中长度较长的车道线的长度来确定位置点数量,可以得到更加与车道形状匹配的位置点对,以便得到准确度较高的中心位置点。
S202,基于多个位置点对分别在道路场景中的地理位置,确定该条车道的多个中心位置点在道路场景中的地理位置;每个位置点对对应一个中心位置点。
示例性地,针对每个位置点对,基于该位置点对中每个位置点在道路场景中的地理位置,确定该位置点对连线的中心位置点在道路场景中的地理位置。
示例性地,可以预先针对道路场景构建世界坐标系,基于此可以将该条道路的车道线上包含的每个位置点在世界坐标系中的世界坐标作为该位置点在道路场景中的地理位置。
示例性地,针对每个位置点对,可以根据该位置点对包含的两个位置点分别在世界坐标系中的世界坐标,确定两个位置点连线的中心位置点在世界坐标系中的世界坐标,可以得到两个位置点连线的中心位置点的世界坐标可以表示该中心位置点在道路场景中的地理位置。
S203,基于多个中心位置点在道路场景中的地理位置,确定该条车道对应的第一导航路线。
具体地,基于多个中心位置点在道路场景中的地理位置,确定该条车道对应的第一导航路线的一种可能实施方式中,可以包括S2031~S2033:
S2031,基于多个中心位置点在道路场景中的地理位置,对多个中心位置点进行曲线拟合,得到第一拟合曲线。
示例性地,在得到多个中心位置点在道路场景中的地理位置后,可以通过三次样条曲线拟合的方式,对多个中心位置点进行曲线拟合,得到第一拟合曲线,该第一拟合曲线可以表示该条车道的中心线。
S2032,按照预设间隔在第一拟合曲线上提取多个点,并获取在第一拟合曲线上提取的多个点在道路场景中的地理位置。
示例性地,预设间隔可以通过从目标车辆采集到自身的当前地理位置,到基于当前地理位置确 定出下一个位置点时行驶的距离来确定,按照该预设间隔在第一拟合曲线上进行插值,提取得到第一拟合曲线上的多个点,以及获取多个点在道路场景中的地理位置。
S2033,将在第一拟合曲线上提取的多个点在道路场景中的地理位置,作为该条车道对应的第一导航路线的行驶轨迹。
本公开实施例中,首先通过车道的若干中心位置点可以拟合得到车道的中心线,然后进一步在该中心线上提取多个点,可以准确的得到指导目标车辆在同一车道中行驶的行驶轨迹。
下面将结合图4所示,以一具体实施例介绍确定同一车道的第一导航路线,具体包括以下过程:
(1)计算车道1的左车道线L1的长度l1,以及右车道线L2的长度l2;
(2)比较l1和l2,用长度较大的长度除以预设值g,得到目标中所需插值数T,目标中心间隔值g一般取5米;
(3)对L1和L2分别根据插值数T重新进行线性插值,生成带有T个点的新的L1和L2
(4)从前往后遍历L1和L2中的所有点,计算每一对位置点的中点。
(5)所有中点组成车道的中心位置点。
(6)使用采样点进行三次样条曲线拟合,按长度0.2米进行插值,得到最后的第一导航路线包含的轨迹点如图4中L3中的轨迹点。
在一种实施方式中,针对上述S101,同一路口连接的不同道路的车道包括第一车道和第二车道,按照以下步骤生成第二导航路线,如图5所示,可以包括以下S301~S303:
S301,分别获取由第一车道驶入该路口时经过的第一中心位置点,以及由该路口驶入第二车道时经过的第二中心位置点;第一中心位置点为第一车道上的最后一个中心位置点,第二中心位置点为第二车道上的第一个中心位置点。
示例性地,可以将第一车道作为驶出车道,将第二车道作为驶入车道,这里来确定由第一车道驶入第二车道时在路口的第二导航路线。
示例性地,第一车道11驶入该路口时经过的第一中心位置点可以在确定第一车道的第一导航路线的过程中确定,同样,该路口驶入第二车道时经过的第二中心位置点可以在确定第二车道的第一导航路线的过程中确定,如上述图2,该路口中示出的第一车道可以为车道11、车道12和车道13,第一车道11对应的第二车道可以包括车道21、车道22和车道23,第一车道12对应的第二车道可以包括车道31、车道32和车道33,第一车道13对应的第二车道可以包括车道41、车道42和车道43,其中P1点各第一车道的第一中心位置点,P2点为各第二车道的第二中心位置点。
S302,基于第一车道上包含第一中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由第一车道驶入该路口的第一方向向量,以及基于第二车道上包含第二中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由该路口驶入第二车道的第二方向向量。
示例性地,在第一车道为驶出车道的情况下,将第一车道包含与第一中心位置点P1相邻的前一个中心位置点C1作为第一方向向量的起点,以第一中心位置点P1作为第一方向向量的终点,得到如图2所示的第一方向向量
Figure PCTCN2021098686-appb-000001
在第二车道为驶入车道的情况下,将第二车道包含与第二中心位置点P2作为第二方向向量的起点,将与第二中心位置点相邻的前一个中心位置点C2作为第二方向向量的终点,得到如图2所示的第二方向向量
Figure PCTCN2021098686-appb-000002
S303,基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
示例性地,第一中心位置点可以表示目标车辆在该路口的起点,第二中心位置点可以表示目标车辆在该路口的终点,第一方向向量可以表示目标车辆由第一车道驶入该路口时的方向,第二方向向量可以表示目标车辆从该路口驶入第二车道时的方向,基于这些参数信息,可以为目标车辆规划安全经过该路口的第二导航路线的行驶轨迹。
本公开实施例中,在确定第二导航路线前,规划了目标车辆在路口的起点位置和终点位置、按照什么方向从起点位置驶入路口、按照什么方向从路口驶入终点,通过该方式可以得到准确度较高的第二导航路线的行驶轨迹。
具体地,基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹的一种可能实施方式中,如图6所示,可以包括以下S401~S403:
S401,基于第一方向向量和第二方向向量,确定由第一车道驶入第二车道驶的转向角。
示例性地,可以将第一方向向量和第二方向向量之间的夹角作为由第一车道驶入第二车道驶的 转向角,在第一车道位于第二车道的对侧的情况下,如上图2中车道11为第一车道,车道31为第二车道的情况,转向角较小;在第二车道位于第一车道的右侧的情况下,如上图2中车道11为第一车道,车道21为第二车道的情况,转向角较大。
S402,基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定用于控制第二导航路线形状的多个目标控制点。
示例性地,可以引入四阶贝塞尔曲线来表示第二导航路线,确定四阶贝塞尔曲线的过程,需要确定出五个目标控制点,这五个目标控制点可以用来表示四阶贝塞尔曲线的形状,以及可以表示第二导航路线的形状。
S403,基于多个目标控制点,确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
示例性地,可以基于多个目标控制点在道路场景中的地理位置,确定出四阶贝塞尔曲线,进一步得到由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
本公开实施例中,提出在确定第二导航路线时,可以先通过第一车道行驶至第二车道的转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定出控制第二导航路线形状的多个目标控制点,从而得到准确度较高的第二导航路线的行驶轨迹。
在基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定四阶贝塞尔曲线的多个目标控制点的过程中,按照转向角的大小,可以分为两种不同的确定方式,一种是确定直线贝塞尔控制点,另一种是确定转向贝塞尔控制点,详见以下阐述。
在一种实施方式中,基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定用于控制第二导航路线形状的多个目标控制点的一种可能实施方式中,包括以下S4021~S4023:
S4021,在转向角小于预设角度的情况下,确定第一中心位置点和第二中心位置点连线的中点,以及第一中心位置点和第二中心位置点的第一距离。
示例性地,在转向角小于预设角度的情况下,按照确定直线贝塞尔控制点的方式确定多个目标控制点,可以基于第一中心位置点P1和第二中心位置点P2分别在世界坐标系下的世界坐标,确定第一中心位置点P1和第二中心位置点P2连线的中点M1在世界坐标系下的世界坐标,以及基于第一中心位置点P1和第二中心位置点P2分别在世界坐标系下的世界坐标,确定第一中心位置点P1和第二中心位置点P2之间的第一距离D1。
S4022,获取第一中心位置点按照第一方向向量指示的方向延长第一距离的预设倍数后得到的第一目标点。
示例性地,以第一中心位置点P1为起点,按照第一方向向量
Figure PCTCN2021098686-appb-000003
延长nD1后可以得到第一目标点B1,其中n表示预设倍数,可以根据路口的尺寸按照经验设定,n的值大于0且小于1。
S4023,获取第二中心位置点按照第二方向向量的相反向量指示的方向延长第一距离的预设倍数后得到的第二目标点;
其中,第一中心位置点、第一目标点、第一中心位置点和第二中心位置点连线的中点、第二目标点以及第二中心位置点构成多个目标控制点。
示例性地,以第二中心位置点P2为起点,按照第二方向向量
Figure PCTCN2021098686-appb-000004
的相反向量
Figure PCTCN2021098686-appb-000005
延长nD1后可以得到第二目标点B2。
将上述得到的第一中心位置点P1、第一目标点B1、第一中心位置点P1和第二中心位置点连线的中点M1、第二目标点B2以及第二中心位置点P2作为四阶贝塞尔曲线的五个目标控制点。
下面以一具体实施例介绍确定直线贝塞尔控制点的过程,具体包括以下步骤:
(1)将第一中心位置点P1为贝塞尔曲线的第一个控制点
(2)确定第一中心位置点P1和第二中心位置点P2的中点M1
(3)确定第一中心位置点P1和第二中心位置点P2之间的长度D1
(4)将第一中心位置点P1以第一方向向量
Figure PCTCN2021098686-appb-000006
进行0.3D1长度的延长得第一目标点B1,将该第一目标点作为贝塞尔曲线的第二个控制点;
(5)将第一中心位置点P1和第二中心位置点P2的中点M1为作为贝塞尔曲线的第三个控制点;
(6)将第二中心位置点P2以第二方向向量
Figure PCTCN2021098686-appb-000007
的反向向量
Figure PCTCN2021098686-appb-000008
进行0.3D1长度的延长得第二目标点B2,将该第二目标点作为贝塞尔曲线的第四个控制点;
(7)将第二中心位置点P2为贝塞尔曲线的第五个控制点。
本公开实施例中,提出在两条车道之间的转向角小于预设角度的情况下,提出可以基于第一中心位置点、第二中心位置点以及第一方向向量和第二方向向量快速确定出这两条车道在路口对应的第二导航路线。
在另一种实施方式中,针对上述S402,基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定用于控制第二导航路线形状的多个目标控制点的一种可能实施方式中,包括以下S4024~S4026:
S4024,在转向角大于或等于预设角度的情况下,基于目标车辆的尺寸信息和第一车道对应的障碍区域,确定目标车辆由第一车道驶入该路口时的第一安全避障距离。
示例性地,在转向角大于或等于预设角度的情况下,按照确定转向贝塞尔控制点的方式确定多个目标控制点,在确定多个目标控制点之前,可以先基于目标车辆的尺寸信息和第一车道对应的障碍区域,确定目标车辆由第一车道驶入该路口时的第一安全避障距离。
示例性地,在一些路口中,平行的两条道路之间可能存在用于分割两条道路的静止障碍物,这些障碍物在道路场景中对应的区域称为障碍区域,如图2所示,该路口包含障碍区域A、障碍区域B、障碍区域C和障碍区域D,以第一车道为如图2中的车道13,第二车道为如图2中的车道43为例,在目标车辆由车道13经过该路口驶入车道43的过程中,在从车道13驶出时需要向前行驶一段距离以超过障碍区域A,需要向前行驶的一段距离可以称为第一安全避障距离,特别地,在不存在障碍区域A的情况下,这里的第一安全避障距离可以为0。
示例性地,可以按照以下方式确定第一安全避障距离:
(1)基于车道13中的第一中心位置点P1和车道43中的第二中心位置点P2,确定障碍搜索方向向量
Figure PCTCN2021098686-appb-000009
示例性地,该障碍搜索方向向量用于确定车道13关联的障碍区域和车道43关联的障碍区域,如图2中车道13关联的障碍区域为A,车道43关联的障碍区域为D。
(2)基于障碍搜索方向向量和车道13对应的第一方向向量
Figure PCTCN2021098686-appb-000010
确定障碍敏感方向向量
Figure PCTCN2021098686-appb-000011
示例性地,该障碍物敏感方向向量用于指示容易和目标车辆发生碰撞的障碍区域所在的方向。
(3)针对车道13,对障碍区域A轮廓上包含的多个边界点Q i进行遍历,分别构建矢量
Figure PCTCN2021098686-appb-000012
并确定
Figure PCTCN2021098686-appb-000013
Figure PCTCN2021098686-appb-000014
上的投影的长度d i;其中Q i表示多个边界点中的第i个边界点,
Figure PCTCN2021098686-appb-000015
表示基于第i个边界点和第一中心位置点构建的第i个矢量;d i表示第i个矢量在
Figure PCTCN2021098686-appb-000016
上的投影的长度。
示例性地,该长度d i用于筛选出若目标车辆未按照第一安全避障距离向前行驶容易与目标车辆发生碰撞的目标边界点。
(4)基于d i和第一预设范围(比如第一预设范围为大于0且小于h,其中h与车身的宽度相关,可以等于车身宽度),选择使得d i符合预设范围的目标边界点;
(5)在确定存在至少一个目标边界点的情况下,确定每个目标边界点和第一中心位置点P1构成的矢量
Figure PCTCN2021098686-appb-000017
在第一方向向量
Figure PCTCN2021098686-appb-000018
上的投影长度N x(其中Q x表示至少一个目标边界点中的第x个目标边界点,N x表示第x个目标点对应的投影长度);
(6)基于投影长度N x和第二预设范围(比如第二预设范围为大于0且小于m,其中m为预先基于障碍区域的尺寸按照经验设置的,用于指示障碍区域属于车道13侧的障碍区域),筛选出符合第二预设范围且长度最长的N1作为第一安全避障距离,如图2所示。
S4025,基于目标车辆的尺寸信息和第二车道对应的障碍区域,确定目标车辆由该路口驶入第二车道时的第二安全避障距离。
示例性地,确定第二安全避障距离的过程使用到的障碍搜索方向向量为
Figure PCTCN2021098686-appb-000019
第二车道为上述图2中的车道43的情况下,可以基于障碍区域D、目标车辆的尺寸信息和障碍搜索方向向量为
Figure PCTCN2021098686-appb-000020
来确定第二安全避障距离N2,如图2所示,确定过程与上述确定第一安全避障距离N1的原理相同,在此不再赘述。
S4026,基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量的交点、第一安全避障距离和第二安全避障距离确定多个目标控制点。
本公开实施例中,在确定与较大角度转向对应的第二导航路线的过程中,需要考虑目标车辆在 该路口行驶过程中的起点和终点,以及避障距离,以提高目标车辆在路口行驶过程中的安全性。
具体地,基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量的交点、第一安全避障距离和第二安全避障距离确定多个目标控制点的一种可能的实施方式中,包括以下S40261~S40263:
S40261,获取第一中心位置点按照第一方向向量指示的方向延长第一安全避障距离后得到的第三目标点。
示例性地,以第一中心位置点P1为起点,按照第一方向向量
Figure PCTCN2021098686-appb-000021
延长N1后可以得到第三目标点B3。
S40262,获取第二中心位置点按照第二方向向量指示的方向延长第二安全避障距离后得到的第四目标点。
示例性地,以第二中心位置点P2为起点,按照第二方向向量
Figure PCTCN2021098686-appb-000022
的反向向量
Figure PCTCN2021098686-appb-000023
延长N2后可以得到第四目标点B4。
S40263,基于第三目标点、第四目标点、以及交点,确定除第三目标点和第四目标点之外的其它多个目标点。
其中,第三目标点、确定的其它多个目标点、和第四目标点构成多个目标控制点。
示例性地,第三目标点可以作为转向贝塞尔控制点的第一个目标控制点,第四目标点可以作为转向贝塞尔控制点中的第五个目标控制点,其它多个目标控制点分别可以包含转向贝塞尔控制点中的第二个目标控制点、第三个目标控制点和第四个目标控制点。
具体地,基于第三目标点、第四目标点、以及交点,确定除第三目标点和第四目标点之外的其它多个目标点的一种可能的实施方式中,包括:
(1)获取第一方向向量和第二方向向量的交点M2;
(2)确定第三目标点B3和交点M2之间的长度D2,以及确定第四目标点B4和交点M2之间的长度D3;
(3)确定(D2+D3)/4与D2的比例r1,以及确定(D2+D3)/4与D3的比例r2;
(4)在第三目标点B3和交点M2之间选取一个切分点作为第五目标点B5,使得B3到B5之间的距离和B3到M2之间的距离的比值等于上述r1;其中第五目标点B5作为转向贝塞尔控制点中的第二个目标控制点;
(5)在第四目标点B4和交点M2之间选取一个切分点作为第六目标点B6,使得B4到B6之间的距离和B4到M2之间的距离的比值等于上述r2;第六目标点B6作为转向贝塞尔控制点中的第四个目标控制点;
(6)确定e=D2-D3,在D2大于D3的情况下,确定(D2+D3)/2在D2上的且分点M3,然后将M3和
Figure PCTCN2021098686-appb-000024
相加后,得到第七目标点B7,将第七目标点B7作为该情况下转向贝塞尔控制点的第三目标控制点;在D2小于D3的情况下,确定(D2+D3)/2在D3上的且分点M4,然后将M4和
Figure PCTCN2021098686-appb-000025
相加后,得到第八目标点B8,将第七目标点B8作为该情况下转向贝塞尔控制点的第三目标控制点;在D2等于D3的情况下,将第一方向向量和第二方向向量的交点M2作为转向贝塞尔控制点中的第三目标控制点。
在一种实施方式中,针对上述S403,基于多个目标控制点,确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹的一种可能实施方式中,可以包括以下S4031~S4033:
S4031,基于多个目标控制点,确定由第一车道驶入第二车道时在该路口的第二拟合曲线。
示例性地,可以将多个目标控制点在道路场景中的地理位置输入四阶贝塞尔曲线函数,得到第二拟合曲线。
S4032,按照预设间隔在第二拟合曲线上提取多个点,并获取在第二拟合曲线上提取的多个点在道路场景中的地理位置。
示例性地,预设间隔可以通过从目标车辆采集到自身的当前地理位置,到基于当前地理位置确定出下一个位置点时行驶的距离来确定,按照该预设间隔在第二拟合曲线上进行插值,提取得到第二拟合曲线上的多个点,以及获取多个点在道路场景中的地理位置。
S4033,将在第二拟合曲线上提取的多个点在道路场景中的地理位置,作为由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
示例性地,如上述图2中所示,示出三条第二导航路线的行驶轨迹,分别为车道11到车道21在路口的第二导航路线的行驶轨迹U1,车道12到车道32在路口的第二导航路线的行驶轨迹U2, 以及车道13到车道43在路口的第二导航路线的行驶轨迹U3。
本公开实施例中,通过在规划出的用于指示目标车辆在路口行驶过程中的第二导航路线,以及确定出第二导航路线中多个点在道路场景中的地理位置,可以准确的得到指导目标车辆在路口行驶的行驶轨迹。
在一种实施方式中,针对上述S103,在控制目标车辆按照目标导航线进行行驶时,如图7所示,可以包括以下S501~S502:
S501,在检测到目标车辆按照目标导航线行驶过程中存在障碍物的情况下,获取障碍物在道路场景中的地理位置。
示例性地,在这里的障碍物属于动态障碍物,比如行人、车辆等。
示例性地,可以通过目标车辆上安装的采集设备,比如单目相机来获取道路场景图像,基于道路场景图像中检测到动态障碍物的情况下,可以基于障碍物在道路场景图像中的图像位置、以及预先确定的单目相机拍摄的道路场景图像对应的图像坐标系和目标车辆对应的车体坐标系之间的转换关系,确定出障碍物在车体坐标系下的坐标位置,进一步基于目标车辆在道路场景中的地理位置,确定出障碍物在道路场景中的地理位置。
S502,在控制目标车辆按照目标导航线进行行驶的过程中,基于障碍物的地理位置调整目标导航线,以控制目标车辆绕开障碍物。
示例性地,在目标车辆按照目标导航线进行行驶过程中,若检测到障碍物位于目标车辆的行驶前方,可以控制目标车辆停止,在检测到障碍物离开目标车辆的行驶前方后,再控制目标车辆继续按照目标导航线进行行驶,或者,在检测到障碍物位于目标车辆的行驶前方的情况下,可以控制目标车辆转移到相邻的车道对应的第一导航路线上继续行驶,在检测到初始车道不存在障碍物的情况下,再控制目标车辆行驶到初始车道中,按照目标导航线继续行驶。
本公开实施例中,在控制目标车辆按照目标导航线行驶的过程中,若检测到动态障碍物,可以基于动态障碍物在道路场景中的地理位置进行避障,提高行驶的安全性。
本领域技术人员可以理解,在具体实施方式的上述方法中,各步骤的撰写顺序并不意味着严格的执行顺序而对实施过程构成任何限定,各步骤的具体执行顺序应当以其功能和可能的内在逻辑确定。
基于同一技术构思,本公开实施例中还提供了与导航方法对应的导航装置,由于本公开实施例中的装置解决问题的原理与本公开实施例上述导航方法相似,因此装置的实施可以参见方法的实施,重复之处不再赘述。
参照图8所示,为本公开实施例提供的一种导航装置600的示意图,该导航装置600包括:
获取模块601,用于获取目标车辆的当前定位位置和导航目的地以及由当前定位位置到达导航目的地之间的道路上的至少一条车道关联的导航线,其中导航线是预先生成的;生成模块602,用于基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线,目标导航线由至少一条车道的导航线拼接形成;控制模块603,用于控制目标车辆按照目标导航线进行行驶。
在一种可能的实施方式中,导航线包括用于引导车辆在车道内的行驶路径的第一导航路线;生成模块602在用于基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线时,包括:基于预先存储的车道连接关系,确定目标车辆由当前定位位置到达导航目标地的道路不经过路口的情况下,获取目标车辆由当前定位位置到达导航目的地经过的第一车道组,第一车道组中包含至少一条车道;提取第一车道组中至少一条车道对应的第一导航路线;对第一车道组分别对应的第一导航路线按照由当前定位位置到达导航目的地的顺序进行拼接,得到目标导航线。
在一种可能的实施方式中,导航线还包括与车道连接的路口对应的第二导航路线,第二导航路线用于引导车辆在由路口由连接的第一车道行驶至第二车道的行驶路径;生成模块602用于按照如下方式生成目标车辆由当前定位位置到达导航目的地的目标导航线:基于预先存储的车道连接关系,确定目标车辆由当前定位位置到达导航目标地的道路经过路口的情况下,获取目标车辆由当前定位位置到达导航目的地经过的第二车道组,以及经过的第一路口集,第二车道组包含至少两条车道,第一路口集包含至少一个路口;提取第二车道组中至少一条车道对应的第一导航路线,以及第一路口集中至少一个路口对应的第二导航路线;对第二车道组分别对应的第一导航路线以及路口集分别对应的第二导航路线按照由当前定位位置到达导航目的地的顺序进行拼接,得到目标导航线。
在一种可能的实施方式中,生成模块602用于按照如下方式生成所述目标车辆由当前定位位置到达导航目的地的目标导航线:获取由当前定位位置到达导航目的地的之间的道路中的路口信息;根据所述路口信息将所述道路划分为多个路段;基于所述导航线确定所述多个路段中至少一个路段 的目标子导航线;对所述目标子导航线进行拼接,得到所述目标导航线。
在一种可能的实施方式中,所述导航线包括用于引导车辆在车道内的行驶路径的第一导航路线和与车道连接的路口对应的第二导航路线,所述第二导航路线用于引导车辆在由所述路口连接的第一车道行驶至第二车道的行驶路径;所述多个路段包括至少一个第一路段,所述第一路段经过至少一个路口;生成模块602用于针对至少一个第一路段,按照如下方式确定多个路段中至少一个路段的目标子导航线:确定所述第一路段内的第三车道组和第二路口集,所述第三车道组包含至少两条车道,所述第二路口集包括至少一个路口;提取所述第二路口集的至少一个路口对应的第二导航路线,以及所述第三车道组中由所述第二导航路线指示连接的目标车道的第一导航路线;将所述目标车道的第一导航路线与所述第二路口集中的至少一个路口对应的第二导航路线按照在所述第一路段内的行经顺序进行拼接,得到所述第一路段的目标子导航线。
在一种可能的实施方式中,所述多个路段还包括至少一个第二路段,所述第二路段不经过路口;生成模块602用于针对至少一个第二路段,按照如下方式确定多个路段中至少一个路段的目标子导航线:基于与所述第二路段连接的第一路段的目标子导航线,确定所述第二路段内的起始车道和结束车道;基于预先存储的车道连接关系,提取所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线;对所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线按照在所述第二路段内的行经顺序进行拼接,得到所述第二路段的目标子导航线。
在一种可能的实施方式中,生成模块602用于按照以下步骤预先生成第一导航路线:针对道路场景中的任一条车道,在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对;基于多个位置点对分别在道路场景中的地理位置,确定该条车道的多个中心位置点在道路场景中的地理位置;每个位置点对对应一个中心位置点;基于多个中心位置点在道路场景中的地理位置,确定该条车道对应的第一导航路线。
在一种可能的实施方式中,生成模块602用于按照如下方式在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对:获取该条车道包含的两条车道线在道路场景中的长度;基于该条车道包含的两条车道线中长度最长的车道线的长度,确定多个位置点数量;基于多个位置点数量,分别在该条车道包含的两条车道线中按照插值方式提取多个位置点;在对该条车道包含的至少一条车道线上的多个位置点按照车道行驶方向排序后,将不同车道线中序号相同的两个位置点构成一个位置点对。
在一种可能的实施方式中,生成模块602用于基于多个位置点对分别在道路场景中的地理位置,按照如下方式确定该条车道的多个中心位置点在道路场景中的地理位置:针对至少一个位置点对,基于该位置点对中至少一个位置点在道路场景中的地理位置,确定该位置点对连线的中心位置点在道路场景中的地理位置。
在一种可能的实施方式中,生成模块602在用于基于多个中心位置点在道路场景中的地理位置,按照如下方式确定该条车道对应的第一导航路线:基于多个中心位置点在道路场景中的地理位置,对多个中心位置点进行曲线拟合,得到第一拟合曲线;按照预设间隔在第一拟合曲线上提取多个点,并获取在第一拟合曲线上提取的多个点在道路场景中的地理位置;将在第一拟合曲线上提取的多个点在道路场景中的地理位置,作为该条车道对应的第一导航路线的行驶轨迹。
在一种可能的实施方式中,同一路口连接的不同道路的车道包括第一车道和第二车道,生成模块602用于按照以下步骤生成第二导航路线:分别获取由第一车道驶入该路口时经过的第一中心位置点,以及由该路口驶入第二车道时经过的第二中心位置点;第一中心位置点为第一车道上的最后一个中心位置点,第二中心位置点为第二车道上的第一个中心位置点;基于第一车道上包含第一中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由第一车道驶入该路口的第一方向向量,以及基于第二车道上包含第二中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由该路口驶入第二车道的第二方向向量;基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
在一种可能的实施方式中,生成模块602用于基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,按照如下方式确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹:基于第一方向向量和第二方向向量,确定由第一车道驶入第二车道驶的转向角;基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,确定用于控制第二导航路线形状的多个目标控制点;基于多个目标控制点,确定由第一车道驶入第二车道时在路口的第二导 航路线的行驶轨迹。
在一种可能的实施方式中,生成模块602用于基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,按照如下方式确定用于控制第二导航路线形状的多个目标控制点:在转向角小于预设角度的情况下,确定第一中心位置点和第二中心位置点连线的中点,以及第一中心位置点和第二中心位置点的第一距离;获取第一中心位置点按照第一方向向量指示的方向延长第一距离的预设倍数后得到的第一目标点;获取第二中心位置点按照第二方向向量的反向向量指示的方向延长第一距离的预设倍数后得到的第二目标点;其中,第一中心位置点、第一目标点、第一中心位置点和第二中心位置点连线的中点、第二目标点以及第二中心位置点构成多个目标控制点。
在一种可能的实施方式中,生成模块602用于基于转向角、第一中心位置点、第二中心位置点、第一方向向量和第二方向向量,按照如下方式确定用于控制第二导航路线形状的多个目标控制点:在转向角大于或等于预设角度的情况下,基于目标车辆的尺寸信息和第一车道对应的障碍区域,确定目标车辆由第一车道驶入该路口时的第一安全避障距离;基于目标车辆的尺寸信息和第二车道对应的障碍区域,确定目标车辆由该路口驶入第二车道时的第二安全避障距离;基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量的交点、第一安全避障距离和第二安全避障距离确定多个目标控制点。
在一种可能的实施方式中,生成模块602用于基于第一中心位置点、第二中心位置点、第一方向向量和第二方向向量的交点、第一安全避障距离和第二安全避障距离,按照如下方式确定多个目标控制点:获取第一中心位置点按照第一方向向量指示的方向延长第一安全避障距离后得到的第三目标点;以及,获取第二中心位置点按照第二方向向量的反向向量指示的方向延长第二安全避障距离后得到的第四目标点;基于第三目标点、第四目标点、以及交点,确定除第三目标点和第四目标点之外的其它多个目标点;其中,第三目标点、确定的其它多个目标点、和第四目标点构成多个目标控制点。
在一种可能的实施方式中,生成模块602用于基于多个目标控制点,按照如下方式确定由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹:基于多个目标控制点,确定由第一车道驶入第二车道时在该路口的第二拟合曲线;按照预设间隔在第二拟合曲线上提取多个点,并获取在第二拟合曲线上提取的多个点在道路场景中的地理位置;将在第二拟合曲线上提取的多个点在道路场景中的地理位置,作为由第一车道驶入第二车道时在路口的第二导航路线的行驶轨迹。
在一种可能的实施方式中,控制模块603用于按照如下方式控制目标车辆按照目标导航线进行行驶:在检测到目标车辆按照目标导航线行驶过程中存在障碍物的情况下,获取障碍物在道路场景中的地理位置;在控制目标车辆按照目标导航线进行行驶的过程中,基于障碍物的地理位置调整目标导航线,以控制目标车辆绕开障碍物。
关于装置中的各模块的处理流程、以及各模块之间的交互流程的描述可以参照上述方法实施例中的相关说明,这里不再详述。
对应于图1中的导航方法,本公开实施例还提供了一种电子设备700,如图9所示,为本公开实施例提供的电子设备700结构示意图,包括:
处理器71、存储器72、和总线73;存储器72用于存储执行指令,包括内存721和外部存储器722;这里的内存721也称内存储器,用于暂时存放处理器71中的运算数据,以及与硬盘等外部存储器722交换的数据,处理器71通过内存721与外部存储器722进行数据交换,当电子设备700运行时,处理器71与存储器72之间通过总线73通信,使得处理器71执行以下指令:获取目标车辆的当前定位位置和导航目的地以及由当前定位位置到导航目的地之间的道路上的各车道关联的导航线,其中导航线是预先生成的;基于导航线,生成目标车辆由当前定位位置到达导航目的地的目标导航线,目标导航线由至少一条车道的导航线拼接形成;控制目标车辆按照目标导航线进行行驶。
本公开实施例还提供一种计算机可读存储介质,该计算机可读存储介质上存储有计算机程序,该计算机程序被处理器运行时执行上述方法实施例中的导航方法的步骤。其中,该存储介质可以是易失性或非易失的计算机可读取存储介质。
本公开实施例还提供一种计算机程序产品,包括计算机可读代码,或者承载有计算机可读代码的非易失性计算机可读存储介质,当该计算机可读代码在电子设备的处理器中运行时,电子设备中的处理器执行上述方法实施例中所述的导航方法的步骤,具体可参见上述方法实施例,在此不再赘述。
其中,上述计算机程序产品可以具体通过硬件、软件或其结合的方式实现。在一个可选实施例中,所述计算机程序产品具体体现为计算机存储介质,在另一个可选实施例中,计算机程序产品具 体体现为软件产品,例如软件开发包(Software Development Kit,SDK)等等。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统和装置的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。在本公开所提供的几个实施例中,应该理解到,所揭露的系统、装置和方法,可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,又例如,多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本公开各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个处理器可执行的非易失的计算机可读取存储介质中。基于这样的理解,本公开的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本公开各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是:以上所述实施例,仅为本公开的具体实施方式,用以说明本公开的技术方案,而非对其限制,本公开的保护范围并不局限于此,尽管参照前述实施例对本公开进行了详细的说明,本领域的普通技术人员应当理解:任何熟悉本技术领域的技术人员在本公开揭露的技术范围内,其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化,或者对其中部分技术特征进行等同替换;而这些修改、变化或者替换,并不使相应技术方案的本质脱离本公开实施例技术方案的精神和范围,都应涵盖在本公开的保护范围之内。因此,本公开的保护范围应所述以权利要求的保护范围为准。

Claims (21)

  1. 一种导航方法,其特征在于,包括:
    获取目标车辆的当前定位位置和导航目的地以及由所述当前定位位置到达所述导航目的地之间的道路上的至少一条车道关联的导航线,其中所述导航线是预先生成的;
    基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,所述目标导航线由至少一条所述车道的导航线拼接形成;
    控制所述目标车辆按照所述目标导航线进行行驶。
  2. 根据权利要求1所述的导航方法,其特征在于,所述导航线包括用于引导车辆在车道内的行驶路径的第一导航路线;
    所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,包括:
    基于预先存储的车道连接关系,确定所述目标车辆由所述当前定位位置到达所述导航目标地的道路不经过路口的情况下,获取所述目标车辆由所述当前定位位置到达所述导航目的地经过的第一车道组,所述第一车道组中包含至少一条车道;
    提取所述第一车道组中至少一条车道对应的第一导航路线;
    对所述第一车道组分别对应的所述第一导航路线按照由所述当前定位位置到达所述导航目的地的顺序进行拼接,得到所述目标导航线。
  3. 根据权利要求2所述的导航方法,其特征在于,所述导航线还包括与车道连接的路口对应的第二导航路线,所述第二导航路线用于引导车辆在由所述路口连接的第一车道行驶至第二车道的行驶路径;
    所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,包括:
    基于预先存储的车道连接关系,确定所述目标车辆由所述当前定位位置到达所述导航目标地的道路经过路口的情况下,获取所述目标车辆由所述当前定位位置到达所述导航目的地经过的第二车道组,以及经过的第一路口集,所述第二车道组包含至少两条车道,所述第一路口集包含至少一个路口;
    提取所述第二车道组中至少一条车道对应的第一导航路线,以及所述第一路口集中至少一个路口对应的第二导航路线;
    对所述第二车道组分别对应的所述第一导航路线以及所述路口集分别对应的第二导航路线按照由所述当前定位位置到达所述导航目的地的顺序进行拼接,得到所述目标导航线。
  4. 根据权利要求1所述的导航方法,其特征在于,所述基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,包括:
    获取由当前定位位置到达导航目的地的之间的道路中的路口信息;
    根据所述路口信息将所述道路划分为多个路段;
    基于所述导航线确定所述多个路段中至少一个路段的目标子导航线;
    对所述目标子导航线进行拼接,得到所述目标导航线。
  5. 根据权利要求4所述的导航方法,其特征在于,所述导航线包括用于引导车辆在车道内的行驶路径的第一导航路线和与车道连接的路口对应的第二导航路线,所述第二导航路线用于引导车辆在由所述路口连接的第一车道行驶至第二车道的行驶路径;
    所述多个路段包括至少一个第一路段,所述第一路段经过至少一个路口;
    所述基于所述导航线确定所述多个路段中至少一个路段的目标子导航线,包括针对至少一个第一路段:
    确定所述第一路段内的第三车道组和第二路口集,所述第三车道组包含至少两条车道,所述第二路口集包括至少一个路口;
    提取所述第二路口集的至少一个路口对应的第二导航路线,以及所述第三车道组中由所述第二导航路线指示连接的目标车道的第一导航路线;
    将所述目标车道的第一导航路线与所述第二路口集中的至少一个路口对应的第二导航路线按照在所述第一路段内的行经顺序进行拼接,得到所述第一路段的目标子导航线。
  6. 根据权利要求5所述的导航方法,其特征在于,所述多个路段还包括至少一个第二路段,所述第二路段不经过路口;
    所述基于所述导航线确定所述多个路段中至少一个路段的目标子导航线,包括针对至少一个第二路段:
    基于与所述第二路段连接的第一路段的目标子导航线,确定所述第二路段内的起始车道和结束车道;
    基于预先存储的车道连接关系,提取所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线;
    对所述第二路段内由所述起始车道到达所述结束车道的至少一条车道对应的第一导航路线按照在所述第二路段内的行经顺序进行拼接,得到所述第二路段的目标子导航线。
  7. 根据权利要求2-3、5-6中任一所述的导航方法,其特征在于,按照以下步骤预先生成所述第一导航路线:
    针对道路场景中的任一条车道,在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对;
    基于所述多个位置点对分别在所述道路场景中的地理位置,确定该条车道的多个中心位置点在所述道路场景中的地理位置;每个位置点对对应一个中心位置点;
    基于所述多个中心位置点在所述道路场景中的地理位置,确定该条车道对应的第一导航路线。
  8. 根据权利要求7所述的导航方法,其特征在于,所述在该条车道对应的指示车道两侧边界的车道线中分别提取多个位置点,构成多个位置点对,包括:
    获取该条车道包含的两条车道线在所述道路场景中的长度;
    基于该条车道包含的两条车道线中长度最长的车道线的长度,确定所述多个位置点数量;
    基于所述多个位置点数量,分别在该条车道包含的两条车道线中按照插值方式提取所述多个位置点;
    在对该条车道包含的至少一条车道线上的多个位置点按照车道行驶方向排序后,将不同车道线中序号相同的两个位置点构成一个位置点对。
  9. 根据权利要求7或8所述的导航方法,其特征在于,所述基于所述多个位置点对分别在所述道路场景中的地理位置,确定该条车道的多个中心位置点在所述道路场景中的地理位置,包括:
    针对至少一个位置点对,基于该位置点对中至少一个位置点在所述道路场景中的地理位置,确定该位置点对连线的中心位置点在所述道路场景中的地理位置。
  10. 根据权利要求7-9任一所述的导航方法,其特征在于,所述基于所述多个中心位置点在所述道路场景中的地理位置,确定该条车道对应的第一导航路线,包括:
    基于所述多个中心位置点在所述道路场景中的地理位置,对所述多个中心位置点进行曲线拟合,得到第一拟合曲线;
    按照预设间隔在所述第一拟合曲线上提取多个点,并获取在所述第一拟合曲线上提取的多个点在所述道路场景中的地理位置;
    将在所述第一拟合曲线上提取的多个点在道路场景中的地理位置,作为该条车道对应的第一导航路线的行驶轨迹。
  11. 根据权利要求3、5-6中任一所述的导航方法,其特征在于,按照以下步骤生成所述第二导航路线:
    分别获取由所述第一车道驶入该路口时经过的第一中心位置点,以及由该路口驶入所述第二车道时经过的第二中心位置点;所述第一中心位置点为所述第一车道上的最后一个中心位置点,所述第二中心位置点为所述第二车道上的第一个中心位置点;
    基于所述第一车道上包含所述第一中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由所述第一车道驶入该路口的第一方向向量,以及基于所述第二车道上包含所述第二中心位置点在内的相邻两个中心位置点分别对应的地理位置,确定用于表征由该路口驶入所述第二车道的第二方向向量;
    基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
  12. 根据权利要求11所述的导航方法,其特征在于,所述基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹,包括:
    基于所述第一方向向量和所述第二方向向量,确定由所述第一车道驶入所述第二车道驶的转向角;
    基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点;
    基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
  13. 根据权利要求12所述的导航方法,其特征在于,所述基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点,包括:
    在所述转向角小于预设角度的情况下,确定所述第一中心位置点和所述第二中心位置点连线的中点,以及所述第一中心位置点和所述第二中心位置点的第一距离;
    获取所述第一中心位置点按照所述第一方向向量指示的方向延长所述第一距离的预设倍数后得到的第一目标点;
    获取所述第二中心位置点按照所述第二方向向量的相反向量指示的方向延长所述第一距离的预设倍数后得到的第二目标点;
    其中,所述第一中心位置点、所述第一目标点、所述第一中心位置点和所述第二中心位置点连线的中点、所述第二目标点以及所述第二中心位置点构成所述多个目标控制点。
  14. 根据权利要求12所述的导航方法,其特征在于,所述基于所述转向角、所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量,确定用于控制所述第二导航路线形状的多个目标控制点,包括:
    在所述转向角大于或等于预设角度的情况下,基于所述目标车辆的尺寸信息和所述第一车道对应的障碍区域,确定所述目标车辆由所述第一车道驶入该路口时的第一安全避障距离;
    基于所述目标车辆的尺寸信息和所述第二车道对应的障碍区域,确定所述目标车辆由该路口驶入所述第二车道时的第二安全避障距离;
    基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量的交点、所述第一安全避障距离和所述第二安全避障距离确定所述多个目标控制点。
  15. 根据权利要求14所述的导航方法,其特征在于,所述基于所述第一中心位置点、所述第二中心位置点、所述第一方向向量和所述第二方向向量的交点、所述第一安全避障距离和所述第二安全避障距离确定所述多个目标控制点,包括:
    获取所述第一中心位置点按照所述第一方向向量指示的方向延长所述第一安全避障距离后得到的第三目标点;以及,
    获取所述第二中心位置点按照所述第二方向向量的相反向量指示的方向延长所述第二安全避障距离后得到的第四目标点;
    基于所述第三目标点、所述第四目标点、以及所述交点,确定除所述第三目标点和第四目标点之外的其它多个目标点;
    其中,所述第三目标点、确定的所述其它多个目标点、和所述第四目标点构成所述多个目标控制点。
  16. 根据权利要求12-15任一所述的导航方法,其特征在于,所述基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹,包括:
    基于所述多个目标控制点,确定由所述第一车道驶入所述第二车道时在该路口的第二拟合曲线;
    按照预设间隔在所述第二拟合曲线上提取多个点,并获取在所述第二拟合曲线上提取的多个点在道路场景中的地理位置;
    将在所述第二拟合曲线上提取的多个点在道路场景中的地理位置,作为由所述第一车道驶入所述第二车道时在所述路口的第二导航路线的行驶轨迹。
  17. 根据权利要求1-16任一所述的导航方法,其特征在于,所述控制所述目标车辆按照所述目标导航线进行行驶,包括:
    在检测到所述目标车辆按照所述目标导航线行驶过程中存在障碍物的情况下,获取所述障碍物在道路场景中的地理位置;
    在控制所述目标车辆按照所述目标导航线进行行驶的过程中,基于所述障碍物的地理位置调整所述目标导航线,以控制所述目标车辆绕开所述障碍物。
  18. 一种导航装置,其特征在于,包括:
    获取模块,用于获取目标车辆的当前定位位置和导航目的地以及由所述当前定位位置到所述导航目的地之间的道路上的至少一条车道关联的导航线,其中所述导航线是预先生成的;
    生成模块,用于基于所述导航线,生成所述目标车辆由当前定位位置到达导航目的地的目标导航线,所述目标导航线由至少一条所述车道的导航线拼接形成;
    控制模块,用于控制所述目标车辆按照所述目标导航线进行行驶。
  19. 一种电子设备,其特征在于,包括:处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当电子设备运行时,所述处理器与所述存储器之间通过总线通信,所述机器可读指令被所述处理器执行时执行如权利要求1-17任一所述的导航方法的步骤。
  20. 一种计算机可读存储介质,其特征在于,该计算机可读存储介质上存储有计算机程序,该计算机程序被处理器运行时执行如权利要求1-17任一所述的导航方法的步骤。
  21. 一种计算机程序产品,包括计算机可读代码,或者承载有计算机可读代码的非易失性计算机可读存储介质,当所述计算机可读代码在电子设备的处理器中运行时,所述电子设备中的处理器执行用于实现权利要求1-17中的任一权利要求所述的方法。
PCT/CN2021/098686 2021-03-30 2021-06-07 一种导航方法、装置、电子设备及存储介质 WO2022205617A1 (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020227029065A KR20220137034A (ko) 2021-03-30 2021-06-07 내비게이팅 방법, 장치, 전자 기기 및 저장 매체

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110338827.3A CN113008261B (zh) 2021-03-30 2021-03-30 一种导航方法、装置、电子设备及存储介质
CN202110338827.3 2021-03-30

Publications (1)

Publication Number Publication Date
WO2022205617A1 true WO2022205617A1 (zh) 2022-10-06

Family

ID=76409195

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/098686 WO2022205617A1 (zh) 2021-03-30 2021-06-07 一种导航方法、装置、电子设备及存储介质

Country Status (3)

Country Link
KR (1) KR20220137034A (zh)
CN (1) CN113008261B (zh)
WO (1) WO2022205617A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116817930A (zh) * 2023-08-30 2023-09-29 国汽(北京)智能网联汽车研究院有限公司 车辆导航的方法、装置、设备和存储介质

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113720348B (zh) * 2021-11-01 2022-03-18 深圳市城市交通规划设计研究中心股份有限公司 一种车路协同环境下的车辆车道级定位方法及电子设备
CN114495554A (zh) * 2021-12-31 2022-05-13 武汉中海庭数据技术有限公司 一种用于智能驾驶的路口引导信息构建方法和系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110066312A1 (en) * 2009-09-15 2011-03-17 Electronics And Telecommunications Research Institute Navigation apparatus and driving route information providing method using the same and automatic driving system and method
CN105651295A (zh) * 2016-01-15 2016-06-08 武汉光庭信息技术股份有限公司 基于Bezier曲线构建交叉路口驶入驶出车道Link的连接曲线算法
CN106441312A (zh) * 2015-08-11 2017-02-22 高德软件有限公司 一种生成引导线的方法及装置
CN108664016A (zh) * 2017-03-31 2018-10-16 腾讯科技(深圳)有限公司 确定车道中心线的方法及装置
US20190301872A1 (en) * 2018-03-29 2019-10-03 WeRide Corp. Method for generating road map for vehicle navigation and navigation device
CN112325896A (zh) * 2020-10-30 2021-02-05 上海商汤临港智能科技有限公司 导航方法、装置、智能行驶设备及存储介质

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8725474B2 (en) * 2008-10-01 2014-05-13 Navteq B.V. Bezier curves for advanced driver assistance system applications
JP6280850B2 (ja) * 2014-09-29 2018-02-14 日立建機株式会社 障害物回避システム
US9816830B2 (en) * 2015-05-20 2017-11-14 Uber Technologies, Inc. Navigation lane guidance
CN106873600A (zh) * 2017-03-31 2017-06-20 深圳市靖洲科技有限公司 一种面向无人自行车的局部避障路径规划方法
CN110579222B (zh) * 2018-06-07 2022-03-15 百度在线网络技术(北京)有限公司 导航路线处理方法、装置及设备
US20200166352A1 (en) * 2018-11-27 2020-05-28 Electronics And Telecommunications Research Institute Apparatus and method for establishing dual path plan and determining road determination area for autonomous driving
CN110502010B (zh) * 2019-08-15 2021-06-04 同济大学 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法
CN112416004B (zh) * 2020-11-19 2021-12-14 腾讯科技(深圳)有限公司 一种基于自动驾驶的控制方法、装置、车辆以及相关设备

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110066312A1 (en) * 2009-09-15 2011-03-17 Electronics And Telecommunications Research Institute Navigation apparatus and driving route information providing method using the same and automatic driving system and method
CN106441312A (zh) * 2015-08-11 2017-02-22 高德软件有限公司 一种生成引导线的方法及装置
CN105651295A (zh) * 2016-01-15 2016-06-08 武汉光庭信息技术股份有限公司 基于Bezier曲线构建交叉路口驶入驶出车道Link的连接曲线算法
CN108664016A (zh) * 2017-03-31 2018-10-16 腾讯科技(深圳)有限公司 确定车道中心线的方法及装置
US20190301872A1 (en) * 2018-03-29 2019-10-03 WeRide Corp. Method for generating road map for vehicle navigation and navigation device
CN112325896A (zh) * 2020-10-30 2021-02-05 上海商汤临港智能科技有限公司 导航方法、装置、智能行驶设备及存储介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116817930A (zh) * 2023-08-30 2023-09-29 国汽(北京)智能网联汽车研究院有限公司 车辆导航的方法、装置、设备和存储介质
CN116817930B (zh) * 2023-08-30 2024-02-09 国汽(北京)智能网联汽车研究院有限公司 车辆导航的方法、装置、设备和存储介质

Also Published As

Publication number Publication date
CN113008261B (zh) 2023-02-28
KR20220137034A (ko) 2022-10-11
CN113008261A (zh) 2021-06-22

Similar Documents

Publication Publication Date Title
WO2022205617A1 (zh) 一种导航方法、装置、电子设备及存储介质
CN108871368B (zh) 一种高精度地图车道横向拓扑关系的构建方法、系统及存储器
US10186150B2 (en) Scene determination device, travel assistance apparatus, and scene determination method
CN111595358B (zh) 导航数据处理方法、路径诱导方法、设备及存储介质
EP3327695A1 (en) Driving plan device, travel support device, and driving plan method
EP3333820B1 (en) Driving plan device, travel support device, and driving plan method
EP3869157A1 (en) Method and device for constructing high-resolution map
Ma et al. A two-level path planning method for on-road autonomous driving
US20180218600A1 (en) Scene Determination Device, Travel Assistance Apparatus, and Scene Determination Method
CN109489675A (zh) 用于自动驾驶车辆的基于成本的路径规划
CN109491376A (zh) 用于自动驾驶车辆的基于动态规划和梯度下降的决策和规划
Tordesillas et al. Real-time planning with multi-fidelity models for agile flights in unknown environments
CN109813332B (zh) 添加虚拟引导线的方法和装置
CN111158365A (zh) 一种路径规划方法、装置、机器人及存储介质
CN109491378A (zh) 自动驾驶车辆的基于道路分段的路线引导系统
JP2010026326A (ja) 道路網データ生成装置及び車両誘導路生成装置、並びにこれらの方法及びプログラム
JP7299976B2 (ja) 環境ターゲットの特徴点抽出方法及び装置
CN115077550A (zh) 一种基于导航地图与高精地图匹配的无人车路径规划方法
Tanzmeister et al. Grid-based multi-road-course estimation using motion planning
Liu et al. A novel method for predicting vehicle state in internet of vehicles
JP6177498B2 (ja) 経路案内システム
Trentin et al. Interaction-aware intention estimation at roundabouts
JP2014209062A (ja) 交差点案内表示システム、方法およびプログラム
RU2700301C2 (ru) Устройство определения окружения, аппаратура содействия при движении и способ определения окружения
Ren et al. Improve generalization of driving policy at signalized intersections with adversarial learning

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2022530914

Country of ref document: JP

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 20227029065

Country of ref document: KR

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21934266

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE