DRIVER ASSISTANCE FOR A MOTOR VEHICLE
20230166768 · 2023-06-01
Assignee
Inventors
Cpc classification
B60W30/0956
PERFORMING OPERATIONS; TRANSPORTING
B60W60/0016
PERFORMING OPERATIONS; TRANSPORTING
B60W2554/804
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W60/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A driver-assistance method for a motor vehicle of interest, in which the vehicle of interest detects the third-party vehicles which are present at an initial instant in its environment is disclosed. During a first prediction cycle, an order of priority is assigned to the third-party vehicles which are detected at the initial instant and to the vehicle of interest, corresponding to an order in which the vehicles in the set follow one another in the travel zone starting from a vehicle detected in a position which is furthest ahead of the vehicle of interest. For each selected vehicle in the set, taken in the order of priority, another vehicle in the set is identified which is able to be a primary target vehicle for this selected vehicle. A manoeuvre which is in progress for the selected vehicle is estimated on the basis at least of the identified primary target vehicle.
Claims
1. A driver-assistance method for a motor vehicle of interest, comprising: a detection step during which an on-board system on said motor vehicle of interest detects a plurality of third-party vehicles which are present at an initial instant in the environment of the motor vehicle of interest, in a multi-lane travel zone; a first cycle of prediction, by said on-board system, of a first relative position and of a first relative speed of each vehicle O.sub.k in said set, in a first frame of reference linked to the vehicle of interest and for a first prediction instant following said initial instant, said first prediction cycle comprising: storing, in a database of said on-board system, initial data for each vehicle O.sub.k in a set of K vehicles comprising the third-party vehicles which are detected at the initial instant and the vehicle of interest, said initial data comprising information relating to the current traffic lane, a current relative position and a current relative speed of each vehicle O.sub.k in said set at the initial instant and in said first frame of reference; sorting, during which an order of priority is assigned to the K vehicles O.sub.k in the set, the order of priority being determined in accordance with the position and with the traffic lane of each vehicle O.sub.k in the set which are stored in the database, and corresponding to an order in which the vehicles O.sub.k in the set follow one another in said travel zone starting from a vehicle detected in a position which is furthest ahead of the vehicle of interest; selecting each vehicle O.sub.k in said set in the predetermined order of priority, and, for each selected vehicle O*.sub.k in said set by: identifying another vehicle in said set which is able to be a primary target vehicle for the selected vehicle O*.sub.k; estimating a manoeuvre which is in progress or about to be performed by the selected vehicle O*.sub.k on the basis at least of the identified primary target vehicle, of information relating only to the selected vehicle O*.sub.k and of information relating to the current environment of the selected vehicle O*.sub.k; estimating the movement of the selected vehicle O*.sub.k between the initial instant and said first prediction instant on the basis of the manoeuvre which is estimated for the selected vehicle O*.sub.k; wherein the first relative position and the first relative speed of the selected vehicle O*.sub.k for said first prediction instant is predicted on the basis of the estimated movement.
2. The method according to claim 1, wherein the sub-steps are carried out on the basis of position and speed data which are transformed into a two-dimensional frame of reference which is linked to the selected vehicle O*.sub.k.
3. The method according to claim 1, wherein the estimated manoeuvre is chosen from a predefined set of possible manoeuvres.
4. The method according to claim 3, wherein the predefined set of possible manoeuvres for a selected vehicle O*.sub.k comprises: keeping the selected vehicle in a current lane; changing a selected vehicle lane to the left lane; changing a selected vehicle lane to the right lane; stopping the selected vehicle in the current lane.
5. The method according to claim 1, wherein, identifying a potential primary target vehicle for the selected vehicle O*.sub.k comprises searching for a vehicle in the set located in the same lane, ahead of and closest to the selected vehicle O*.sub.k.
6. The method according to claim 1, wherein the information relating only to the selected vehicle O*.sub.k comprises a sideways movement, and/or an on or off state of one of its indicators, and/or a history of its stored positions.
7. The method according to claim 1, wherein the information relating to the current environment of the selected vehicle O*.sub.k comprises the type of marking lines of the traffic lane in which the selected vehicle O*.sub.k is located and/or the occupancy of the traffic lanes which are adjacent to the current traffic lane of the selected vehicle O*.sub.k and/or the current speed limit assigned to the traffic lane.
8. The method according to claim 1, further comprising: a second cycle of prediction, by said on-board system, of a second relative position and of a second relative speed of each vehicle O.sub.k in said set, in said first frame of reference and for a second prediction instant following said first prediction instant, the second prediction cycle comprising: updating the database, in which the initial relative position and relative speed data are replaced by the first relative position and the first relative speed which are predicted in the first prediction cycle for each vehicle O.sub.k in the set, wherein the sorting, the selection and the sub-steps of the first prediction cycle, in which the initial instant has been replaced by the first prediction instant, and the first prediction instant has been replaced by the second prediction instant.
9. The method according to claim 8, further comprising: a number N, which is greater than 2, of successive prediction cycles, each n.sup.th prediction cycle making it possible to predict an n.sup.th relative position and an n.sup.th relative speed of each vehicle O.sub.k in said set, in said first frame of reference and for an n.sup.th prediction instant following a preceding prediction instant, each n.sup.th prediction cycle comprising: a step of updating the database, in which the relative position and relative speed data are replaced by the relative position and the relative speed which are predicted in the preceding prediction cycle for each vehicle O.sub.k in the set; and wherein the sorting, the selection and the sub-steps of the first prediction cycle, in which the initial instant has been replaced by the preceding prediction instant, and the first prediction instant has been replaced by the n.sup.th prediction instant.
10. The method according to claim 9, wherein the successive prediction instants are separated by a constant time step.
11. The method according to claim 10, in which N is equal to 33 and the constant time step is equal to 200 ms.
12. An on-board driver-assistance system on a vehicle of interest, configured to implement the method according to claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0037] The invention will be better understood in view of the following description, given with reference to the appended figures, in which:
[0038]
[0039]
[0040]
DESCRIPTION OF EMBODIMENT(S)
[0041] In order to give a concrete idea, the invention will now be described in the context of the non-limiting example of the road scene shown schematically in plan view in
[0042] In this
[0043] It is assumed below that the vehicle of interest O.sub.I is equipped: [0044] with various sensors (which are not shown) of different natures (for example, image sensors, Radar, Lidar) making it possible for it to detect, on the one hand, the third-party vehicles O.sub.1 to O.sub.3 and O.sub.5, O.sub.6 which are present in its environment, and, on the other hand, the information relating to the geometry of the road scene (in particular the marking lines, the traffic signs, etc.); [0045] with an ADAS (which is not shown) making it possible for it to process the information detected and to take appropriate decisions (alerts to the driver of the vehicle of interest O.sub.I and/or sideways and lengthways control of the vehicle of interest O.sub.I).
[0046] A complete driver-assistance method which is in accordance with the invention consists in detecting the presence of the various third-party vehicles at an initial instant t.sub.0 and in predicting, for the vehicle of interest O.sub.I and for all the third-party vehicles the presence of which was detected at the initial instant t.sub.0, the future trajectory (or predicted trajectory) over a predetermined total prediction period.
[0047] Below, the following notations will be used: [0048] O.sub.k represents a vehicle in a set of K vehicles comprising the vehicle of interest O.sub.I and all the third-party vehicles detected at the initial instant t.sub.0. Thus, in the example of
t.sub.k=t.sub.0+nΔt
[0053] this point P.sub.k(n) being also conventionally associated with: [0054] the relative position {X; Y; θ}.sub.k,n of the vehicle O.sub.k predicted at the prediction instant t.sub.k in the first frame of reference linked to the vehicle of interest O.sub.I; [0055] the relative speed {V.sub.X, V.sub.Y, {dot over (θ)}}.sub.k,n of the vehicle O.sub.k predicted at the prediction instant t.sub.k in this same first frame of reference linked to the vehicle of interest O.sub.I.
[0056] A predicted trajectory for each vehicle O.sub.k taken from the set comprising the detected third-party vehicles and the vehicle of interest is thus formed, starting from an initial point P.sub.k(0) measured at the initial instant t.sub.0, by a succession of N points P.sub.k(n) estimated successively with a time step Δt, in which n varies from 1 to N.
[0057] In an example of an implementation, the time step Δt is constant between each successive point of a predicted trajectory. By way of example, a time step Δt which is equal to 200 ms is chosen, and the number N is set equal to 33, this making it possible to make a trajectory prediction for each vehicle O.sub.k over a total prediction time of 7 seconds counting from the initial instant t.sub.0.
[0058] With reference to
[0059] The method 100 comprises an initial detection step 110 during which the on-board system on the motor vehicle of interest O.sub.I detects a plurality of third-party vehicles which are present at the initial instant t.sub.0 in the environment of the motor vehicle of interest O.sub.I, in a multi-lane travel zone. In the example of
[0060] In accordance with the notations indicated above, the aim of this first prediction cycle is to make it possible for the on-board system on the vehicle of interest O.sub.I to predict the parameters associated with the first point P.sub.k(1), namely the first relative position {X; Y; θ}.sub.k,1 and the first relative speed {V.sub.X; V.sub.Y, {dot over (θ)}}.sub.k,0 of each vehicle O.sub.k, in the frame of reference associated with the vehicle of interest and for a first prediction instant t.sub.1 following the initial instant t.sub.0.
[0061] For this purpose, the first prediction cycle begins with a step 120 of storing, in a database of the on-board system, initial data for each vehicle O.sub.k in a set of K vehicles comprising the third-party vehicles detected at the initial instant t.sub.0 and the vehicle of interest O.sub.I. The initial data comprise: [0062] on the one hand, the parameters indicated above associated with each initial point P.sub.k(0), namely a current relative position {X; Y; θ}.sub.k,0 and a current relative speed {V.sub.X; V.sub.Y, {dot over (θ)}}.sub.k,0 of each vehicle O.sub.k in the set at the initial instant t.sub.0 and expressed in the first frame of reference linked to the vehicle of interest O.sub.I; [0063] on the other hand, the current traffic lane of each vehicle O.sub.k at the initial instant t.sub.0, as estimated by the on-board system on the vehicle of interest O.sub.I (conventional estimation consisting, for example, in identifying the traffic lane for which the sideways distance along the Y axis calculated between the centre of the vehicle of interest O.sub.I and the centre of each traffic lane L.sub.1, L.sub.2 and L.sub.3 is minimal).
[0064] Table 1 below gives an example of the contents of the database at the detection instant t.sub.0 for the road scene shown in
TABLE-US-00001 TABLE 1 Initial working database Vehicle O.sub.1 O.sub.2 O.sub.3 O.sub.l = O.sub.4 O.sub.5 O.sub.6 Point at t.sub.0 P.sub.1(0) P.sub.2(0) P.sub.3(0) P.sub.4(0) P.sub.5(0) P.sub.6(0) k = 1 k = 2 k = 3 k = 4 k = 5 k = 6 {X; Y; θ}.sub.k, 0 {60; 0; 0} {70; 3.5; 0} {100; 0; 0} {0; 0; 0} {−20; 3.5; 0} {−25; −3.5; 0} {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k, 0 {−16.1; 0; 0} {5.5; 0; 0} {−36.1; 0; 0} {0; 0; 0} {0.2; 0; 0} {−0.5; +0.8; 0} Lane No. 2 3 2 2 3 1
[0065] According to an important feature of the invention, the first prediction cycle continues with a sorting step 130 during which an order of priority is assigned to the K vehicles O.sub.k in the set, the order of priority being determined in accordance with the position and with the traffic lane of each vehicle O.sub.k in the set which are stored in the database, and corresponding to an order in which the vehicles O.sub.k in the set follow one another in the travel zone starting from a vehicle detected in the position furthest ahead of the vehicle of interest O.sub.I. In the case of the road scene given by way of example in
[0066] Table 2 below illustrates Table 1, the columns of which have been reordered according to the order of priority corresponding to the example of a road scene in
TABLE-US-00002 TABLE 2 Initial working database reordered according to order of priority Vehicle O.sub.3 O.sub.2 O.sub.1 O.sub.l = O.sub.4 O.sub.5 O.sub.6 Point at t.sub.0 P.sub.3(0) P.sub.2(0) P.sub.1(0) P.sub.4(0) P.sub.5(0) P.sub.6(0) k = 3 k = 2 k = 1 k = 4 k = 5 k = 6 {X; Y; θ}.sub.k, 0 {100; 0; 0} {70; 3.5; 0} {60; 0; 0} {0; 0; 0} {−20; 3.5; 0} {−25; −3.5; 0} {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k, 0 {−36.1; 0; 0} {5.5; 0; 0} {−16.1; 0; 0} {0; 0; 0} {0.2; 0; 0} {−0.5; +0.8; 0} Lane No. 2 3 2 2 3 1 Order of 1 2 3 4 5 6 priority
[0067] The first prediction cycle continues with particular prediction processing being performed, by the on-board system of the vehicle of interest, on each of the vehicles O.sub.k in the set (including the vehicle of interest O.sub.I). More specifically, the on-board system on the vehicle of interest O.sub.I selects (step 140) each vehicle O.sub.k in the order of priority assigned in step 130. Each vehicle selected in the order of priority is then denoted O.sub.k*. In the example of the road scene shown in
[0068] The particular processing performed on each selected vehicle O.sub.k* essentially comprises the following sub-steps, which will be detailed more fully below: [0069] a sub-step 150 of identifying another vehicle in said set which is able to be a primary target vehicle for the selected vehicle O*.sub.k; [0070] a sub-step 160 of estimating a manoeuvre which is in progress or about to be performed by the selected vehicle O*.sub.k on the basis at least of the primary target vehicle identified in the sub-step 150, of information relating only to the selected vehicle O*.sub.k and of information relating to the current environment of the selected vehicle O*.sub.k; and [0071] a sub-step 170 of estimating the movement of the selected vehicle O*.sub.k between the initial instant t.sub.0 and the first prediction instant t.sub.1, on the basis of the manoeuvre which is estimated in the sub-step 160 for the selected vehicle O*.sub.k.
[0072] In order to simplify the calculations, the sub-steps 150, 160 and 170 are preferably carried out, not on the basis of data expressed in the first frame of reference linked to the vehicle of interest O.sub.I (except in the case where the processing relates to the vehicle O.sub.I as selected vehicle), but of data transformed into a two-dimensional frame of reference linked to the selected vehicle O*.sub.k. All the prediction processing is thus performed as if the on-board system on the vehicle of interest O.sub.I was in fact on board the selected vehicle O*.sub.k. The system must thus, for each prediction processing associated with a selected vehicle O*.sub.k, transform beforehand (by rotation and translation) all the data stored in the reordered initial database into the frame of reference associated with the selected vehicle O*.sub.k, and store this information in a temporary database which is representative of the selected vehicle O*.sub.k.
[0073] By way of examples, Table 3 below gives the temporary database obtained when the selected vehicle O*.sub.k for the processing according to the sub-steps 150 to 170 corresponds to the lorry O.sub.3 (first processing according to the order of priority), and Table 4 below gives the temporary database obtained when the selected vehicle O*.sub.k for the processing according to the sub-steps 150 to 170 corresponds to the vehicle O.sub.3 (second processing according to the order of priority):
TABLE-US-00003 TABLE 3 Temporary database vehicle selected O.sub.3* = O.sub.3 Vehicle O.sub.3* = O.sub.3 O.sub.2 O.sub.1 O.sub.l = O.sub.4 O.sub.5 O.sub.6 {X; Y; θ}*.sub.k, 0 {0; 0; 0} {−30; 3.5; 0} {−40; 0; 0} {−100; 0; 0} {−120; 3.5; 0} {−125; −3.5; 0} {V.sub.X; V.sub.Y; {dot over (θ)}}*.sub.k, 0 {0; 0; 0} {41.6; 0; 0} {20; 0; 0} {36.1; 0; 0} {36.3; 0; 0} {35.6; 0; 0} Lane No. 2 3 2 2 3 1
TABLE-US-00004 TABLE 4 Temporary database vehicle selected O.sub.2* = O.sub.2 Vehicle O.sub.3 O* = O.sub.2 O.sub.1 O.sub.l = O.sub.4 O.sub.5 O.sub.6 {X; Y; θ}*.sub.k, 0 {30; −3.5; 0} {0; 0; 0} {−10; −3.5; 0} {−70; −3.5; 0} {−90; 0; 0} {−95; 0; 0} {V.sub.X; V.sub.Y; {dot over (θ)}}*.sub.k, 0 {−41.6; 0; 0} {0; 0; 0} {−21.6; 0; 0} {−5.5; 0; 0} {−5.3; 0; 0} {−6; +0.8; 0} Lane No. 2 3 2 2 3 1
[0074] In Tables 3 and 4 above: [0075] {X; Y; θ}*.sub.k,0 represents the current relative position of each vehicle O.sub.k after being transformed into a two-dimensional frame of reference linked to the selected vehicle O*.sub.k; [0076] {V.sub.X, V.sub.Y, {dot over (θ)}}.sub.k,0 represents the current relative speed of each vehicle O.sub.k after being transformed into the two-dimensional frame of reference linked to the vehicle of interest O*.sub.k.
[0077] On the basis of the transformed information stored in the temporary database which is representative of a selected vehicle, the on-board system will be able to identify (sub-step 150 mentioned above) whether there exists, in the set of K vehicles, a primary target for the selected vehicle O*.sub.k. Such a potential primary target is conventionally identified by the on-board system of the vehicle of interest by searching for a vehicle in the set which, according to the transformed information stored in the temporary database which is representative of the selected vehicle O*.sub.k, is located in the same lane, ahead of and closest to the selected vehicle O*.sub.k. This search is conventionally performed by searching for the vehicle for which the estimated time to collision (or TTC) with the selected vehicle O*.sub.k is the smallest.
[0078] In the example of a road scene shown in
[0082] The on-board system will then be able to estimate (sub-step 160 mentioned above) the manoeuvre which is in progress or about to be performed by the selected vehicle O*.sub.k using, in particular: [0083] the primary target (or the absence of primary target) identified in the previous sub-step 150 for the selected vehicle O*.sub.k; [0084] information relating only to the selected vehicle O*.sub.k, for example: [0085] its sideways movement, and/or [0086] the on or off state of one of its indicators, and/or [0087] a history of its stored positions; [0088] information relating to the current environment of the selected vehicle O*.sub.k, such as: [0089] the type of marking lines (dotted or continuous) of the traffic lane in which the selected vehicle O*.sub.k is located; and/or [0090] the occupancy of the traffic lanes which are adjacent to the current traffic lane of the selected vehicle O*.sub.k; and/or [0091] the current speed limit assigned to the traffic lane (originating, for example, from a GPS system or from a digital map pre-recorded in the on-board system, or extracted from the image of a traffic sign captured by an on-board camera on the vehicle of interest).
[0092] The manoeuvre which is predicted for the selected vehicle O*.sub.k preferably forms part of a predefined set of possible manoeuvres, such as: [0093] KL.sub.k, or keeping in its current lane: The selected vehicle O*.sub.k continues to drive in its current travel lane; [0094] LLC.sub.k, or changing lane to the left lane: The selected vehicle O*.sub.k will move to the adjacent lane to the left of its current travel lane; [0095] RLC.sub.k, or changing lane to the right lane: The selected vehicle O*.sub.k will move to the adjacent lane to the right of its current travel lane; [0096] S.sub.k, or stopping in current lane: The selected vehicle O*.sub.k will stop in its current travel lane.
[0097] The preceding manoeuvres are not limiting. Other manoeuvres better suited to other road configurations (for example, arriving at a roundabout or at a junction) may be envisaged without departing from the scope of the present invention.
[0098] Table 5 below gives, in particular, the primary targets, predicted manoeuvres, current lane, and target lane which are obtained for the various vehicles in the road scene illustrated in
TABLE-US-00005 TABLE 5 Selected vehicle Primary Predicted O*.sub.k target manoeuvre Current lane Target lane O.sub.1 O.sub.3 KL.sub.1 L.sub.2 L.sub.2 O.sub.2 Ø KL.sub.2 L.sub.3 L.sub.3 O.sub.3 Ø S.sub.3 L.sub.2 L.sub.2 O.sub.4 = O.sub.l O.sub.1 KL.sub.4 L.sub.2 L.sub.2 O.sub.5 O.sub.2 KL.sub.5 L.sub.3 L.sub.3 O.sub.6 Ø LLC.sub.6 L.sub.1 L.sub.2
[0099] The on-board system may then estimate (sub-step 170), in the frame of reference of the selected vehicle O*.sub.k, the predicted movement in terms of position and of speed for the selected vehicle O*.sub.k between the initial instant t.sub.0 and the first prediction instant t.sub.1 on the basis of the primary target (or the absence of primary target) and the estimated manoeuvre for the selected vehicle O*.sub.k. Table 6 below gives an example of the movement thus estimated when the previous prediction processing has been performed, according to the order of priority, on all the vehicles in the set, selected in turn:
TABLE-US-00006 TABLE 6 Movement of each vehicle in its own frame of reference Vehicle O.sub.3 O.sub.2 O.sub.1 O.sub.l = O.sub.4 O.sub.5 O.sub.6 {ΔX; ΔY; Δθ}*.sub.k {0; 0; 0} {1.1; 0; 0} . . . {1; 0; 0} . . . . . . {ΔV.sub.X; ΔV.sub.Y; Δ{dot over (θ)}}*.sub.k {0; 0; 0} {0; 0; 0} . . . {0; 0; 0} . . . . . .
[0100] The preceding results are then transformed again (translation and rotation) in order to be expressed in the frame of reference linked to the vehicle of interest O.sub.I, so that it is possible, on the basis of the calculated movement, to give the predicted position and speed for the prediction instant t.sub.1 for each vehicle (step 180
[0101] A second prediction cycle (which is not shown), which is similar to the first prediction cycle described above, may be carried out by the on-board system on the vehicle of interest O.sub.1 in order to predict the points P.sub.k(2) occupied by each of the K vehicles in the set at a second prediction instant t.sub.2 separated from the first instant t.sub.1 by the time step Δt, that is to say in order to estimate a second relative position {X; Y; θ}.sub.k,2 and a second relative speed {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k,2 of each vehicle O.sub.k in said set, in said first frame of reference and for the second prediction instant. For this purpose, the second prediction cycle comprises: [0102] a first step of updating the database, in which the initial relative position and relative speed data are replaced by the first relative position {X; Y; θ}.sub.k,1 and the first relative speed {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k,1 which are predicted in the first prediction cycle for each vehicle O.sub.k in the set; and [0103] the sorting step 130, the selection step 140 and the sub-steps 150-170 of the first prediction cycle, in which the initial instant t.sub.0 has been replaced by the first prediction instant t.sub.1, and the first prediction instant t.sub.1 has been replaced by the second prediction instant t.sub.2.
[0104] By generalizing the preceding principles, provision may be made for completing the method with a number N, which is greater than 2, of successive prediction cycles, each n.sup.th prediction cycle making it possible to predict an n.sup.th relative position {X; Y; θ}.sub.k,n and an n.sup.th relative speed {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k,n of each vehicle O.sub.k in the initial set, in the first frame of reference linked to the vehicle of interest and for an n.sup.th prediction instant t.sub.0 following a preceding prediction instant t.sub.n-1 every n.sup.th prediction cycle then comprising: [0105] a step of updating the database, in which the initial relative position and relative speed data are replaced by the relative position {X; Y; θ}.sub.k,n-1 and the relative speed {V.sub.X; V.sub.Y; {dot over (θ)}}.sub.k,n-1 which are predicted in the preceding prediction cycle for each vehicle O.sub.k in the set; and [0106] the sorting step 130, the selection step 140 and the sub-steps 150-170 of the first prediction cycle, in which the initial instant t.sub.0 has been replaced by the preceding prediction instant t.sub.n-1, and the first prediction instant has been replaced by the n.sup.th prediction instant t.sub.n.