METHOD FOR ESTIMATING THE POSITION OF A MOTOR VEHICLE ON A ROAD

Abstract

A method for estimating the position of a motor vehicle (1) on a road (5) comprising at least one traffic lane (6) delimited by a first line (7) positioned in a first direction and a second line (8) positioned in a second direction opposite to the first direction, using at least one camera on the motor vehicle (1). The method includes a step for estimating the number of lanes comprising several substeps, and a step for estimating the lane number (Ln) by determining a principal direction chosen between the first and second directions, the lane number at the end of the road (5) in said principal direction being equal to 1 and the lane number at the end of the road (5) in the direction opposite to the principal direction being equal to the number of lanes. Figure for the abstract: Fig 2

Description

Title of the invention: METHOD FOR ESTIMATING THE POSITION OF A MOTOR VEHICLE ON A ROAD technical field

[0001] The present invention relates generally to the adaptive regulation of the speed of a motor vehicle and in particular to the estimation of the position of said motor vehicle on the road.

[0002] Adaptive speed regulation is a function that allows the vehicle to anticipate changes in speed in certain situations.

[0003] In town for example, a roundabout on a segment of road limited to 50 kilometers per hour cannot actually be crossed at 50 kilometers per hour by the motor vehicle but at a lower speed, determined according to several parameters.

[0004] Another example is when a motor vehicle enters a motorway exit lane. Adaptive speed control is implemented in this situation because the motorway exit lane is detected and the vehicle's turn signal is activated. Since the vehicle is leaving the motorway, it is therefore important that its speed be reduced.

[0005] A similar situation occurs when a vehicle moves into the far right lane of the road without using the highway exit lane. However, reducing the vehicle's speed can be dangerous in this case. In another similar situation, the vehicle may also be overtaking another motor vehicle and intend to move back into the far right lane of the road.

[0006] In such a situation, activating the vehicle's adaptive speed control can cause panic if confusion arises regarding the vehicle's exact position. Adaptive speed control can therefore be dangerous. Previous techniques

[0007] To reduce risks, there are now solutions aimed at determining the exact position of the motor vehicle on the road and in particular at determining which lane the motor vehicle is in.

[0008] A first approach to determining the position of the motor vehicle on the road suggests the use of high-definition mapping and a global positioning system (GPS, “Global Positioning System”, in English).

[0009] A second approach consists of using an SD memory card (“Secure Digital” in English), a global positioning system and a camera of the motor vehicle.

[0010] However, these solutions are not optimal because they require several vehicle components sometimes used exclusively for this purpose, thus generating additional installation time, costs and maintenance operations. Description of the invention

[0011] The present invention aims to provide a solution that addresses the aforementioned problems.

[0012] The invention therefore relates to a method for estimating the position of a motor vehicle on a road comprising at least one lane, each lane being delimited by a first line and a second line located on either side of the lane, the method being carried out by means of at least one camera on the motor vehicle. The method comprises: - a step to estimate the number of lanes, comprising the following sub-steps: • Initializing the number of lanes index to 1, • for the lane in question corresponding to the lane in which the motor vehicle is located, detection of the nature of the first and second lines of said lane, the nature of each line that can be crossed or not crossed by the motor vehicle, a crossable line separating the lane in question from an adjacent lane delimited by said crossable line and another line, • when a crossing line is detected, the nature of the other line of the track adjacent to the track in question is detected, • Increment the lane number index by 1 for each traversable line detected,

[0013] the value of the lane number index corresponding to the estimated number of lanes, - a step of estimating the number of the lane considered as a function of the estimated number of lanes and at least one impassable line detected.

[0014] According to one embodiment, the first line of the track considered is the left line of the track considered and the second line of the track considered is the right line of the track considered.

[0015] Advantageously, the step of estimating the number of lanes includes a substep of estimating the distance between the first traversable line of the lane in question and the other line of the adjacent lane delimited by said first line and / or the distance between the second traversable line of the lane in question and the line of the adjacent lane delimited by said second line, the substep of incrementing the index of the number of lanes being carried out only if said distance is less than or equal to a predetermined threshold.

