US20230391325A1 - Travel control method and travel control device - Google Patents
Travel control method and travel control device Download PDFInfo
- Publication number
- US20230391325A1 US20230391325A1 US18/036,208 US202018036208A US2023391325A1 US 20230391325 A1 US20230391325 A1 US 20230391325A1 US 202018036208 A US202018036208 A US 202018036208A US 2023391325 A1 US2023391325 A1 US 2023391325A1
- Authority
- US
- United States
- Prior art keywords
- prescribed
- vehicle
- boundary lines
- lane boundary
- host vehicle
- Prior art date
- Legal status (The legal status 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 status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 37
- 238000001514 detection method Methods 0.000 claims description 20
- 230000008859 change Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 description 48
- 230000008569 process Effects 0.000 description 15
- 238000010586 diagram Methods 0.000 description 7
- 230000010365 information processing Effects 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 238000004590 computer program Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18159—Traversing an intersection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/20—Direction indicator values
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to data
- B60W2556/10—Historical data
Definitions
- the present disclosure relates to a travel control method and a travel control device.
- Patent Document 1 discloses a road shape detection method for the accurate identification of the shape of a lane by combining vehicle travel information during autonomous driving with vehicle travel information during manual driving.
- This road shape detection method identifies the detected point (travel locus) of the current position of a vehicle over time during autonomous driving as the lane center line and identifies the lane boundaries based on the distribution of the distance between the identified lane center line and the detected points of the current position over time during manual driving.
- an object of the present invention is to provide a travel control method and a travel control device with which it is possible for a vehicle to travel in a prescribed position within its own lane, even in sections where lane boundary lines cannot be detected.
- the travel control method detects lane boundary lines provided at the widthwise ends of the vehicle lane in which a host vehicle is traveling and carries out travel control of the host vehicle based on the detection result of the lane boundary lines.
- a first prescribed position with respect to the lane boundary lines is calculated and stored when the vehicle goes from a state in which the lane boundary lines can be detected to a state in which the lane boundary lines cannot be detected, and a second prescribed position with respect to the lane boundary lines is calculated and stored when the vehicle goes from a state in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected.
- the host vehicle is then controlled to travel along a travel path connecting the first prescribed position and the second prescribed position during travel in a section for which the first and second prescribed positions are stored.
- FIG. 1 is a block diagram showing an example of the configuration of the travel control device according to an illustrated embodiment.
- FIG. 2 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment.
- FIG. 3 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment.
- FIG. 4 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment.
- FIG. 5 is a diagram illustrating an example of the travel path correction method according to the illustrated embodiment.
- FIG. 6 A is a diagram illustrating an example of a travel scenario according to the illustrated embodiment.
- FIG. 6 B is a diagram illustrating an example of a travel scenario according to the illustrated embodiment of.
- FIG. 7 is a flowchart illustrating an example of an operation of the travel control device according to the illustrated embodiment.
- FIG. 8 is a flowchart illustrating an example of an operation of the travel control device according to the illustrated embodiment.
- the travel control device 1 comprises a camera 10 , a speed sensor 11 , an angular velocity sensor 12 , a GNSS receiver 13 , and a controller 20 .
- the travel control device 1 according to this embodiment is mounted in a vehicle V and controls the travel of vehicle V.
- the travel control device 1 may be mounted in a vehicle that has an autonomous driving function or a vehicle that does not have an autonomous driving function.
- the travel control device 1 may also be mounted in a vehicle capable of switching between autonomous driving and manual driving.
- Autonomous driving in this embodiment refers to a state in which, for example, at least one actuator, such as the brake, accelerator, steering, is controlled without any operation from the occupant. Therefore, other actuators may be operated by an operation from the occupant.
- Autonomous driving may also be any state in which any control, such as acceleration/deceleration control, lateral position control, etc., is being executed.
- manual driving in this embodiment refers to a state in which the occupant is operating the brake, accelerator, or steering wheel, for example.
- the camera 10 is mounted on vehicle V and photographs the surroundings of vehicle V.
- the camera 10 comprises an imaging element, such as a CCD (charge-coupled device), CMOS (complementary metal oxide semiconductor), and the like.
- the camera 10 sequentially outputs the captured images to the controller 20 .
- the speed sensor 11 detects the travel speed (vehicle speed) of vehicle V.
- the speed sensor 11 includes, for example, a sensor rotor that rotates together with a wheel and that has a protrusion (gear pulser) formed on the circumference thereof and a detection circuit having a pickup coil provided to face the protrusion of the sensor rotor.
- the speed sensor 11 converts the change in the magnetic flux density accompanying the rotation of the sensor rotor into a voltage signal by means of the pickup coil and measures the wheel speed of each wheel from the voltage signal.
- the speed sensor 11 computes the average wheel speed of each wheel as the vehicle speed.
- the speed sensor 11 outputs the detected vehicle speed of vehicle V to the controller 20 .
- the angular velocity sensor 12 detects angular velocity of vehicle V and outputs the detected angular velocity to the controller 20 .
- the GNSS receiver 13 is a GPS receiver or the like, which detects the position of vehicle V on the ground (hereafter may be referred to as self-location) by receiving radio waves from a plurality of satellites.
- the GNSS receiver 13 outputs the detected position information of vehicle V to the controller 20 .
- GNSS is an acronym for “Global Navigation Satellite System”
- GPS Global Positioning System
- the controller 20 is a general-purpose microcomputer with a CPU (central processing device), memory, and an input/output unit.
- a computer program is installed in the microcomputer to make it function as the travel control device 1 .
- the microcomputer functions as a plurality of information processing circuits provided in the travel control device 1 .
- the plurality of information processing circuits provided in the travel control device 1 are realized in software in the example shown here, it is of course possible to configure the plurality of information processing circuits as dedicated hardware, in order to execute each of the following information processes.
- the plurality of information processing circuits may also be realized in discrete hardware.
- the controller 20 includes the following as the plurality of information processing circuits: a lane boundary line detection unit 21 , a relative position estimation unit 22 , an absolute position estimation unit 23 , a travel path calculation unit 24 , a travel path storage unit 25 , a travel path retrieval unit 26 , a travel path correction unit 27 , and a vehicle control unit 28 .
- the lane boundary line detection unit 21 detects lane boundary lines ahead of the vehicle, which are provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling.
- Lane boundary lines are division lines that delineate a roadway, such as the white lines on the road surface, raised pavement markers, or curbs.
- the lane boundary line detection unit 21 detects the relative positions of vehicle V and the detected lane boundary line.
- the relative position detected by the lane boundary line detection unit 21 is a position in a vehicle coordinate system.
- the vehicle coordinate system may be set, for example, such that the center of the rear axle of vehicle V is the origin, the forward direction is the positive direction of the x axis, and the left direction is the positive direction of the y axis.
- a formula for converting from the coordinate system of the camera 10 to the coordinate system of the vehicle is set in advance in the lane boundary line detection unit 21 .
- the relative position estimation unit 22 acquires the vehicle speed of vehicle V from the speed sensor 11 and the angular velocity of vehicle V from the angular velocity sensor 12 .
- the relative position estimation unit 22 estimates the relative position and attitude (azimuth angle) of vehicle V in a relative coordinate system with a certain position as the origin by so-called odometry, in which the distance and direction of movement of the vehicle V is calculated from the acquired vehicle speed and angular velocity. For example, when the travel control device 1 is activated or when the process is reset, the relative position and the relative azimuth angle of vehicle V are estimated with the position of vehicle V as the origin and the azimuth angle of vehicle V set to 0°.
- the relative position estimation unit 22 may estimate the relative position and the relative azimuth angle of vehicle V by odometry using the steering angle and rpm of the wheels, or estimate the relative position and relative azimuth angle of vehicle V by odometry using the steering and rotation speed of the wheels.
- the parameters used for odometry are not particularly limited.
- the absolute position estimation unit 23 acquires the self-location of vehicle V from the GNSS receiver 13 , the vehicle speed of vehicle V from the speed sensor 11 , and the angular velocity of vehicle V from the angular velocity sensor 12 .
- the absolute position estimation unit 23 estimates the absolute position of the vehicle V from the acquired self-location, vehicle speed, and angular velocity of vehicle V using a Kalman filter.
- the self-location acquired from the GNSS receiver 13 contains errors due to the presence of obstacles, etc. By combining the self-location acquired from the GNSS receiver 13 with the vehicle speed and angular velocity, the absolute position estimation unit 23 can suppress the effect of errors in the self-location.
- the travel path calculation unit 24 calculates and stores a prescribed position relative to a lane boundary line detected by vehicle V at a first point as the first prescribed position. A prescribed position relative to a lane boundary line detected at a second point after vehicle V has traveled for a prescribed interval from the first point is then calculated and stored as the second prescribed position.
- the travel path calculation unit 24 calculates and stores, for example, the center positions of the lane boundary lines detected at the first and second points as the first and second prescribed positions. For example, the travel path calculation unit 24 calculates and stores the first and second prescribed positions during manual driving travel of vehicle V.
- the travel path calculation unit 24 calculates and stores the direction along the host vehicle lane at the first prescribed position and the direction along the host vehicle lane at the second prescribed position.
- the travel path calculation unit 24 checks the operating state of the turn indicator of vehicle V while vehicle V travels in the section from the first prescribed position to the second prescribed position. In the case that the turn indicator of vehicle V is not activated while vehicle V travels in the section from the first prescribed position to the second prescribed position, the travel path calculation unit 24 calculates a travel path connecting the stored first and second prescribed positions. The travel path calculation unit 24 calculates a travel path that connects the first and second prescribed positions such that the orientation thereof matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position.
- the travel path calculation unit 24 determines whether a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions. If a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions, a travel path connecting the first and second prescribed positions is then calculated. If a deviation of the prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions, a travel path is not calculated. Details of the travel path calculation method of the travel path calculation unit 24 will be described further below with reference to FIGS. 2 - 4 .
- the travel path storage unit 25 stores in memory in the controller 20 , as a set, the absolute position and the absolute azimuth angle of vehicle V at the first point, the positions of the lane boundary lines detected by vehicle V at the first point, and the first and second prescribed positions and the travel paths calculated by the travel path calculation unit 24 .
- the travel path retrieval unit 26 retrieves the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of vehicle V from the travel paths stored in the travel path storage unit 25 .
- the travel path retrieval unit 26 retrieves the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of the vehicle V from the travel paths stored in the travel path storage unit 25 . Details of the travel path retrieval method of the travel path retrieval unit 26 will be described further below with reference to FIG. 5 .
- the travel path correction unit 27 corrects the travel path retrieved by the travel path retrieval unit 26 . Based on the difference between the respective positions of the lane boundary lines stored as a set with the travel path retrieved by the travel path retrieval unit 26 and the positions of the lane boundary lines detected by the current vehicle V, the travel path correction unit 27 corrects the travel path retrieved by the travel path retrieval unit 26 to a relative travel path with respect to the current vehicle V. The corrected travel path is then set as the travel path of the current vehicle V. Details of the travel path correction method of the travel path correction unit 27 will be described further below with reference to FIG. 5 .
- the vehicle control unit 28 controls the actuators of vehicle V such that vehicle V follows the travel path corrected by the travel path correction unit 27 .
- the actuators include brake actuators, accelerator pedal actuators, steering actuators, etc.
- FIG. 2 shows a scenario in which vehicle V passes through an intersection during manual driving travel.
- the travel path calculation unit 24 acquires the positions of lane boundary lines 41 a , 42 a detected by vehicle V in front of the intersection (first point).
- the travel path calculation unit 24 calculates the center position of the lane boundary lines 41 a , 42 a and stores this position as a first prescribed position P 1 . Since lane boundary lines are not present within the intersection shown in FIG. 2 , when vehicle V enters the intersection, vehicle V cannot detect lane boundary lines while traveling along a travel locus 51 a . When vehicle V then passes through the intersection, vehicle V will again be able to detect lane boundary lines.
- the travel path calculation unit 24 acquires the positions of lane boundary lines 43 a , 44 a detected at the point (second point) at which vehicle V has passed through the intersection. The center position of the lane boundary lines 43 a , 44 a is then calculated and stored as a second prescribed position P 2 . The travel path calculation unit 24 calculates and stores a direction D 1 along the host vehicle lane at first prescribed position P 1 and a direction D 2 along the host vehicle lane at second prescribed position P 2 .
- the travel path calculation unit 24 determines that the turn indicator of vehicle V has not been activated as vehicle V travels in the section from first prescribed position P 1 to second prescribed position P 2 .
- a travel path 61 a that connects first prescribed position P 1 and second prescribed position P 2 is then calculated such that its orientation matches direction D 1 along the host vehicle lane at first prescribed position P 1 and/or the direction along the host vehicle lane at second prescribed position P 2 .
- the travel path storage unit 25 stores in memory in the controller 20 the absolute position A 1 and the azimuth angle of vehicle V at the first point, the positions of the lane boundary lines 41 a , 42 a , first and second prescribed positions P 1 , P 2 , and the travel path 61 a as a set.
- FIG. 3 shows a scenario in which vehicle V makes a right turn at an intersection during manual driving travel.
- the travel path calculation unit 24 acquires the positions of lane boundary lines 41 b , 42 b detected by vehicle V in front of the intersection (first point).
- the travel path calculation unit 24 calculates the center position of the lane boundary lines 41 b , 42 b and stores this position as a first prescribed position P 1 .
- vehicle V cannot detect lane boundary lines while traveling along a travel locus 51 b to turn right at the intersection.
- vehicle V then turns right at the intersection, vehicle V will again be able to detect lane boundary lines.
- the travel path calculation unit 24 acquires the positions of lane boundary lines 43 b , 44 b detected at the point (second point) at which vehicle V passed through the intersection. The center position of the lane boundary lines 43 b , 44 b is then calculated and stored as a second prescribed position P 2 . The travel path calculation unit 24 calculates and stores a direction D 1 along the host vehicle lane at the first prescribed position and a direction D 2 along the host vehicle lane at the second prescribed position.
- the travel path calculation unit 24 determines that the turn indicator of vehicle V has been activated as vehicle V travels in the section from first prescribed position P 1 to second prescribed position P 2 .
- the travel path calculation unit 24 determines that a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions P 1 , P 2 .
- a smooth curve that connects first and second prescribed positions P 1 , P 2 , such that its orientation matches direction D 1 along the host vehicle lane at first prescribed position P 1 and/or direction D 2 along the host vehicle lane at second prescribed position P 2 is then calculated as a travel path 61 b .
- the travel path calculation unit 24 calculates the travel path 61 b using a clothoid curve or a spline curve, for example.
- the travel path storage unit 25 stores in memory in the controller 20 the absolute position A 1 and azimuth angle of vehicle V at the first point, the positions of the lane boundary lines 41 b , 42 b , first and second prescribed positions P 1 , P 2 , and the travel path 61 b as a set.
- FIG. 4 shows a scenario in which vehicle V changes lanes during manual driving travel.
- the travel path calculation unit 24 acquires the positions of lane boundary lines 41 c , 42 c detected by vehicle V at a point (first point) before changing lanes.
- the travel path calculation unit 24 calculates the center position of the lane boundary lines 41 c , 42 c and stores this position as a first prescribed position P 1 .
- the positions of lane boundary lines 43 c , 44 c detected at a point (second point) after vehicle V travels along a travel locus 51 c and starts to change lanes are then acquired.
- the center position of the lane boundary lines 43 c , 44 c is then calculated and stored as a second prescribed position P 2 .
- the travel path calculation unit 24 calculates and stores a direction D 1 along the host vehicle lane at first prescribed position P 1 and a direction D 2 along the host vehicle lane at second prescribed position P 2 .
- the travel path calculation unit 24 determines that the turn indicator of vehicle V has been activated as vehicle V travels in the section from first prescribed position P 1 to second prescribed position P 2 . The travel path calculation unit 24 then determines that a deviation of a prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions P 1 , P 2 . In this case, the travel path calculation unit 24 ends the process without calculating a travel path.
- the first and second prescribed positions P 1 , P 2 and the travel paths 61 a , 61 b are described as in terms of their relative positions in a relative coordinate system, with the absolute position A 1 of vehicle V when vehicle V is at the first point as the origin.
- the absolute position estimation unit 23 estimates the absolute position A 1 of vehicle V.
- the relative position estimation unit 22 estimates a relative position R of vehicle V, with the absolute position A 1 as the origin.
- the travel path calculation unit 24 calculates first and second prescribed positions P 1 , P 2 as well as the relative positions of the travel paths 61 a , 61 b based on the absolute position A 1 and relative position R.
- the travel path calculation method can also be applied to cases in which vehicle V turns left at an intersection, or travels on a straight road or a curve, and is not limited to these cases.
- FIG. 5 shows a scenario in which vehicle V is again about to traverse the intersection shown in FIG. 2 through which it has previously traveled.
- the travel path retrieval unit 26 retrieves the travel path closest to the current absolute position A 2 of vehicle V within a prescribed range from the current absolute position A 2 of vehicle V from the travel paths stored in the travel path storage unit 25 .
- the travel path retrieval unit 26 extracts the travel path 61 a closest to the current absolute position A 2 of vehicle V within a prescribed range from the current absolute position A 2 of vehicle V.
- the absolute position A 1 and the azimuth angle of vehicle V and the positions of the lane boundary lines 41 a , 42 a stored as a set with the travel path 61 a are then extracted.
- the travel path correction unit 27 determines whether the current absolute position A 2 and azimuth angle of vehicle V deviate by a prescribed value or more from the absolute position A 1 and the azimuth angle of vehicle V extracted by the travel path retrieval unit 26 . In the scenario of FIG. 5 , the travel path correction unit 27 determines that the current absolute position A 2 and azimuth angle of vehicle V do not deviate by a prescribed value or more from the absolute position A 1 and the azimuth angle of vehicle V extracted by the travel path retrieval unit 26 . The travel path correction unit 27 then obtains the positions of lane boundary lines 71 a , 72 a detected by the current vehicle V at the absolute position A 2 .
- the positions of the lane boundary lines 41 a , 42 a extracted by the travel path retrieval unit 26 are then associated with the positions of the lane boundary lines 71 a , 72 a .
- a coordinate transformation (translation/rotation) T is then calculated so that the positions of the lane boundary lines 41 a , 42 a coincide as much as possible with the positions of the lane boundary lines 71 a , 72 a.
- the travel path correction unit 27 applies the calculated coordinate transformation T to the travel path 61 a and corrects the position of the travel path 61 a to a relative travel path 81 a with respect to the current vehicle V.
- the corrected travel path is then set as the travel path of the current vehicle V. In this manner, by correcting the position of the travel path based on a clear target, such as lane boundary lines, deviations in the travel path due to GNSS positioning errors can be suppressed.
- a clear target such as lane boundary lines
- the travel path retrieval method and the travel path correction method can also be applied to cases in which vehicle V turns right or left at an intersection, or travels on a straight road or a curve, and are not limited to this case.
- the controller 20 may store the travel route of vehicle V instead of a travel path connecting the first and second prescribed positions. That is, the position with respect to the lane boundary lines 41 d , 42 d at the first and second prescribed positions may be set as the relative position of vehicle V with respect to the lane boundary lines 41 d , 42 d during manual driving instead of the center position of the lane. For example, as shown in FIG.
- the travel path storage unit 25 stores in memory in the controller 20 the absolute position A 1 and azimuth angle of vehicle V at the first point, the positions of the lane boundary lines 41 d , 42 d detected by vehicle V at the first point, and the travel locus 51 d as a set. In this case, as shown in FIG.
- the travel path correction unit 27 corrects the travel locus 51 d extracted by the travel path retrieval unit 26 to a relative travel path 81 d with respect to the current vehicle V.
- the corrected travel path 81 d is then set as the travel path of the current vehicle V.
- FIG. 7 shows an example of the flow of operations of the travel control device 1 during manual driving travel of vehicle V.
- the absolute position estimation unit 23 estimates the absolute position of vehicle V on a map based on the self-location of vehicle V acquired from the GNSS receiver 13 as well as the vehicle speed and angular velocity.
- the relative position estimation unit 22 estimates the relative position and the relative azimuth angle of vehicle V in a relative coordinate system, with the absolute position of vehicle V estimated by the absolute position estimation unit 23 as the origin.
- Step S 101 the lane boundary line detection unit 21 detects, from images captured by the camera 10 , lane boundary lines in front of the vehicle provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling.
- Step S 102 the lane boundary line detection unit 21 determines whether the lane boundary lines have been successively detected. If lane boundary lines have been successively detected (YES in Step S 102 ), the process proceeds to Step S 103 . On the other hand, if the lane boundary lines have not been detected (NO in Step S 102 ), the process of FIG. 7 is terminated.
- Step S 103 the travel path calculation unit 24 calculates and stores a prescribed position with respect to the lane boundary lines detected by the lane boundary line detection unit 21 .
- the travel path calculation unit 24 calculates and stores the direction along the host vehicle lane at the calculated prescribed position.
- Step S 104 the travel path calculation unit 24 checks the operating state of the turn indicator of vehicle V as vehicle V travels in the section from the previously stored prescribed position (first prescribed position) to the currently stored prescribed position (second prescribed position).
- Step S 105 if the turn indicator of vehicle V has been activated as vehicle V travels in the section from the first prescribed position to the second prescribed position (YES in Step S 105 ), the process proceeds to Step S 106 .
- Step S 107 On the other hand, if the turn indicator of vehicle V has not been activated as vehicle V travels in the section from the first prescribed position to the second prescribed position (NO in Step S 105 ), the process proceeds to Step S 107 .
- Step S 106 the travel path calculation unit 24 determines whether a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions. If a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions (YES in Step S 106 ), the process proceeds to Step S 107 . If a deviation of the prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions (NO in Step S 106 ), the process of FIG. 7 is terminated.
- Step S 107 the travel path calculation unit 24 calculates a travel path connecting the stored first and second prescribed positions.
- a case is considered in which the state changes from one in which the lane boundary lines can be detected, to one in which the lane boundary lines can no longer be detected, and then to one in which the lane boundary lines can again be detected.
- the point at which the state changes from one in which the lane boundary lines can be detected to a state in which lane dividing lines cannot be detected is the first point, and the prescribed position relative to the lane boundary lines at this first point is the first prescribed position.
- the point at which the state changes from one in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected is the second point, and the prescribed position relative to the lane boundary lines at this second point is the second prescribed position.
- the point at which the state changes from one in which lane boundary lines are detectable to a state in which lane boundary lines are not detectable is the first point
- the point at which the state changes from one in which the lane boundary lines are not detectable to a state in which the lane boundary lines are detectable is the second point, but no limitation is implied thereby.
- the first point may be the point at a prescribed time before the time at which the state changes from one in which the lane boundary lines are detectable to a state in which the lane boundary lines are undetectable.
- the second point may be the point at a prescribed time after the time at which the state changes from one in which the lane boundary lines are undetectable to a state in which the lane boundary lines are detectable.
- the travel path calculation unit 24 calculates a travel path connecting the first and second prescribed positions such that its orientation matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position.
- the travel path storage unit 25 stores in memory in the controller 20 the absolute position and the azimuth angle of vehicle V at the first point, the positions of the lane boundary lines detected by vehicle V at the first point, and the first and second prescribed positions and the travel path calculated by the travel path calculation unit 24 as a set.
- FIG. 8 shows an example of the flow of operations of the travel control device 1 during autonomous driving travel of vehicle V.
- the absolute position estimation unit 23 estimates the absolute position of vehicle V on a map based on the self-location of vehicle V acquired from the GNSS receiver 13 and the vehicle speed and angular velocity.
- the relative position estimation unit 22 estimates the relative position and the relative azimuth angle of vehicle V in a relative coordinate system, with the absolute position of vehicle V estimated by the absolute position estimation unit 23 as the origin.
- Step S 201 the travel path retrieval unit 26 extracts the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of vehicle V from the absolute positions stored in the travel path storage unit 25 .
- the absolute position and the absolute azimuth angle of vehicle V and the positions of the lane boundary lines stored as a set with the retrieved travel path are then extracted.
- Step S 202 the travel path correction unit 27 determines whether the current absolute position and the current azimuth angle of vehicle V deviate by a prescribed value or more from the absolute position and the absolute azimuth angle of vehicle V extracted by the travel path retrieval unit 26 . If the current absolute position and the current absolute azimuth angle of vehicle V deviated by the prescribed value or more from the absolute position and the azimuth angle of vehicle V extracted by the travel path retrieval unit 26 (YES in Step S 202 ), then the travel path calculation unit 24 terminates the process of FIG. 8 .
- Step S 203 the process proceeds to Step S 203 .
- Step S 203 the lane boundary line detection unit 21 detects, from images captured by the camera 10 , lane boundary lines in front of the vehicle provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling. Proceeding to Step S 204 , the lane boundary line detection unit 21 determines whether the lane boundary lines have been successfully detected. If the lane boundary lines have been successfully detected (YES in Step S 204 ), the process proceeds to Step S 205 . If the lane boundary lines have not been detected (NO in Step S 204 ), the process proceeds to Step S 206 .
- Step S 205 the travel path correction unit 27 associates the positions of the lane boundary lines retrieved by the travel path retrieval unit 26 in Step S 201 with the positions of the lane boundary lines detected by the lane boundary line detection unit 21 in Step S 203 .
- a coordinate transformation (translation/rotation) T is then calculated so that the positions of the lane boundary lines retrieved by the travel path retrieval unit 26 in Step S 201 match the positions of the lane boundary lines detected by the lane boundary line detection unit 21 in Step S 203 to the extent possible.
- the travel path correction unit 27 applies the calculated coordinate transformation T to the travel path retrieved by the travel path calculation unit 24 in Step S 201 so that it is corrected to a relative travel path with respect to the current vehicle V.
- the corrected travel path is then set as the travel path of current vehicle V.
- Step S 206 the vehicle control unit 28 controls the actuators of vehicle V such that vehicle V follows the travel path corrected by the travel path correction unit 27 , and the process of FIG. 8 is terminated.
- the travel path connecting the first and second prescribed positions is corrected to a relative travel path with respect to the current vehicle V.
- a first target present in the vicinity of the host vehicle at a first point may be detected and stored, and when vehicle V travels in a section for which first and second prescribed positions are stored, a second target corresponding to the first target may be detected and stored, and the travel path may be corrected based on the positional deviation between the first and second targets.
- the travel path storage unit 25 stores in memory in the controller 20 the absolute position and the absolute azimuth angle of vehicle V at the first point, the positions of the first target detected at the first point, and the first and second prescribed positions and the travel path calculated by the travel path calculation unit 24 as a set. Then, based on the difference between the position of the first target stored as a set with the travel path extracted by the travel path retrieval unit 26 and the position of the second target corresponding to the first target detected by the current vehicle V, the travel path correction unit 27 corrects the travel path extracted by the travel path retrieval unit 26 to a relative travel path with respect to the current vehicle V.
- the first and second targets may be any one of lane boundary lines, stop lines, traffic lights, road signs, road markings, or a combination thereof.
- the travel control device comprises a controller that detects lane boundary lines provided at the widthwise ends of a host vehicle lane in which a host vehicle is traveling and performs travel control of the host vehicle based on the detection result of the lane boundary lines.
- a first prescribed position with respect to the lane boundary lines is calculated and stored when changing from a state in which the lane boundary lines can be detected to a state in which the lane boundary lines cannot be detected, and a second prescribed position with respect to the lane boundary lines is calculated and stored when changing from a state in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected.
- the host vehicle is then controlled to travel along a travel path connecting the first prescribed position and the second prescribed position during travel in a section for which the first and second prescribed positions are stored.
- the travel control device calculates the lane widthwise center position of the host vehicle lane as the first and second prescribed positions with respect to the lane boundary lines.
- this allows travel in the center position of the lane, even in sections such as intersections in which lane boundary lines cannot be detected.
- the travel control device calculates and stores the direction along the host vehicle lane at the first and second prescribed positions, and calculates a travel path that connects the first and second prescribed positions such that its orientation matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position. It is thus possible to set a travel path whose orientation matches the orientation of the host vehicle at the first prescribed position and the direction of the host vehicle lane at the second prescribed position. Even in a case in which the orientation of the host vehicle lane at the first prescribed position and the orientation of the host vehicle lane at the second prescribed position significantly differ, such as when the host vehicle turns left or right, or travels along a curve, it is possible to travel in the prescribed position of the lane.
- the travel control device detects and stores a first target present in the vicinity of the host vehicle when the first prescribed position is calculated and stored, and detects a second target corresponding to the first target during travel in a section for which first and second prescribed positions are stored, and corrects the travel path based on the positional deviation between the first target and the second target. Therefore, it is possible to calculate the positional deviation between the first target detected when the first prescribed position was calculated and the second target corresponding to the second target detected during travel in a section for which first and second prescribed positions are stored.
- the first and second targets may be any one of lane boundary lines, stop lines, traffic lights, road signs, road markings, or a combination thereof. It is thus possible to select one or a more detectable targets from among targets present in the vicinity of the vehicle. It is thus also possible to more accurately correct the errors in the position of the host vehicle when the first prescribed position is calculated, and the position of the host vehicle during travel in a section for which first and second prescribed positions are stored, and to suppress errors in the positions of the travel path connecting the first and second prescribed positions.
- the travel control device calculates the travel path if a deviation of a prescribed value or more exists between the first and second prescribed positions, or between the attitudes of the host vehicle when the first and second prescribed positions were calculated, and does not calculate a travel path if a deviation of a prescribed value or more does not exist. Therefore, in the case that there is a deviation between the first and second prescribed positions, such as when the host vehicle turns right or left, or travels along a curve, or a case in which the attitudes of the host vehicle are respectively different when the first and second prescribed positions are calculated, a travel path connecting the first and second prescribed positions is calculated.
- first and second prescribed positions do not diverge, such as when the host vehicle changes lanes, or when the attitude of the host vehicle does not deviate at between he first and second prescribed positions when these positions are calculated, a travel path connecting the first and second prescribed positions is not calculated.
- the turn indicator when activated, it is possible to set separate travel paths for host vehicle right/left turns and host vehicle lane changes, thereby preventing the setting of an unsuitable travel path.
- the travel control device does not set the calculated travel path as the travel path of the host vehicle. Therefore, if the host vehicle is traveling in a state in which the host vehicle deviates significantly from its own lane, a travel path is not set, and thus the setting of an unsuitable travel path can be prevented.
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Human Computer Interaction (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
- This application is a U.S. national stage application of International Application No. PCT/IB2020/000979, filed on Nov. 27, 2020.
- The present disclosure relates to a travel control method and a travel control device.
- Japanese Laid-Open Patent Application No. 2016-224593 (Patent Document 1) discloses a road shape detection method for the accurate identification of the shape of a lane by combining vehicle travel information during autonomous driving with vehicle travel information during manual driving. This road shape detection method identifies the detected point (travel locus) of the current position of a vehicle over time during autonomous driving as the lane center line and identifies the lane boundaries based on the distribution of the distance between the identified lane center line and the detected points of the current position over time during manual driving.
- However, in the road shape detection method of the prior art described above, in order to execute autonomous driving assistance for vehicles, lane boundary lines and other vehicles in the vicinity, etc., are detected by camera, etc., and the travel locus of the vehicle during autonomous driving travel is identified as the lane center line. Therefore, in sections in which lane boundary lines are incompletely drawn, have disappeared or faded to the extent of being undetectable by camera, etc., it is difficult to identify lane center lines and lane boundaries accurately; thus, there is the risk that the host vehicle will be unable to travel in prescribed position within its own lane.
- In view of the problem described above, an object of the present invention is to provide a travel control method and a travel control device with which it is possible for a vehicle to travel in a prescribed position within its own lane, even in sections where lane boundary lines cannot be detected.
- The travel control method according to one aspect of the present invention detects lane boundary lines provided at the widthwise ends of the vehicle lane in which a host vehicle is traveling and carries out travel control of the host vehicle based on the detection result of the lane boundary lines. A first prescribed position with respect to the lane boundary lines is calculated and stored when the vehicle goes from a state in which the lane boundary lines can be detected to a state in which the lane boundary lines cannot be detected, and a second prescribed position with respect to the lane boundary lines is calculated and stored when the vehicle goes from a state in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected. The host vehicle is then controlled to travel along a travel path connecting the first prescribed position and the second prescribed position during travel in a section for which the first and second prescribed positions are stored.
- By means of the present invention, it is possible to travel in a prescribed position within the host vehicle lane even in sections in which lane boundary lines cannot be detected.
- Referring now to the attached drawings which form a part of this original disclosure.
-
FIG. 1 is a block diagram showing an example of the configuration of the travel control device according to an illustrated embodiment. -
FIG. 2 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment. -
FIG. 3 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment. -
FIG. 4 is a diagram illustrating an example of the travel path calculation method according to the illustrated embodiment. -
FIG. 5 is a diagram illustrating an example of the travel path correction method according to the illustrated embodiment. -
FIG. 6A is a diagram illustrating an example of a travel scenario according to the illustrated embodiment. -
FIG. 6B is a diagram illustrating an example of a travel scenario according to the illustrated embodiment of. -
FIG. 7 is a flowchart illustrating an example of an operation of the travel control device according to the illustrated embodiment. -
FIG. 8 is a flowchart illustrating an example of an operation of the travel control device according to the illustrated embodiment. - Embodiments of the present invention will be described below with reference to the drawings. In the descriptions of the figures, identical parts have been assigned the same reference numerals, and their descriptions have been omitted.
- An example of the configuration of a travel control device that executes the travel control method according to the present embodiment will be described with reference to
FIG. 1 . As shown inFIG. 1 , the travel control device 1 comprises acamera 10, aspeed sensor 11, anangular velocity sensor 12, aGNSS receiver 13, and acontroller 20. The travel control device 1 according to this embodiment is mounted in a vehicle V and controls the travel of vehicle V. - The travel control device 1 may be mounted in a vehicle that has an autonomous driving function or a vehicle that does not have an autonomous driving function. The travel control device 1 may also be mounted in a vehicle capable of switching between autonomous driving and manual driving. Autonomous driving in this embodiment refers to a state in which, for example, at least one actuator, such as the brake, accelerator, steering, is controlled without any operation from the occupant. Therefore, other actuators may be operated by an operation from the occupant. Autonomous driving may also be any state in which any control, such as acceleration/deceleration control, lateral position control, etc., is being executed. Further, manual driving in this embodiment refers to a state in which the occupant is operating the brake, accelerator, or steering wheel, for example.
- The
camera 10 is mounted on vehicle V and photographs the surroundings of vehicle V. Thecamera 10 comprises an imaging element, such as a CCD (charge-coupled device), CMOS (complementary metal oxide semiconductor), and the like. Thecamera 10 sequentially outputs the captured images to thecontroller 20. - The
speed sensor 11 detects the travel speed (vehicle speed) of vehicle V. Thespeed sensor 11 includes, for example, a sensor rotor that rotates together with a wheel and that has a protrusion (gear pulser) formed on the circumference thereof and a detection circuit having a pickup coil provided to face the protrusion of the sensor rotor. Thespeed sensor 11 converts the change in the magnetic flux density accompanying the rotation of the sensor rotor into a voltage signal by means of the pickup coil and measures the wheel speed of each wheel from the voltage signal. Thespeed sensor 11 computes the average wheel speed of each wheel as the vehicle speed. Thespeed sensor 11 outputs the detected vehicle speed of vehicle V to thecontroller 20. - The
angular velocity sensor 12 detects angular velocity of vehicle V and outputs the detected angular velocity to thecontroller 20. - The GNSS
receiver 13 is a GPS receiver or the like, which detects the position of vehicle V on the ground (hereafter may be referred to as self-location) by receiving radio waves from a plurality of satellites. The GNSSreceiver 13 outputs the detected position information of vehicle V to thecontroller 20. “GNSS” is an acronym for “Global Navigation Satellite System” and “GPS” is an acronym for “Global Positioning System.” - The
controller 20 is a general-purpose microcomputer with a CPU (central processing device), memory, and an input/output unit. A computer program is installed in the microcomputer to make it function as the travel control device 1. By executing the computer program, the microcomputer functions as a plurality of information processing circuits provided in the travel control device 1. Although the plurality of information processing circuits provided in the travel control device 1 are realized in software in the example shown here, it is of course possible to configure the plurality of information processing circuits as dedicated hardware, in order to execute each of the following information processes. The plurality of information processing circuits may also be realized in discrete hardware. Thecontroller 20 includes the following as the plurality of information processing circuits: a lane boundaryline detection unit 21, a relativeposition estimation unit 22, an absoluteposition estimation unit 23, a travelpath calculation unit 24, a travelpath storage unit 25, a travelpath retrieval unit 26, a travelpath correction unit 27, and avehicle control unit 28. - From images captured by the
camera 10, the lane boundaryline detection unit 21 detects lane boundary lines ahead of the vehicle, which are provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling. Lane boundary lines are division lines that delineate a roadway, such as the white lines on the road surface, raised pavement markers, or curbs. The lane boundaryline detection unit 21 detects the relative positions of vehicle V and the detected lane boundary line. The relative position detected by the lane boundaryline detection unit 21 is a position in a vehicle coordinate system. The vehicle coordinate system may be set, for example, such that the center of the rear axle of vehicle V is the origin, the forward direction is the positive direction of the x axis, and the left direction is the positive direction of the y axis. Further, a formula for converting from the coordinate system of thecamera 10 to the coordinate system of the vehicle is set in advance in the lane boundaryline detection unit 21. - The relative
position estimation unit 22 acquires the vehicle speed of vehicle V from thespeed sensor 11 and the angular velocity of vehicle V from theangular velocity sensor 12. The relativeposition estimation unit 22 estimates the relative position and attitude (azimuth angle) of vehicle V in a relative coordinate system with a certain position as the origin by so-called odometry, in which the distance and direction of movement of the vehicle V is calculated from the acquired vehicle speed and angular velocity. For example, when the travel control device 1 is activated or when the process is reset, the relative position and the relative azimuth angle of vehicle V are estimated with the position of vehicle V as the origin and the azimuth angle of vehicle V set to 0°. The relativeposition estimation unit 22 may estimate the relative position and the relative azimuth angle of vehicle V by odometry using the steering angle and rpm of the wheels, or estimate the relative position and relative azimuth angle of vehicle V by odometry using the steering and rotation speed of the wheels. Thus, the parameters used for odometry are not particularly limited. - The absolute
position estimation unit 23 acquires the self-location of vehicle V from theGNSS receiver 13, the vehicle speed of vehicle V from thespeed sensor 11, and the angular velocity of vehicle V from theangular velocity sensor 12. The absoluteposition estimation unit 23 estimates the absolute position of the vehicle V from the acquired self-location, vehicle speed, and angular velocity of vehicle V using a Kalman filter. The self-location acquired from theGNSS receiver 13 contains errors due to the presence of obstacles, etc. By combining the self-location acquired from theGNSS receiver 13 with the vehicle speed and angular velocity, the absoluteposition estimation unit 23 can suppress the effect of errors in the self-location. - The travel
path calculation unit 24 calculates and stores a prescribed position relative to a lane boundary line detected by vehicle V at a first point as the first prescribed position. A prescribed position relative to a lane boundary line detected at a second point after vehicle V has traveled for a prescribed interval from the first point is then calculated and stored as the second prescribed position. The travelpath calculation unit 24 calculates and stores, for example, the center positions of the lane boundary lines detected at the first and second points as the first and second prescribed positions. For example, the travelpath calculation unit 24 calculates and stores the first and second prescribed positions during manual driving travel of vehicle V. The travelpath calculation unit 24 calculates and stores the direction along the host vehicle lane at the first prescribed position and the direction along the host vehicle lane at the second prescribed position. - The travel
path calculation unit 24 checks the operating state of the turn indicator of vehicle V while vehicle V travels in the section from the first prescribed position to the second prescribed position. In the case that the turn indicator of vehicle V is not activated while vehicle V travels in the section from the first prescribed position to the second prescribed position, the travelpath calculation unit 24 calculates a travel path connecting the stored first and second prescribed positions. The travelpath calculation unit 24 calculates a travel path that connects the first and second prescribed positions such that the orientation thereof matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position. - In the case that the turn indicator of vehicle V is activated while the vehicle V travels in the segment from the first prescribed position to the second prescribed position, the travel
path calculation unit 24 determines whether a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions. If a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions, a travel path connecting the first and second prescribed positions is then calculated. If a deviation of the prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions, a travel path is not calculated. Details of the travel path calculation method of the travelpath calculation unit 24 will be described further below with reference toFIGS. 2-4 . - The travel
path storage unit 25 stores in memory in thecontroller 20, as a set, the absolute position and the absolute azimuth angle of vehicle V at the first point, the positions of the lane boundary lines detected by vehicle V at the first point, and the first and second prescribed positions and the travel paths calculated by the travelpath calculation unit 24. - During travel in a section for which the first and second prescribed positions are stored, the travel
path retrieval unit 26 retrieves the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of vehicle V from the travel paths stored in the travelpath storage unit 25. For example, during autonomous driving travel of the vehicle V, the travelpath retrieval unit 26 retrieves the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of the vehicle V from the travel paths stored in the travelpath storage unit 25. Details of the travel path retrieval method of the travelpath retrieval unit 26 will be described further below with reference toFIG. 5 . - If the current position and the current azimuth angle of vehicle V do not deviate by a prescribed value or more from the position and the azimuth angle of vehicle V at the first point, which are stored as a set with the travel path retrieved by the travel
path retrieval unit 26, the travelpath correction unit 27 corrects the travel path retrieved by the travelpath retrieval unit 26. Based on the difference between the respective positions of the lane boundary lines stored as a set with the travel path retrieved by the travelpath retrieval unit 26 and the positions of the lane boundary lines detected by the current vehicle V, the travelpath correction unit 27 corrects the travel path retrieved by the travelpath retrieval unit 26 to a relative travel path with respect to the current vehicle V. The corrected travel path is then set as the travel path of the current vehicle V. Details of the travel path correction method of the travelpath correction unit 27 will be described further below with reference toFIG. 5 . - The
vehicle control unit 28 controls the actuators of vehicle V such that vehicle V follows the travel path corrected by the travelpath correction unit 27. The actuators include brake actuators, accelerator pedal actuators, steering actuators, etc. - An example of the travel path calculation method of the travel
path calculation unit 24 will be described with reference toFIGS. 2-4 . -
FIG. 2 shows a scenario in which vehicle V passes through an intersection during manual driving travel. The travelpath calculation unit 24 acquires the positions oflane boundary lines path calculation unit 24 calculates the center position of thelane boundary lines FIG. 2 , when vehicle V enters the intersection, vehicle V cannot detect lane boundary lines while traveling along atravel locus 51 a. When vehicle V then passes through the intersection, vehicle V will again be able to detect lane boundary lines. The travelpath calculation unit 24 acquires the positions oflane boundary lines lane boundary lines path calculation unit 24 calculates and stores a direction D1 along the host vehicle lane at first prescribed position P1 and a direction D2 along the host vehicle lane at second prescribed position P2. - In the scenario shown in
FIG. 2 , the travelpath calculation unit 24 determines that the turn indicator of vehicle V has not been activated as vehicle V travels in the section from first prescribed position P1 to second prescribed position P2. Atravel path 61 a that connects first prescribed position P1 and second prescribed position P2 is then calculated such that its orientation matches direction D1 along the host vehicle lane at first prescribed position P1 and/or the direction along the host vehicle lane at second prescribed position P2. - The travel
path storage unit 25 stores in memory in thecontroller 20 the absolute position A1 and the azimuth angle of vehicle V at the first point, the positions of thelane boundary lines travel path 61 a as a set. -
FIG. 3 shows a scenario in which vehicle V makes a right turn at an intersection during manual driving travel. The travelpath calculation unit 24 acquires the positions oflane boundary lines path calculation unit 24 calculates the center position of thelane boundary lines travel locus 51 b to turn right at the intersection. When vehicle V then turns right at the intersection, vehicle V will again be able to detect lane boundary lines. The travelpath calculation unit 24 acquires the positions oflane boundary lines lane boundary lines path calculation unit 24 calculates and stores a direction D1 along the host vehicle lane at the first prescribed position and a direction D2 along the host vehicle lane at the second prescribed position. - In the scenario shown in
FIG. 3 , the travelpath calculation unit 24 determines that the turn indicator of vehicle V has been activated as vehicle V travels in the section from first prescribed position P1 to second prescribed position P2. The travelpath calculation unit 24 then determines that a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions P1, P2. A smooth curve that connects first and second prescribed positions P1, P2, such that its orientation matches direction D1 along the host vehicle lane at first prescribed position P1 and/or direction D2 along the host vehicle lane at second prescribed position P2, is then calculated as atravel path 61 b. The travelpath calculation unit 24 calculates thetravel path 61 b using a clothoid curve or a spline curve, for example. - The travel
path storage unit 25 stores in memory in thecontroller 20 the absolute position A1 and azimuth angle of vehicle V at the first point, the positions of thelane boundary lines travel path 61 b as a set. -
FIG. 4 shows a scenario in which vehicle V changes lanes during manual driving travel. The travelpath calculation unit 24 acquires the positions oflane boundary lines path calculation unit 24 calculates the center position of thelane boundary lines lane boundary lines travel locus 51 c and starts to change lanes are then acquired. The center position of thelane boundary lines path calculation unit 24 calculates and stores a direction D1 along the host vehicle lane at first prescribed position P1 and a direction D2 along the host vehicle lane at second prescribed position P2. - In the scenario shown in
FIG. 4 , the travelpath calculation unit 24 determines that the turn indicator of vehicle V has been activated as vehicle V travels in the section from first prescribed position P1 to second prescribed position P2. The travelpath calculation unit 24 then determines that a deviation of a prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions P1, P2. In this case, the travelpath calculation unit 24 ends the process without calculating a travel path. - The first and second prescribed positions P1, P2 and the
travel paths position estimation unit 23 estimates the absolute position A1 of vehicle V. Then, when vehicle V is at the second point, the relativeposition estimation unit 22 estimates a relative position R of vehicle V, with the absolute position A1 as the origin. The travelpath calculation unit 24 calculates first and second prescribed positions P1, P2 as well as the relative positions of thetravel paths - Next, an example of the travel path retrieval method of the travel
path retrieval unit 26 and the travel path correction method of the travelpath correction unit 27 will be explained with reference toFIG. 5 . -
FIG. 5 shows a scenario in which vehicle V is again about to traverse the intersection shown inFIG. 2 through which it has previously traveled. The travelpath retrieval unit 26 retrieves the travel path closest to the current absolute position A2 of vehicle V within a prescribed range from the current absolute position A2 of vehicle V from the travel paths stored in the travelpath storage unit 25. The travelpath retrieval unit 26 extracts thetravel path 61 a closest to the current absolute position A2 of vehicle V within a prescribed range from the current absolute position A2 of vehicle V. The absolute position A1 and the azimuth angle of vehicle V and the positions of thelane boundary lines travel path 61 a are then extracted. - The travel
path correction unit 27 determines whether the current absolute position A2 and azimuth angle of vehicle V deviate by a prescribed value or more from the absolute position A1 and the azimuth angle of vehicle V extracted by the travelpath retrieval unit 26. In the scenario ofFIG. 5 , the travelpath correction unit 27 determines that the current absolute position A2 and azimuth angle of vehicle V do not deviate by a prescribed value or more from the absolute position A1 and the azimuth angle of vehicle V extracted by the travelpath retrieval unit 26. The travelpath correction unit 27 then obtains the positions oflane boundary lines lane boundary lines path retrieval unit 26 are then associated with the positions of thelane boundary lines lane boundary lines lane boundary lines - The travel
path correction unit 27 applies the calculated coordinate transformation T to thetravel path 61 a and corrects the position of thetravel path 61 a to arelative travel path 81 a with respect to the current vehicle V. The corrected travel path is then set as the travel path of the current vehicle V. In this manner, by correcting the position of the travel path based on a clear target, such as lane boundary lines, deviations in the travel path due to GNSS positioning errors can be suppressed. Although a case in which vehicle V passes directly through an intersection was described as an example, the travel path retrieval method and the travel path correction method can also be applied to cases in which vehicle V turns right or left at an intersection, or travels on a straight road or a curve, and are not limited to this case. - In the case that vehicle V is traveling on a travel path connecting the prescribed positions of the detected lane boundary lines in a section in which the lane boundary lines of the host vehicle lane can be continuously detected, the
controller 20 may store the travel route of vehicle V instead of a travel path connecting the first and second prescribed positions. That is, the position with respect to thelane boundary lines lane boundary lines FIG. 6 , if vehicle V is traveling in the host vehicle lane along a travel path connecting the center positions of the lane boundary lines continuously detected by vehicle V, the travelpath storage unit 25 stores in memory in thecontroller 20 the absolute position A1 and azimuth angle of vehicle V at the first point, the positions of thelane boundary lines travel locus 51 d as a set. In this case, as shown inFIG. 6B , based on the difference between the positions of thelane boundary lines travel locus 51 d extracted by the travelpath retrieval unit 26 and the positions of thelane boundary lines path correction unit 27 corrects thetravel locus 51 d extracted by the travelpath retrieval unit 26 to arelative travel path 81 d with respect to the current vehicle V. The correctedtravel path 81 d is then set as the travel path of the current vehicle V. - An example of the flow of operations of the travel control device according to this embodiment of the present invention will now be described with reference to the flowcharts of
FIGS. 7 and 8 . -
FIG. 7 shows an example of the flow of operations of the travel control device 1 during manual driving travel of vehicle V. In Step S100 ofFIG. 7 , the absoluteposition estimation unit 23 estimates the absolute position of vehicle V on a map based on the self-location of vehicle V acquired from theGNSS receiver 13 as well as the vehicle speed and angular velocity. The relativeposition estimation unit 22 estimates the relative position and the relative azimuth angle of vehicle V in a relative coordinate system, with the absolute position of vehicle V estimated by the absoluteposition estimation unit 23 as the origin. - In Step S101, the lane boundary
line detection unit 21 detects, from images captured by thecamera 10, lane boundary lines in front of the vehicle provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling. In Step S102, the lane boundaryline detection unit 21 determines whether the lane boundary lines have been successively detected. If lane boundary lines have been successively detected (YES in Step S102), the process proceeds to Step S103. On the other hand, if the lane boundary lines have not been detected (NO in Step S102), the process ofFIG. 7 is terminated. - In Step S103, the travel
path calculation unit 24 calculates and stores a prescribed position with respect to the lane boundary lines detected by the lane boundaryline detection unit 21. The travelpath calculation unit 24 calculates and stores the direction along the host vehicle lane at the calculated prescribed position. - In Step S104, the travel
path calculation unit 24 checks the operating state of the turn indicator of vehicle V as vehicle V travels in the section from the previously stored prescribed position (first prescribed position) to the currently stored prescribed position (second prescribed position). In Step S105, if the turn indicator of vehicle V has been activated as vehicle V travels in the section from the first prescribed position to the second prescribed position (YES in Step S105), the process proceeds to Step S106. On the other hand, if the turn indicator of vehicle V has not been activated as vehicle V travels in the section from the first prescribed position to the second prescribed position (NO in Step S105), the process proceeds to Step S107. - In Step S106, the travel
path calculation unit 24 determines whether a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions. If a deviation of a prescribed value or more exists between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions (YES in Step S106), the process proceeds to Step S107. If a deviation of the prescribed value or more does not exist between the azimuth angles of vehicle V at the first and second points or between the first and second prescribed positions (NO in Step S106), the process ofFIG. 7 is terminated. - In Step S107, the travel
path calculation unit 24 calculates a travel path connecting the stored first and second prescribed positions. Here, a case is considered in which the state changes from one in which the lane boundary lines can be detected, to one in which the lane boundary lines can no longer be detected, and then to one in which the lane boundary lines can again be detected. In such a case, the point at which the state changes from one in which the lane boundary lines can be detected to a state in which lane dividing lines cannot be detected is the first point, and the prescribed position relative to the lane boundary lines at this first point is the first prescribed position. Further, the point at which the state changes from one in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected is the second point, and the prescribed position relative to the lane boundary lines at this second point is the second prescribed position. In the present embodiment, the point at which the state changes from one in which lane boundary lines are detectable to a state in which lane boundary lines are not detectable is the first point, and the point at which the state changes from one in which the lane boundary lines are not detectable to a state in which the lane boundary lines are detectable is the second point, but no limitation is implied thereby. For example, the first point may be the point at a prescribed time before the time at which the state changes from one in which the lane boundary lines are detectable to a state in which the lane boundary lines are undetectable. Similarly, the second point may be the point at a prescribed time after the time at which the state changes from one in which the lane boundary lines are undetectable to a state in which the lane boundary lines are detectable. The travelpath calculation unit 24 calculates a travel path connecting the first and second prescribed positions such that its orientation matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position. The travelpath storage unit 25 stores in memory in thecontroller 20 the absolute position and the azimuth angle of vehicle V at the first point, the positions of the lane boundary lines detected by vehicle V at the first point, and the first and second prescribed positions and the travel path calculated by the travelpath calculation unit 24 as a set. -
FIG. 8 shows an example of the flow of operations of the travel control device 1 during autonomous driving travel of vehicle V. In Step S200 ofFIG. 8 , the absoluteposition estimation unit 23 estimates the absolute position of vehicle V on a map based on the self-location of vehicle V acquired from theGNSS receiver 13 and the vehicle speed and angular velocity. The relativeposition estimation unit 22 estimates the relative position and the relative azimuth angle of vehicle V in a relative coordinate system, with the absolute position of vehicle V estimated by the absoluteposition estimation unit 23 as the origin. - In Step S201, the travel
path retrieval unit 26 extracts the travel path closest to the current absolute position of vehicle V within a prescribed range from the current absolute position of vehicle V from the absolute positions stored in the travelpath storage unit 25. The absolute position and the absolute azimuth angle of vehicle V and the positions of the lane boundary lines stored as a set with the retrieved travel path are then extracted. - The process proceeds to Step S202, and the travel
path correction unit 27 determines whether the current absolute position and the current azimuth angle of vehicle V deviate by a prescribed value or more from the absolute position and the absolute azimuth angle of vehicle V extracted by the travelpath retrieval unit 26. If the current absolute position and the current absolute azimuth angle of vehicle V deviated by the prescribed value or more from the absolute position and the azimuth angle of vehicle V extracted by the travel path retrieval unit 26 (YES in Step S202), then the travelpath calculation unit 24 terminates the process ofFIG. 8 . On the other hand, if the current absolute position and the current absolute azimuth angle of vehicle V do not deviate by a prescribed value or more from the absolute position and the absolute azimuth angle of vehicle V extracted by the travel path retrieval unit 26 (NO in Step S202), the process proceeds to Step S203. - In Step S203, the lane boundary
line detection unit 21 detects, from images captured by thecamera 10, lane boundary lines in front of the vehicle provided at the widthwise ends of the host vehicle lane in which vehicle V is traveling. Proceeding to Step S204, the lane boundaryline detection unit 21 determines whether the lane boundary lines have been successfully detected. If the lane boundary lines have been successfully detected (YES in Step S204), the process proceeds to Step S205. If the lane boundary lines have not been detected (NO in Step S204), the process proceeds to Step S206. - In Step S205, the travel
path correction unit 27 associates the positions of the lane boundary lines retrieved by the travelpath retrieval unit 26 in Step S201 with the positions of the lane boundary lines detected by the lane boundaryline detection unit 21 in Step S203. A coordinate transformation (translation/rotation) T is then calculated so that the positions of the lane boundary lines retrieved by the travelpath retrieval unit 26 in Step S201 match the positions of the lane boundary lines detected by the lane boundaryline detection unit 21 in Step S203 to the extent possible. The travelpath correction unit 27 applies the calculated coordinate transformation T to the travel path retrieved by the travelpath calculation unit 24 in Step S201 so that it is corrected to a relative travel path with respect to the current vehicle V. The corrected travel path is then set as the travel path of current vehicle V. - In Step S206, the
vehicle control unit 28 controls the actuators of vehicle V such that vehicle V follows the travel path corrected by the travelpath correction unit 27, and the process ofFIG. 8 is terminated. - In the present embodiment, it was described that when vehicle V is traveling in a section for which first and second prescribed positions are stored, based on the difference between the respective positions of the lane boundary lines detected by vehicle V at the first point and the positions of the lane boundary lines detected by the current vehicle V, the travel path connecting the first and second prescribed positions is corrected to a relative travel path with respect to the current vehicle V. However, a first target present in the vicinity of the host vehicle at a first point may be detected and stored, and when vehicle V travels in a section for which first and second prescribed positions are stored, a second target corresponding to the first target may be detected and stored, and the travel path may be corrected based on the positional deviation between the first and second targets.
- In this case, the travel
path storage unit 25 stores in memory in thecontroller 20 the absolute position and the absolute azimuth angle of vehicle V at the first point, the positions of the first target detected at the first point, and the first and second prescribed positions and the travel path calculated by the travelpath calculation unit 24 as a set. Then, based on the difference between the position of the first target stored as a set with the travel path extracted by the travelpath retrieval unit 26 and the position of the second target corresponding to the first target detected by the current vehicle V, the travelpath correction unit 27 corrects the travel path extracted by the travelpath retrieval unit 26 to a relative travel path with respect to the current vehicle V. The first and second targets may be any one of lane boundary lines, stop lines, traffic lights, road signs, road markings, or a combination thereof. - As described above, the travel control device according to the present invention comprises a controller that detects lane boundary lines provided at the widthwise ends of a host vehicle lane in which a host vehicle is traveling and performs travel control of the host vehicle based on the detection result of the lane boundary lines. A first prescribed position with respect to the lane boundary lines is calculated and stored when changing from a state in which the lane boundary lines can be detected to a state in which the lane boundary lines cannot be detected, and a second prescribed position with respect to the lane boundary lines is calculated and stored when changing from a state in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected. The host vehicle is then controlled to travel along a travel path connecting the first prescribed position and the second prescribed position during travel in a section for which the first and second prescribed positions are stored.
- Therefore, it is possible to set a travel path that connects a first prescribed position with respect to the lane boundary lines when changing from a state in which the lane boundary lines can be detected to a state in which the lane boundary lines cannot be detected, and a second prescribed position when going from a state in which the lane boundary lines cannot be detected to a state in which the lane boundary lines can be detected. During travel in a section for which the first and second prescribed positions are stored, this allows travel in a prescribed position in the lane even in a section such as an intersection in which lane boundary lines cannot be detected.
- The travel control device according to the present invention calculates the lane widthwise center position of the host vehicle lane as the first and second prescribed positions with respect to the lane boundary lines. Thus, it is possible to set a travel path that connects the lane widthwise center positions of the host vehicle lane at the time when the lane boundary lines could be detected. During travel in a section for which the first and second prescribed positions are stored, this allows travel in the center position of the lane, even in sections such as intersections in which lane boundary lines cannot be detected.
- The travel control device according to the present invention calculates and stores the direction along the host vehicle lane at the first and second prescribed positions, and calculates a travel path that connects the first and second prescribed positions such that its orientation matches the direction along the host vehicle lane at the first prescribed position and/or the direction along the host vehicle lane at the second prescribed position. It is thus possible to set a travel path whose orientation matches the orientation of the host vehicle at the first prescribed position and the direction of the host vehicle lane at the second prescribed position. Even in a case in which the orientation of the host vehicle lane at the first prescribed position and the orientation of the host vehicle lane at the second prescribed position significantly differ, such as when the host vehicle turns left or right, or travels along a curve, it is possible to travel in the prescribed position of the lane.
- The travel control device according to the present invention detects and stores a first target present in the vicinity of the host vehicle when the first prescribed position is calculated and stored, and detects a second target corresponding to the first target during travel in a section for which first and second prescribed positions are stored, and corrects the travel path based on the positional deviation between the first target and the second target. Therefore, it is possible to calculate the positional deviation between the first target detected when the first prescribed position was calculated and the second target corresponding to the second target detected during travel in a section for which first and second prescribed positions are stored. It is thus possible to correct the errors in the positions of locators when the first and second prescribed positions are calculated and the positions of locators during travel in a section for which first and second prescribed positions are stored, and to suppress errors in the positions of the travel path connecting the first and second prescribed positions.
- Moreover, the first and second targets may be any one of lane boundary lines, stop lines, traffic lights, road signs, road markings, or a combination thereof. It is thus possible to select one or a more detectable targets from among targets present in the vicinity of the vehicle. It is thus also possible to more accurately correct the errors in the position of the host vehicle when the first prescribed position is calculated, and the position of the host vehicle during travel in a section for which first and second prescribed positions are stored, and to suppress errors in the positions of the travel path connecting the first and second prescribed positions.
- If the turn indicator of the host vehicle is activated as the host vehicle travels in the section from the first prescribed position to the second prescribed position, the travel control device according to the present invention calculates the travel path if a deviation of a prescribed value or more exists between the first and second prescribed positions, or between the attitudes of the host vehicle when the first and second prescribed positions were calculated, and does not calculate a travel path if a deviation of a prescribed value or more does not exist. Therefore, in the case that there is a deviation between the first and second prescribed positions, such as when the host vehicle turns right or left, or travels along a curve, or a case in which the attitudes of the host vehicle are respectively different when the first and second prescribed positions are calculated, a travel path connecting the first and second prescribed positions is calculated. Then, if the first and second prescribed positions do not diverge, such as when the host vehicle changes lanes, or when the attitude of the host vehicle does not deviate at between he first and second prescribed positions when these positions are calculated, a travel path connecting the first and second prescribed positions is not calculated. As a result, when the turn indicator is activated, it is possible to set separate travel paths for host vehicle right/left turns and host vehicle lane changes, thereby preventing the setting of an unsuitable travel path.
- During travel in a section for which the first and second prescribed positions are stored, if the position and attitude of the host vehicle deviate by a prescribed value or more from the position and attitude of the host vehicle when the first prescribed position is calculated and stored the travel control device according to the present invention does not set the calculated travel path as the travel path of the host vehicle. Therefore, if the host vehicle is traveling in a state in which the host vehicle deviates significantly from its own lane, a travel path is not set, and thus the setting of an unsuitable travel path can be prevented.
Claims (8)
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/IB2020/000979 WO2022112811A1 (en) | 2020-11-27 | 2020-11-27 | Travel control method and travel control device |
Publications (2)
Publication Number | Publication Date |
---|---|
US20230391325A1 true US20230391325A1 (en) | 2023-12-07 |
US11840226B1 US11840226B1 (en) | 2023-12-12 |
Family
ID=81754117
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US18/036,208 Active US11840226B1 (en) | 2020-11-27 | 2020-11-27 | Travel control method and travel control device |
Country Status (5)
Country | Link |
---|---|
US (1) | US11840226B1 (en) |
EP (1) | EP4254381A4 (en) |
JP (1) | JP7422248B2 (en) |
CN (1) | CN116547730A (en) |
WO (1) | WO2022112811A1 (en) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140267415A1 (en) * | 2013-03-12 | 2014-09-18 | Xueming Tang | Road marking illuminattion system and method |
US20200073396A1 (en) * | 2018-08-28 | 2020-03-05 | Denso Corporation | Travel assistance method and travel assistance apparatus |
US20200207342A1 (en) * | 2018-12-26 | 2020-07-02 | Automotive Research & Testing Center | Lane tracking method and lane tracking system for an autonomous vehicle |
US20210164797A1 (en) * | 2019-12-03 | 2021-06-03 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method and apparatus for detecting a position change of a lane marker, electronic device and storage medium |
US20210166421A1 (en) * | 2019-12-03 | 2021-06-03 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method, electronic device and storage medium for detecting a position change of lane line |
US20210213930A1 (en) * | 2020-01-13 | 2021-07-15 | Nio Usa, Inc. | Lane prediction and smoothing for extended motion planning horizon |
US20210263162A1 (en) * | 2020-02-21 | 2021-08-26 | Commissariat à l'Energie Atomique et aux Energies Alternatives | Method for determining the position and orientation of a vehicle |
US20220004193A1 (en) * | 2020-07-06 | 2022-01-06 | Honda Motor Co., Ltd. | Processing device, processing method, and medium |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101290230B (en) * | 2008-04-14 | 2011-03-30 | 深圳市凯立德软件技术股份有限公司 | Road crossing navigation method and navigation system using the navigation method |
JP5007840B2 (en) | 2009-05-22 | 2012-08-22 | トヨタ自動車株式会社 | Driving assistance device |
WO2011064825A1 (en) * | 2009-11-27 | 2011-06-03 | トヨタ自動車株式会社 | Drive assistance device and drive assistance method |
JP5708449B2 (en) * | 2011-11-08 | 2015-04-30 | アイシン・エィ・ダブリュ株式会社 | Lane guidance display system, method and program |
EP2871107B1 (en) * | 2012-07-06 | 2023-10-25 | Toyota Jidosha Kabushiki Kaisha | Traveling control device for vehicle |
JP6197393B2 (en) * | 2013-06-20 | 2017-09-20 | 株式会社豊田中央研究所 | Lane map generation device and program |
JP2016218539A (en) * | 2015-05-15 | 2016-12-22 | トヨタ自動車株式会社 | Vehicle runway recognition device |
JP6564618B2 (en) | 2015-05-28 | 2019-08-21 | アイシン・エィ・ダブリュ株式会社 | Road shape detection system, road shape detection method, and computer program |
DE102015211150B4 (en) * | 2015-06-17 | 2023-05-11 | Bayerische Motoren Werke Aktiengesellschaft | Method, driver assistance system and vehicle for learning a trajectory of a road section |
CN105787455A (en) * | 2016-03-01 | 2016-07-20 | 江苏大学 | Lane-keeping control algorithm introducing image virtual guide line |
JP2019012308A (en) * | 2017-06-29 | 2019-01-24 | 株式会社デンソーテン | Image processing device and image processing method |
CN107963077B (en) * | 2017-10-26 | 2020-02-21 | 东软集团股份有限公司 | Control method, device and system for vehicle to pass through intersection |
-
2020
- 2020-11-27 US US18/036,208 patent/US11840226B1/en active Active
- 2020-11-27 EP EP20963401.3A patent/EP4254381A4/en active Pending
- 2020-11-27 CN CN202080107526.3A patent/CN116547730A/en active Pending
- 2020-11-27 JP JP2022564700A patent/JP7422248B2/en active Active
- 2020-11-27 WO PCT/IB2020/000979 patent/WO2022112811A1/en active Application Filing
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140267415A1 (en) * | 2013-03-12 | 2014-09-18 | Xueming Tang | Road marking illuminattion system and method |
US20200073396A1 (en) * | 2018-08-28 | 2020-03-05 | Denso Corporation | Travel assistance method and travel assistance apparatus |
US20200207342A1 (en) * | 2018-12-26 | 2020-07-02 | Automotive Research & Testing Center | Lane tracking method and lane tracking system for an autonomous vehicle |
US20210164797A1 (en) * | 2019-12-03 | 2021-06-03 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method and apparatus for detecting a position change of a lane marker, electronic device and storage medium |
US20210166421A1 (en) * | 2019-12-03 | 2021-06-03 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method, electronic device and storage medium for detecting a position change of lane line |
US20210213930A1 (en) * | 2020-01-13 | 2021-07-15 | Nio Usa, Inc. | Lane prediction and smoothing for extended motion planning horizon |
US20210263162A1 (en) * | 2020-02-21 | 2021-08-26 | Commissariat à l'Energie Atomique et aux Energies Alternatives | Method for determining the position and orientation of a vehicle |
US20220004193A1 (en) * | 2020-07-06 | 2022-01-06 | Honda Motor Co., Ltd. | Processing device, processing method, and medium |
Also Published As
Publication number | Publication date |
---|---|
JPWO2022112811A1 (en) | 2022-06-02 |
US11840226B1 (en) | 2023-12-12 |
EP4254381A1 (en) | 2023-10-04 |
EP4254381A4 (en) | 2024-01-10 |
CN116547730A (en) | 2023-08-04 |
JP7422248B2 (en) | 2024-01-25 |
WO2022112811A1 (en) | 2022-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10793141B2 (en) | Vehicle traveling control apparatus | |
US10988139B2 (en) | Vehicle position control method and device vehicle position control device for correcting position in drive-assisted vehicle | |
US11370425B2 (en) | Traveling controller for vehicle | |
US10569774B2 (en) | Traveling controller for vehicle | |
US10839689B2 (en) | Traveling control apparatus of vehicle | |
US11526173B2 (en) | Traveling trajectory correction method, traveling control method, and traveling trajectory correction device | |
US11904936B2 (en) | Driving support device for vehicle | |
US11468772B2 (en) | Vehicle drive-assist apparatus | |
US11161516B2 (en) | Vehicle control device | |
CN106959114B (en) | Lane extension for a visually steered automated vehicle | |
US11042759B2 (en) | Roadside object recognition apparatus | |
JP6943127B2 (en) | Position correction method, vehicle control method and position correction device | |
JP2021092508A (en) | Travel trajectory estimation method and travel trajectory estimation device | |
EP4046894B1 (en) | Overriding determination method for travel assistance device, and travel assistance device | |
US11840226B1 (en) | Travel control method and travel control device | |
EP4047318A1 (en) | Autonomous driving system and abnormality determination method | |
JP6972528B2 (en) | Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device | |
JP7414683B2 (en) | Own vehicle position estimation device and own vehicle position estimation method | |
US11845436B2 (en) | Vehicle travel locus transmission system and vehicle traffic control system | |
JP7006797B2 (en) | Direction detection system, direction detection method, and direction detection program | |
JP2023064971A (en) | Vehicle position correction system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: RENAULT S.A.S., FRANCE Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:TSUCHIYA, CHIKAO;TAKEI, SHOICHI;SIGNING DATES FROM 20230421 TO 20230424;REEL/FRAME:063593/0873 Owner name: NISSAN MOTOR CO., LTD., JAPAN Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:TSUCHIYA, CHIKAO;TAKEI, SHOICHI;SIGNING DATES FROM 20230421 TO 20230424;REEL/FRAME:063593/0873 |
|
FEPP | Fee payment procedure |
Free format text: ENTITY STATUS SET TO UNDISCOUNTED (ORIGINAL EVENT CODE: BIG.); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
STCF | Information on status: patent grant |
Free format text: PATENTED CASE |