[0016] According to one embodiment, the number of the road in question is determined by analyzing the following scenarios: - The number of the road in question is equal to 1 if the first line of the road in question is impassable. - the number of the road in question is equal to 2 if the other line of the road adjacent to the road in question, delimited by the first line of the road in question, is impassable. - The number of the road in question is equal to the number of lanes if the second line of the road in question is impassable. - the number of the road in question is equal to the subtraction of the number of roads and 1 if the other line of the road adjacent to the road in question, delimited by the second line of the road in question, is impassable, - the number of the road in question is equal to 3 if none of the previous scenarios are verified.

[0017] Advantageously, the method includes a step of determining the leftmost lane of the road.

[0018] Advantageously, the method includes a step of determining the rightmost lane of the road.

[0019] According to one embodiment, the process is carried out using images from the front camera of the motor vehicle.

[0020] Advantageously, the method includes a step of robustifying the estimates in which detected strengthening signals lead to a validation of the estimation action, an invalidation of the estimation action or a delay in the validation or invalidation of the estimation action.

[0021] According to one embodiment, the reinforcement signals include information relating to the motor vehicle and / or information relating to road signs.

[0022] The invention also relates to a motor vehicle comprising a computer capable of performing the process as defined above.

[0023] The invention further relates to a computer program comprising instructions which, when the program is executed by a vehicle's computer, cause the vehicle to implement the process as defined above. Brief description of the drawings

[0024] Other objects, features and advantages of the invention will become apparent from the following description, given solely by way of non-limiting example and made with reference to the accompanying drawings in which:

[0025] - Fig. 1 represents an example of a motor vehicle;

[0026] - The [Fig.2] is a schematic view of a vehicle on a four-lane road;

[0027] - Figure 3 schematically represents an example of estimating the number of lanes of a road;

[0028] - The [Fig.4] is a schematic view of a vehicle on a two-lane road;

[0029] - The [Fig.5] is a schematic view of a vehicle on a three-lane road;

[0030] - The [Fig.6] is a schematic view of a road including an insertion lane;

[0031] - The [Fig.7] is a schematic view of a road including an exit lane;

[0032] - Figure 8 is a schematic view of a road including a sign no right turn sign;

[0033] - Figure 9 is a schematic view of a road including signs directional signage; and

[0034] - Figure 10 is a schematic view of a road including signs road topology signage. Detailed description

[0035] We refer to [Fig. 1] which represents a motor vehicle 1 in an orthogonal coordinate system X, Y, Z. The X axis is parallel to the longitudinal direction of the vehicle 1 and oriented towards the rear of the vehicle 1 in forward motion, the Y axis is perpendicular to the X axis and oriented towards the left of the vehicle 1 viewed from the front, and the Z axis is perpendicular to the plane defined by the X and Y axes and oriented towards the roof of the vehicle 1. The direction of travel of the motor vehicle is thus oriented along an axis opposite to the X axis.

[0036] The motor vehicle 1 includes a camera 2 and a computer 3 capable of implementing a method for estimating the position of the motor vehicle on a road. The camera 2 collects data relating to the road on which the motor vehicle 1 is located and transmits it to the computer 3. In the embodiment illustrated in [Fig. 1], the camera 2 participating in the implementation of the method is the front camera of the motor vehicle 1.

[0037] The motor vehicle 1 also includes a computer program 4 comprising instructions which, when the program is executed by the computer 3 of the motor vehicle 1, lead the latter to implement the method of estimating the position of the motor vehicle 1 on the road.

[0038] As illustrated in [Fig.2], the road 5 on which vehicle 1 is located comprises four traffic lanes, one of which is considered to be lane 6 on which the motor vehicle is located, delimited by a first line 7 and a second line 8.

[0039] In the following description, the first line 7 is considered to correspond to the left line of lane 6 in which motor vehicle 1 is located and the second line 8 is considered to correspond to the right line of lane 6 in which motor vehicle 1 is located. The lane 6 in which motor vehicle 1 is located is referred to as lane 6.

[0040] Lines 7, 8 of route 5 may include ground markings such as a single line, a dashed line or a double line, and / or boundary devices such as barriers, walls or cones.

[0041] The method for estimating the position of the motor vehicle on a road includes a first step which is shown schematically in [Fig.3] and which consists of estimating the number of lanes NbV.

[0042] During a first substep, a lane number index NbV is initialized to 1.

[0043] During a second substep, the natures N of lines 7 and 8 of the lane in question 6 are detected. Lines 7 and 8 may be traversable or impassable by the motor vehicle 1. A traversable line means that a lane adjacent to the lane in question 6 exists. Indeed, a traversable line separates the lane in question 6 from an adjacent lane delimited by said traversable line and another line. A traversable line is generally discontinuous and an impassable line is generally continuous.

[0044] If the method detects at least one crossing line during the second substep, it studies the distance D between said crossing line and the other line of the lane adjacent to the lane in question 6 delimited by said crossing line. If the distance D is less than or equal to a predetermined threshold S, the method increments the lane number index NbV by 1. Advantageously, the predetermined threshold S is less than or equal to 5 meters, and preferably equal to 3.5 meters.

[0045] The step of estimating the number of lanes NbV is performed in the form of a loop. If the nature N of the lane under study is traversable, the nature N of the other lane of a first lane adjacent to the lane under consideration 6 is in turn detected. If said other lane of the first adjacent lane is also traversable, the nature N of the other lane of a second lane adjacent to the first adjacent lane is detected. For each of the traversable lanes detected, the method increments the lane number index NbV by 1.

[0046] The process thus studies each line until an impassable line is detected.

[0047] When the method detects an impassable line to the left and right of vehicle 1, the loop execution is stopped and the total number of lanes NbV is generated. Indeed, if an impassable line is detected, this means that there is no lane adjacent to the lane in question on the side of said impassable line.

[0048] If the process detects an impassable line of the considered track 6, it considers that there is no longer an adjacent track in the direction of the impassable line and stops the loop in said direction.

[0049] According to one embodiment, the step of estimating the number of NbV lanes is completed when an impassable line has been detected on the left of the motor vehicle and when an impassable line has been detected on the right of the motor vehicle, or when the index of the number of NbV lanes is equal to 5. Indeed, the method considers that a road 5 includes a number of NbV lanes less than or equal to 5.

[0050] When the method is implemented on a road segment such as in [Fig. 2], the lane number index is first incremented by 1. Then, the method identifies the left lane 7 and the right lane 8 as crossing lines. Indeed, the camera 2 detects broken lines and concludes that these are crossing lines for the motor vehicle 1.

[0051] The distance D between the left line 7 of the considered track 6 and another line 9 of an adjacent track 10 being less than 5 meters, the track number index NbV is incremented by 1.

[0052] The distance D between the straight line 8 of the considered track 6 and another line 11 of an adjacent track 12 being also less than 5 meters, the track number index NbV is incremented by 1.

[0053] The method then examines the nature N of the lines of the adjacent lanes. Line 9 of the adjacent lane 10 to the left of the lane in question 6 is a traversable line. The lane number index NbV is therefore incremented again by 1. Line 11 of the adjacent lane 12 to the right of the lane in question 6 is an impassable line. Indeed, camera 2 detects a solid line. The method therefore stops the loop performed on the right side of the road 5.

[0054] Furthermore, a line 13 of an adjacent lane 14 to the adjacent lane 10 to the left of the lane considered 6 being detected as an impassable line, the loop made on the left side of route 5 is also stopped.

[0055] The process therefore generates a final number of channels NbV equal to 4, that is to say the estimated number of channels.

[0056] The method for estimating the position of the motor vehicle 1 on the road then includes a second step of estimating the number N°V of the lane considered 6. The [Fig.2] illustrates the motor vehicle 1 positioned on lane number 3 of the road 5, considering a direction going from left to right.

[0057] A road plan is established by considering that the lane number located at the leftmost end MLL of route 5 is equal to 1 and the lane number located at the far right end MRL of route 5 is equal to the number of NbV lanes generated by the lane number estimation step.

[0058] In addition, the number N°V of the lane considered 6 is determined by analyzing one or more scenarios, the aim being to find the scenario corresponding to the current situation of vehicle 1.

[0059] According to a first scenario, if the left line 7 of the lane considered 6 is detected as impassable, then the number N°V of the lane considered 6 is equal to 1. Indeed, if the line to the left of vehicle 1 is impassable, this means that there is no lane adjacent to the left of the lane considered 6. Vehicle 1 is therefore located in the leftmost lane MLL of route 5.

[0060] If the current situation of vehicle 1 does not correspond to the first scenario, a second scenario is analyzed. If the other line 9 of the adjacent lane 10 on the left side of the lane in question 6 is impassable, the number N°V of the lane in question 6 is equal to 2. This scenario means that there is only one lane adjacent 10 to the lane in question 6 on the left side of said lane in question 6. Vehicle 1 is therefore located in the second lane of road 5.

[0061] If this second scenario is not verified, the method examines a third scenario in which the lane number N°V of the lane in question 6 is equal to the lane number NbV determined previously when the straight line 8 of the lane in question 6 is impassable. Indeed, if there is no lane adjacent to the right of the lane in question 6, this means that vehicle 1 is located in the rightmost lane MRL of route 5.

[0062] Furthermore, the method analyzes a fourth scenario if the third scenario does not correspond to the current situation of vehicle 1. According to the fourth scenario, the lane number (N°V) of the lane in question, 6, is equal to the subtraction of the lane number (NbV) and 1 if the other lane (11) of the adjacent lane 12 to the right of the lane in question, 6, is impassable. Indeed, if the adjacent lane 12 to the right of the lane in question, 6, is the rightmost MRL lane of route 5, the lane number (N°V) of the lane in question, 6, is the second-to-last lane of route 5 when considering a direction from left to right.

[0063] According to the described implementation, the method assumes that a road 5 cannot have more than five lanes. Therefore, if none of the preceding scenarios are verified, this means that vehicle 1 is located in the third lane of road 5.

[0064] After finding the scenario corresponding to the situation of the motor vehicle 1, the process generates a number N°V of the lane considered 6.

[0065] According to the situation shown in [Fig. 2], the first, second, and third scenarios are not verified. Indeed, the left-hand line 7 of the considered track 6, the other line 9 of the adjacent track 10 to the left of the track in question 6 and the right line 8 of the track in question 6 are passable.

[0066] The fourth scenario is, however, verified since the other line 11 of the adjacent lane 12 to the right of the lane in question 6 is impassable. The process therefore generates the lane number N°V of the lane in question 6, which is equal to the subtraction of the number of lanes NbV and 1, that is, 3. Vehicle 1 is located on the third lane of road 5.

[0067] The method for estimating the position of the motor vehicle on the road also includes an optional third step of determining the leftmost lane MLL of the road and the rightmost lane MRL of the road.

[0068] Indeed, the nearest detected impassable line to the left line 7 of the lane in question 6 delimits the leftmost lane MLL of the route 5. Therefore, when the motor vehicle 1 is located in the leftmost lane MLL of the route 5, the lane number V of the lane in question 6 is equal to 1. According to the example illustrated in [Fig. 2], the method detects the impassable line 13 of the adjacent lane 14 as being the nearest impassable line to the left line 7 of the lane in question 6 and therefore deduces that the leftmost lane MLL with lane number V equal to 1 is the adjacent lane 14. As illustrated in [Fig. 4], since the left line 7 of the lane in question 6 is impassable, the lane number V of the lane in question 6 is therefore equal to 1.

[0069] Furthermore, the nearest detected impassable line to the straight line 8 of the lane in question 6 delimits the rightmost lane MRL of the route 5. Thus, when the motor vehicle 1 is located in the rightmost lane MRL of the route 5, the number N°V of the lane in question 6 is equal to the total number of lanes NbV. According to the example illustrated in [Fig.2], the process detects the impassable line 11 of the adjacent track 12 as being the impassable line 11 closest to the straight line 8 of the track in question 6 and therefore deduces that the rightmost track MRL with track number N°V equal to the total number of tracks NbV is the adjacent track 12. As illustrated in [Fig.5], the straight line 8 of the track in question 6 being impassable, the track number N°V of the track in question 6 is therefore equal to the number of tracks NbV.

[0070] The advantage of determining whether vehicle 1 is located in the leftmost lane MLL or in the rightmost lane MRL allows, in particular, to understand the speed of surrounding vehicles, to optimize overtaking of surrounding vehicles or to anticipate a possible departure from the road.

[0071] The information from camera 2 may include noise that leads to a misrepresentation of the nature N of the lines for a specific duration, this duration generally extending over a few seconds. Therefore, in certain In these situations, even if camera 2 correctly perceives the nature N of the lines, the number of lanes NbV and the number N°V of the lane considered 6 do not correspond with reality.

[0072] In the example illustrated in [Fig. 6], an merge lane 15 occurs on a two-lane road; the camera 2 identifies said merge lane 15 as a third lane. The method therefore generates a number of lanes NbV and a number N°V of the lane in question 6 that are distorted for the duration that the merge lane 15 exists.

[0073] In the example illustrated in [Fig. 7], an exit lane 16 appears on a two-lane road. The camera 2 identifies the exit lane 16 as a third lane, and the method in this case also generates a number of lanes NbV and a number N°V of the lane in question 6 that are distorted for the duration that the exit lane exists.

[0074] Camera 2 must not consider an insertion lane 15 or an exit lane 16 as an additional lane. These are temporary roads that are not useful to vehicle 1, which is already on the road and intends to remain there.

[0075] In a vehicle 1 driving mode, the intersection between said vehicle 1 and on-ramp 15 or off-ramp 16 lasts only a few seconds. However, a few seconds are sufficient to transmit undesirable information to the adaptive speed control of vehicle 1 and consequently create dangerous situations.

[0076] The method for estimating the position of the motor vehicle on the road therefore includes a fourth step of robustifying the previous estimates, in which reinforcement signals are detected by the camera 2 and allow the validation, invalidation, or delay of the validation or invalidation of the action of the estimates of the number of lanes NbV, the number N°V of the lane in question 6, the leftmost lane MLL, and the rightmost lane MRL. In other words, if the method validates the action, the number of lanes NbV and the number N°V of the lane in question 6 will be estimated again, and if the method invalidates the action, no estimate is calculated again. If the method delays the decision to validate or invalidate the action, no action is performed for a certain time before the method determines whether to validate or invalidate the action.

[0077] In one embodiment, the detected reinforcement signals include information relating to the motor vehicle 1 such as the vehicle's status or the activation of the turn signals and / or information relating to road signs such as the reading of road signs and road markings.

[0078] Thus, in the step of robustifying the estimates, when the process detects a change of lane of vehicle 1, it confirms a change of route 5 and therefore validates the action of estimating the number of lanes NbV and the number N°V of the lane considered 6 so that route 5 on which vehicle 1 is located can be re-examined. For example, a lane change by vehicle 1 is detected by the activation of a turn signal and / or by crossing a line.

[0079] In the case of detection of an merge lane 15 as illustrated in [Fig. 6], the method invalidates or delays the validation or invalidation of the estimation action. For example, an merge lane 15 is detected by reading a yield sign and / or a no-left or no-right turn sign.

[0080] As illustrated in [Fig. 8], if the camera 2 detects a no-right-turn sign 17, the method delays the decision regarding the validation or invalidation of the estimation action because it is not certain whether a merging lane 15 is nearby. Conversely, if a yield sign is detected a few tens of meters further on, a merging lane 15 is present, in which case the method invalidates the estimation action. Delaying the decision regarding the validation or invalidation of the estimation action at the moment of detection of a no-right-turn sign 17 allows for a reassessment a few tens of meters further on to determine whether a merging lane 15 appears or if it is another situation.

[0081] In the case of detection of an exit lane 16 as in [Fig. 7], the method invalidates the estimation action so that the estimates of the lane number NbV and the lane number N°V of the lane in question 6 are not re-estimated, which would risk the adaptive speed control of vehicle 1 being inaccurately activated. For example, an exit lane 16 is detected by reading a speed limit sign and / or a direction sign.

[0082] In the case of detection of direction signs as illustrated in [Fig.9], the method validates the action of estimating the number of lanes NbV and the number N°V of the lane in question 6. Indeed, direction signs 18 generally indicate a change in the topology of the road 5 and it is therefore important that the number of lanes NbV and the number N°V of the lane in question 6 be estimated again.

[0083] Similarly, in the case of detecting signs indicating a change in the topology of route 19 as illustrated in [Fig. 10], the method validates the action of estimating the number of lanes NbV and the number N°V of the lane considered 6.

[0084] Of course, the invention remains within the scope of the invention even if the method has a different order or steps. Indeed, it is possible to design a step for estimating the number N°V of the lane in question 6 by considering a direction from right to left. Furthermore, the camera 2 is capable of reading all the signs and road markings in order to implement the step of robustening the method's estimates.

Claims

Demands

1.

2. Method for estimating the position of a motor vehicle (1) on a road (5) comprising at least one traffic lane (6, 10, 12, 14), each lane (6, 10, 12, 14) being delimited by a first line (7, 8, 9, 13) and a second line (7, 8, 9, 11) situated on either side of the lane (6, 10, 12, 14), the method being carried out by means of at least one camera (2) of the motor vehicle (1) and characterized in that it comprises: a step for estimating the number of lanes (NbV) comprising the following sub-steps: • Initialization of a number of lanes index (NbV) to 1, for the lane in question (6) corresponding to the lane in which the motor vehicle (1) is located, detection of the nature (N) of the first and second lines (7, 8) of said lane (6), the nature (N) of each line that can be crossed or not crossed by the motor vehicle (1), a crossable line separating the lane in question (6) from an adjacent lane delimited by said crossable line and another line, when there is detection of a crossable line, detection of the nature (N) of the other line of the lane adjacent to the lane in question (6), incrementing the index of the number of lanes (NbV) by 1 for each crossable line detected, the value of the lane number index (NbV) corresponding to the estimated number of lanes, a step of estimating the number (N°V) of the road considered (6) based on the estimated number of roads and at least one impassable line detected. A method according to claim 1, wherein the estimation step the number of lanes (NbV) includes a sub-step of estimating the distance (D) between the first traversable line of the lane under consideration (6) and the other line of the adjacent lane delimited by said first line and / or the distance (D) between the second traversable line of the lane in question (6) and the other line of the adjacent lane delimited by said second line, the substep of incrementing the index of the number of lanes (NbV) being carried out only if said distance (D) is less than or equal to a predetermined threshold (S).

3. A method according to any one of claims 1 and 2, wherein the lane number (N°V) is determined by analyzing the following scenarios: - the lane number (N°V) (6) is equal to 1 if the first lane line of the lane in question (6) is impassable, - the lane number (N°V) (6) is equal to 2 if the other lane line adjacent to the lane in question (6) delimited by the first lane line of the lane in question (6) is impassable, - the lane number (N°V) (6) is equal to the number of lanes (NbV) if the second lane line of the lane in question is impassable, - the lane number (N°V) (6) is equal to the number of lanes (NbV) minus 1 if the other lane line adjacent to the lane in question (6) delimited by the second lane line of the lane in question (6) is impassable,- The number (N°V) of the road in question (6) is equal to 3 if none of the previous scenarios are verified.

4. A method according to any one of claims 1 to 3, comprising a step of determining the leftmost lane (MLL) of the road (5).

5. A method according to any one of claims 1 to 4, comprising a step of determining the rightmost lane (MRL) of the road (5).

6. A method according to any one of claims 1 to 5, carried out using images from the front camera of the motor vehicle (1).

7. A method according to any one of claims 1 to 6, comprising a step of robustifying the estimates (NbV, N°V) in which detected strengthening signals lead

8.

9.

10. validation of the estimation action, invalidation of the estimation action, or delay in the validation or invalidation of the estimation action. Method according to claim 7, wherein the reinforcement signals include information relating to the motor vehicle (1) and / or information relating to road signs. Motor vehicle (1) comprising a computer (3) capable of carrying out the method according to any one of claims 1 to 8. Computer program (4) comprising instructions which, when the program is executed by a computer (3) of the motor vehicle (1), cause the latter to implement the method according to any one of claims 1 to 8.