TARGET TRACK GENERATION APPARATUS, VEHICLE CONTROL APPARATUS, TARGET TRACK GENERATION METHOD, AND VEHICLE CONTROL METHOD
20210394755 · 2021-12-23
Assignee
Inventors
- Rei YOSHINO (Tokyo, JP)
- Masaya Endo (Tokyo, JP)
- Yasuyoshi Hori (Tokyo, JP)
- Tetsuharu HAMADA (Tokyo, JP)
- Takahiro URABE (Tokyo, JP)
Cpc classification
B62D15/026
PERFORMING OPERATIONS; TRANSPORTING
B60W2554/4044
PERFORMING OPERATIONS; TRANSPORTING
B60W30/18163
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W30/165
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
In a target track generation apparatus (10), a preceding vehicle position acquisition unit (1) acquires a relative position of a preceding vehicle. A subject vehicle state quantity acquisition unit (2) acquires a state quantity of a subject vehicle. A subject vehicle movement amount calculator (3) calculates a movement amount of the subject vehicle, based on the state quantity of the subject vehicle. A subject vehicle reference preceding vehicle position calculator (4) calculates a point group of subject vehicle reference preceding vehicle positions representing a history of the relative position of the preceding vehicle in a coordinate system using a current position of the subject vehicle as a reference, based on the relative position of the preceding vehicle and the movement amount of the subject vehicle. A target track generator (5) generates a target track of the subject vehicle, based on the point group of the subject vehicle reference preceding vehicle positions. A target track correction determination unit (6) determines whether or not correction of the target track is necessary, based on the point group of the subject vehicle reference preceding vehicle positions or the target track. A correction target track generator (7) generates a correction target track obtained by correcting the target track, based on the point group of the subject vehicle reference preceding vehicle positions or the target track, when it is determined that correction of the target track is necessary.
Claims
1. A target track generation apparatus comprising: a processor to execute a program; and a memory to store the program which, when executed by the processor, performs processes of: acquiring a relative position of a preceding vehicle traveling in front of a subject vehicle; acquiring a state quantity of the subject vehicle; calculating a movement amount of the subject vehicle, based on the state quantity of the subject vehicle; calculating a point group of subject vehicle reference preceding vehicle positions representing a history of the relative position of the preceding vehicle in a coordinate system using a current position of the subject vehicle as a reference, based on the relative position of the preceding vehicle and the movement amount of the subject vehicle; generating a target track of the subject vehicle, based on the point group of the subject vehicle reference preceding vehicle positions; determining whether or not correction of the target track is necessary, based on the point group of the subject vehicle reference preceding vehicle positions or the target track; and generating a correction target track obtained by correcting the target track, based on the point group of the subject vehicle reference preceding vehicle positions or the target track, when it is determined that correction of the target track is necessary.
2. The target track generation apparatus according to claim 1, wherein the processor generates the target track by performing polynomial approximation on the point group of the subject vehicle reference preceding vehicle positions, and the processor generates the correction target track by lowering a degree of the polynomial approximation used to generate the target track.
3. The target track generation apparatus according to claim 2, wherein the processor generates the correction target track by setting a term of a high degree of a polynomial representing the target track to 0.
4. The target track generation apparatus according to claim 1, wherein the processor determines whether or not the preceding vehicle is traveling straight, and when the processor determines that the preceding vehicle is traveling straight, the processor determines that correction of the target track is necessary.
5. The target track generation apparatus according to claim 1, wherein the processor determines that correction of the target track is necessary when an inter vehicle distance between the subject vehicle and the preceding vehicle is smaller than a predetermined threshold.
6. The target track generation apparatus according to claim 1, wherein the processor generates two target tracks having different degrees by performing two polynomial approximations having different degrees on the point group of the subject vehicle reference preceding vehicle positions, the processor determines a magnitude of a difference between the two target tracks, and when the difference between the two target tracks is equal to or less than a predetermined threshold, the processor determines that correction of the target track is necessary, and of the two target tracks, a target track having a lower degree is used as the correction target track, and a target track having a higher degree is used as a target track to be corrected.
7. The target track generation apparatus according to claim 6, wherein the two target tracks are any two out of a target track obtained by performing linear approximation, a target track obtained by performing quadratic approximation, and a target track obtained by performing cubic approximation.
8. A vehicle control apparatus comprising: the target track generation apparatus according to claim 1; and a controller configured to control operation of the subject vehicle, based on the target track or the correction target track.
9. A target track generation method comprising: acquiring a relative position of a preceding vehicle traveling in front of a subject vehicle; acquiring a state quantity of the subject vehicle; calculating a movement amount of the subject vehicle, based on the state quantity of the subject vehicle; calculating a point group of subject vehicle reference preceding vehicle positions representing a history of the relative position of the preceding vehicle in a coordinate system using a current position of the subject vehicle as a reference, based on the relative position of the preceding vehicle and the movement amount of the subject vehicle; generating a target track of the subject vehicle, based on the point group of the subject vehicle reference preceding vehicle positions; determining whether or not correction of the target track is necessary, based on the point group of the subject vehicle reference preceding vehicle positions or the target track; and generating a correction target track obtained by correcting the target track, based on the point group of the subject vehicle reference preceding vehicle positions or the target track, when it is determined that correction of the target track is necessary.
10. The target track generation method according to claim 9, wherein the target track is generated by performing polynomial approximation on the point group of the subject vehicle reference preceding vehicle positions, and the correction target track is generated by lowering a degree of the polynomial approximation used to generate the target track.
11. The target track generation method according to claim 10, wherein the correction target track is generated by setting a term of a high degree of a polynomial representing the target track to 0.
12. The target track generation method according to claim 9, wherein correction of the target track is determined to be necessary when the preceding vehicle is determined to be traveling straight.
13. The target track generation method according to claim 9, wherein correction of the target track is determined to be necessary when an inter vehicle distance between the subject vehicle and the preceding vehicle is smaller than a predetermined threshold.
14. The target track generation method according to claim 9, wherein two target tracks having different degrees are generated by performing two polynomial approximations having different degrees on the point group of the subject vehicle reference preceding vehicle positions, correction of the target track is determined to be necessary when the difference between the two target tracks is equal to or less than a predetermined threshold, and of the two target tracks, a target track having a lower degree is used as the correction target track, and a target track having a higher degree is used as a target track to be corrected.
15. The target track generation method according to claim 14, wherein the two target tracks are any two out of a target track obtained by performing linear approximation, a target track obtained by performing quadratic approximation, and a target track obtained by performing cubic approximation.
16. A vehicle control method comprising: generating the target track or the correction target track by using the target track generation method according to claim 9; and controlling operation of the subject vehicle, based on the target track or the correction target track.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0009]
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
DESCRIPTION OF EMBODIMENTS
First Embodiment
[0030]
[0031] The preceding vehicle position acquisition unit 1 acquires a relative position of the preceding vehicle with respect to the subject vehicle. More specifically, for example, the preceding vehicle position acquisition unit 1 acquires the relative position of the preceding vehicle by detecting a distance and a direction from the subject vehicle to the preceding vehicle by using an on-board sensor that can detect an object present around the subject vehicle, such as a front camera (a camera that captures an image in front of the subject vehicle) and a millimeter wave radar. Further, the preceding vehicle position acquisition unit 1 stores a certain time period of a history of the acquired relative positions of the preceding vehicle.
[0032] The subject vehicle state quantity acquisition unit 2 acquires a state quantity of the subject vehicle. In the present embodiment, the subject vehicle state quantity acquisition unit 2 acquires a velocity and a yaw rate of the subject vehicle as a subject vehicle state quantity that is necessary for the subject vehicle movement amount calculator 3 to calculate a movement amount of the subject vehicle. Note that information acquired by the subject vehicle state quantity acquisition unit 2 may be any information as long as the information can be used for the arithmetic of the movement amount of the subject vehicle, and for example, information such as rotation velocity of tires may be acquired instead of the velocity of the subject vehicle.
[0033] The subject vehicle movement amount calculator 3 calculates the movement amount of the subject vehicle, based on the subject vehicle state quantity acquired by the subject vehicle state quantity acquisition unit 2. For example, as in
[Expression 1]
Δγ(t)={dot over (γ)}(t)Δt (1)
[Expression 2]
ΔX(t)=V(t)sin(Δγ(t))Δt (2)
[Expression 3]
ΔY(t)=V(t)cos(Δγ(t))Δt (3)
[0034] The subject vehicle reference preceding vehicle position calculator 4 converts coordinates of the relative position of the preceding vehicle into coordinates of a coordinate system that uses the current position of the subject vehicle as a reference, based on the relative position of the preceding vehicle acquired by the preceding vehicle position acquisition unit 1 and the subject vehicle movement amount calculated by the subject vehicle movement amount calculator 3. The coordinate system using the current position of the subject vehicle as a reference is hereinafter referred to as a “subject vehicle reference coordinate system”, and the relative position of the preceding vehicle converted into the subject vehicle reference coordinate system is hereinafter referred to as a “subject vehicle reference preceding vehicle position”.
[0035] More specifically, the subject vehicle reference preceding vehicle position calculator 4 calculates a point group consisting of a history of the subject vehicle reference preceding vehicle positions, based on the history of the relative positions of the preceding vehicle stored in the preceding vehicle position acquisition unit 1 and the subject vehicle movement amount calculated by the subject vehicle movement amount calculator 3. For example, a coordinate system in which the X-axis represents the traveling direction of the subject vehicle and the Y-axis represents the vehicle width direction of the subject vehicle is used as the subject vehicle reference coordinate system, similarly to
[Expression 4]
X.sub.mct(t)=cos(−Δγ(t))X.sub.m(t−1)+sin(−Δγ(t))Y.sub.m(t−1)−ΔX(t) (4)
[Expression 5]
Y.sub.mct(t)=sin(−Δγ(t))X.sub.m(t−1)+cos(−Δγ(t))Y.sub.m(t−1)−ΔY(t) (5)
[0036] By performing the arithmetic of the expressions (4) and (5) for the whole history of the relative positions (X.sub.m(t), Y.sub.m(t) stored in the preceding vehicle position acquisition unit 1, the subject vehicle reference preceding vehicle position calculator 4 calculates the point group of the subject vehicle reference preceding vehicle positions (X.sub.mct(t),
[0037] The target track generator 5 performs polynomial approximation on the point group of the subject vehicle reference preceding vehicle positions calculated by the subject vehicle reference preceding vehicle position calculator 4 to generate a travel track of the preceding vehicle, and uses the travel track as a target track of the subject vehicle. For example, when the target track is generated by performing cubic approximation on the point group of the subject vehicle reference preceding vehicle positions (X.sub.mct(t), Y.sub.mct(t)), a target track Y.sub.3(t) at the certain time t can be expressed as in the following expression (6) in the subject vehicle reference coordinate system in which the X-axis represents the traveling direction of the subject vehicle and the Y-axis represents the vehicle width direction of the subject vehicle.
[Expression 6]
Y.sub.3(t)=K.sub.03(t)+K.sub.13(t)X+K.sub.23(t)X.sup.2+K.sub.33(t)X.sup.3 (6)
[0038] In the expression (6), K.sub.03(t) represents a term related to a lateral position (position in the vehicle width direction) with respect to a reference position of the subject vehicle, K.sub.13(t) represents a term related to inclination of the target track, K.sub.23(t) represents a term related to curvature of the target track, and K.sub.33(t) represents a term related to a curvature change rate of the target track. Note that actual curvature K.sub.2r(t) and curvature change rate K.sub.3r(t) of the target track at an X coordinate X.sub.tt on the target track can be calculated. according to the following expressions (7) and (8).
[Expression 7]
K.sub.2r(t)=2K.sub.23(t)+6K.sub.33(t)X.sub.tt (7)
[Expression 8]
K.sub.3r(t)=6K.sub.33(t) (8)
[0039] Further, when the target track obtained by performing quadratic approximation on the point group of the subject vehicle reference preceding vehicle positions (X.sub.mct(t), Y.sub.mct(t)) is generated by considering that the target track is a curve without a curvature change, a target track Y.sub.2(t) can be expressed as in the following expression (9).
[Expression 9]
Y.sub.2(t)=K.sub.02(t)+K.sub.12(t)X+K.sub.22(t)X.sup.2 (9)
[0040] In the expression (9), K.sub.02(t) represents a term related to a lateral position with respect to the reference position of the subject vehicle, K.sub.12(t) represents a term related to inclination of the target track, and K.sub.22(t) represents a term related to curvature of the target track. Note that actual curvature K.sub.2r(t) of the target track can be calculated according to the following expression (10).
[Expression 10]
K.sub.2r(t)=2K.sub.22(t) (10)
[0041] The target track correction determination unit 6 performs determination (hereinafter referred to as “target track correction determination”) as to whether or not correction of the target track is necessary, based on the subject vehicle reference preceding vehicle positions calculated by the subject vehicle reference preceding vehicle position calculator 4 or the target track generated by the target track generator 5.
[0042]
[0043] The preceding vehicle straight travel determination performed by the preceding vehicle straight travel determination unit 6a. will be described.
[0044]
[0045] As in
[0046] Thus, when the preceding vehicle straight travel determination unit 6a determines that the preceding vehicle is traveling straight, the target track correction determination unit 6 according to the first embodiment determines that correction of the target track is necessary.
[0047] With reference to
[0048] In this case, a track CT.sub.1 connecting the reference position P.sub.sd of the subject vehicle and the preceding vehicle straight travel determination position P.sub.sj(X.sub.sj(t), Y.sub.sj(t)) can be expressed as in the following expression (11).
[Expression 11]
Y(t)=(Y.sub.sj(t)/X.sub.sj(t).sup.2)X.sup.2 (11)
[0049] Further, curvature K.sub.CT1(t) of the track CT.sub.1 expressed by the expression (11) can be expressed as in the following expression (12).
[Expression 12]
K.sub.CT1(t)=2(Y.sub.sj(t)/X.sub.sj(t).sup.2) (12)
[0050] The preceding vehicle straight travel determination unit 6a compares the magnitude of the curvature K.sub.CT1(t) expressed by the expression (12) and the magnitude of the curvature K.sub.2r(t) of the target track TT expressed by the expression (7) or the expression (10), and when the magnitude of the curvature K.sub.2r(t) is smaller than the magnitude of the curvature K.sub.CT1(t), the preceding vehicle straight travel determination unit 6a determines that the preceding vehicle is traveling straight. When the preceding vehicle straight travel determination unit 6a determines that the preceding vehicle is traveling straight, the target track correction determination unit 6 determines that correction of the target track generated in the target track generator 5 is necessary.
[0051] When the target track correction determination unit 6 determines that correction of the target track is necessary, the correction target track generator 7 corrects the target track, based on the subject vehicle reference preceding vehicle positions calculated by the subject vehicle reference preceding vehicle position calculator 4 or the target track generated by the target track generator 5. The target track after correction is hereinafter referred to as a “correction target track”. Specifically, the correction target track generator 7 generates the correction target track by lowering the degree of the polynomial representing the target track, with respect to the target track generated by the target track generator 5 by performing multi-term approximation. In other words, the correction target track generated by the correction target track generator 7 is generated by performing, on the point group of the subject vehicle reference preceding vehicle positions, polynomial approximation of a degree lower than the degree of the polynomial approximation used by the target track generator 5 to generate the target track.
[0052] For example, when the target track generated by the target track generator 5 is a target track of cubic approximation as expressed in the expression (6), the correction target track generator 7 generates the target track of quadratic approximation as expressed in the expression (9) or the target track of linear approximation as expressed in the following expression (13) as the correction target track.
[Expression 13]
Y(t)=K.sub.01(t)+K.sub.11(t)X (13)
[0053] In the expression (13), K.sub.01(t) represents a term related to a lateral position with respect to the reference position of the subject vehicle, and K.sub.11(t) represents a term related to inclination of the target track.
[0054] Further, the correction target track generator 7 may set a term of a high degree included in the approximation of the target track generated by the target track generator 5 to 0 to generate the target track of a low degree, and may use the target track as the correction target track.
[0055] The controller 8 controls the operation of the subject vehicle, based on the target track generated by the target track generation apparatus 10 (the target track generated by the target track generator 5 or the correction target track generated by the correction target track generator 7). Specifically, the controller 8 controls a steering angle of the subject vehicle so as to cause the subject vehicle to follow the target track generated by the target track generation apparatus 10.
[0056] The target track generation apparatus 10 according to the first embodiment corrects the target track by lowering the degree of the polynomial representing the target track when the preceding vehicle is traveling straight. Detection errors of the relative position of the preceding vehicle are liable to influence the shape of the target track when the preceding vehicle is traveling straight; however, by lowering the degree of the target track, such influence can be reduced. For example, curvature variation of the target track caused by the detection errors can be reduced by correcting the target track obtained with cubic approximation into the target track obtained with quadratic approximation. Further, the vehicle control apparatus 100 can accurately and smoothly execute control of the subject vehicle by controlling the subject vehicle based on the target track generated by the target track generation apparatus 10.
[0057] The operation of the vehicle control apparatus 100 according to the first embodiment will be described below with reference to flowcharts.
[0058]
[0059] In Step ST4, the subject vehicle reference preceding vehicle position calculator 4 calculates a history of preceding vehicle positions converted into the subject vehicle reference coordinate system (point group of the subject vehicle reference preceding vehicle positions), based on the subject vehicle movement amount calculated in Step ST2 and the history of the relative positions of the preceding vehicle acquired in Step ST3. In Step ST5, the target track generator 5 generates the target track by performing polynomial approximation on the point group of the subject vehicle reference preceding vehicle positions calculated in Step ST4. In Step ST6, the target track correction determination unit 6 determines whether or not correction of the target track generated in Step STS is necessary. A detailed flow of Step ST6 will be described later.
[0060] When it is determined that correction of the target track is necessary in Step ST6, in Step ST7, the correction target track generator 7 corrects the target track generated in Step ST5. A correction method of the target track is performed as follows: the correction target track is generated by performing polynomial approximation on the target track generated in Step ST5 again with a degree lower than the target track. Further, a term of a high degree of the target track having a higher degree may be set to 0 to calculate the target track of a low degree, and the target track may be used as the correction target track.
[0061] In Step ST8, the controller 8 controls the subject vehicle so that the target track generation apparatus 10 follows the generated target track. Specifically, when it is determined that correction of the target track is not necessary, the controller 8 controls operation of the subject vehicle, based on the target track generated in Step ST5. Further, when it is determined that correction of the target track is necessary, the controller 8 controls operation of the subject vehicle, based on the target track corrected in Step ST7 (correction target track). The vehicle control apparatus 100 repeatedly executes the processing of
[0062] The details of the determination processing (target track correction determination) of Step ST6 of
[0063] The details of the determination processing (preceding vehicle straight travel determination) of Step ST6a of
[0064] In Step ST6a3, the preceding vehicle straight travel determination unit 6a sets the preceding vehicle straight travel determination position P.sub.sj(X.sub.sj, Y.sub.sj)=(l.sub.1, d.sub.th1) at a position away from a position, which is away from the reference position P.sub.sd(X.sub.sd, Y.sub.sd) in the traveling direction (X-axis direction) by the inter vehicle distance l.sub.1, in the vehicle width direction by the threshold d.sub.th1. In Step ST6a4, the preceding vehicle straight travel determination unit 6a generates the track CT.sub.1 connecting the reference position P.sub.sd(X.sub.sd, Y.sub.sd) of the subject vehicle and the preceding vehicle straight travel determination position P.sub.sj. In Step ST6a5, the preceding vehicle straight travel determination unit 6a calculates the curvature K.sub.CT1(t) of the track CT.sub.1.
[0065] In Step ST6a6, the preceding vehicle straight travel determination unit 6a determines whether or not the magnitude of the curvature K.sub.2r(t) of the target track is smaller than the magnitude of the curvature K.sub.CT1(t) of the track CT.sub.1. When the magnitude of the curvature K.sub.2r(t) of the target track is smaller than the magnitude of the curvature K.sub.CT1(t) of the track CT.sub.1, the processing proceeds to Step ST6a7, and the preceding vehicle straight travel determination unit 6a determines that the preceding vehicle is traveling straight. When the magnitude of the curvature K.sub.2r(t) of the target track is equal to or larger than the magnitude of the curvature K.sub.CT1(t) of the track CT.sub.1, the processing proceeds to Step ST6a8, and the preceding vehicle straight travel determination unit 6a determines that the preceding vehicle is not traveling straight.
Second Embodiment
[0066] In the first embodiment, the target track correction determination unit 6 determines the necessity of correction of the target track, based on whether or not the preceding vehicle is traveling straight. In the second embodiment, the target track correction determination unit 6 performs the determination, based on the inter vehicle distance between the subject vehicle and the preceding vehicle.
[0067]
[0068] Note that the overall configuration of the vehicle control apparatus 100 according to the second embodiment is similar to that of the first embodiment (
[0069] The inter vehicle distance determination perfbrmed by the inter vehicle distance determination unit 6b will be described.
[0070]
[0071] As in
[0072] Thus, when the inter vehicle distance determination unit 6b determines that the inter vehicle distance between the subject vehicle and the preceding vehicle is equal to or less than a threshold, the target track correction determination unit 6 according to the second embodiment determines that correction of the target track is necessary.
[0073] With reference to
[0074] Let V(t) be velocity of the subject vehicle and α.sub.ylim be a limit value of lateral acceleration. In this case, a track CT.sub.2 of a case assuming a regular circular driving with the lateral acceleration at the limit value α.sub.ylim can be expressed as in the following expression (14).
[Expression 14]
Y(t)=(α.sub.ylim/2V(t).sup.2)X.sup.2 (14)
[0075] In the second embodiment, an X coordinate when a Y coordinate of the track CT.sub.2 expressed by the expression (14) is the same as that of the first threshold d.sub.th2 is set as a second threshold l.sub.th for inter vehicle distance determination. The second threshold l.sub.th can be expressed as in the following expression (15).
[Expression 15]
l.sub.th(t)=V(t)√{square root over ((2d.sub.th2/α.sub.ylim))} (15)
[0076] The inter vehicle distance determination unit 6b compares the inter vehicle distance l.sub.1 between the subject vehicle and the preceding vehicle and the second threshold l.sub.th expressed by the expression (15), and when the inter vehicle distance l.sub.1 is equal to or less than the second threshold l.sub.th, the inter vehicle distance determination unit 6b determines that the inter vehicle distance is short.
[0077] By setting the threshold (second threshold l.sub.th) used as a reference for determining whether or not the inter vehicle distance is short in the manner described above, the inter vehicle distance determination according to the velocity of the subject vehicle can be performed. Note that a determination method of the threshold may not be the method that is based on the limit value α.sub.ylim of the lateral acceleration. For example, a table in which a relationship between. the vehicle velocity of the subject vehicle and the threshold for inter vehicle distance determination is described may be provided in advance.
[0078] When the inter vehicle distance determination unit 6b determines that the inter vehicle distance between the subject vehicle and the preceding vehicle is short, the target trade correction determination unit 6 according to the second embodiment determines that correction of the target track generated in the target track generator 5 is necessary. Note that a correction method of the target track by the correction target track generator 7 may be, similarly to the first embodiment, the method of lowering the degree of the polynomial representing the target track.
[0079] When the inter vehicle distance between the subiect vehicle and the preceding vehicle is short, the target track generation apparatus 10 according to the second embodiment corrects the target track by lowering the degree of the polynomial representing the target track. When the inter vehicle distance is short, the period of fluctuation of the target track caused by the detection errors of the relative position of the preceding vehicle is short; however, by lowering the degree of the target track, the fluctuation of the target track is reduced, and the number of times of steering per certain time period is prevented from increasing. Further, the vehicle control apparatus 100 can accurately and smoothly execute control of the subject vehicle by controlling the subject vehicle based on the target track generated in the target track generation apparatus 10.
[0080] With reference to a flowchart, the operation of the vehicle control apparatus 100 according to the second embodiment will be described below. Note that the overall operation of the vehicle control apparatus 100 is similar to that of the flowchart of
[0081] The processing of the target track correction determination according to the second embodiment is illustrated in the flowchart of
[0082] The details of the determination processing (inter vehicle distance determination) of Step ST6d of
[0083] In Step ST6d1, the inter vehicle distance determination unit 6b sets the first threshold d.sub.th2 for inter vehicle distance determination at a position away from the X-axis of the subject vehicle reference coordinate system in the Y-axis direction by a certain distance. In Step ST6d2, the inter vehicle distance determination unit 6b calculates the inter vehicle distance l.sub.1 between the subject vehicle and the preceding vehicle. In Step ST6d3, the inter vehicle distance determination unit 6b sets the limit value α.sub.ylim of lateral acceleration of the subject vehicle. In Step ST6d44 the inter vehicle distance determination unit 6b generates the track CT.sub.2 assuming regular circular driving with the lateral acceleration of the subject vehicle at the limit value α.sub.ylim. In Step ST6d5, the inter vehicle distance determination unit 6b calculates an X coordinate when a Y coordinate of the track CT.sub.2 is the same as that of the first threshold d.sub.th2, and sets the value as the second threshold l.sub.th for inter vehicle distance determination.
[0084] In Step ST6d6, the inter vehicle distance determination unit 6b determines whether or not the inter vehicle distance l.sub.1 is equal to or less than the second threshold l.sub.th. When the inter vehicle distance 1.sub.1 is equal to or less than the second threshold l.sub.th, the processing proceeds to Step ST6d7, and the inter vehicle distance determination unit 6b determines that the inter vehicle distance l.sub.1 is short. When the inter vehicle distance l.sub.1 is larger than the second threshold l.sub.th, the processing proceeds to Step ST6d8, and the inter vehicle distance determination unit 6b determines that the inter vehicle distance l.sub.1 is long.
Third Embodiment
[0085] In the third embodiment, the target track generator 5 generates two target tracks having different degrees of polynomial approximations, arid the target track correction determination unit 6 determines necessity of correction of the target track, based on the difference between the two target tracks.
[0086]
[0087] The target track difference determination performed by the target track difference determination unit 6c will be described.
[0088] As illustrated in
[0089] The target track difference determination unit 6c calculates a Y coordinate Y.sub.h when an X coordinate is the same as the X coordinate (X.sub.fvnew) of the point P.sub.fvnew in the target track TT.sub.7 and a Y coordinate Y.sub.1 when an X coordinate is the same as the X coordinate (X.sub.fvnew) of the point P.sub.fvnew in the target track TT.sub.8, and further calculates the magnitude of the difference between Y.sub.h and Y.sub.l as a target track difference d.sub.e.
[0090] Then, the target track difference determination unit 6c compares the target track difference and a predetermined threshold d.sub.th3 for target track difference determination. When the target track difference d.sub.e is equal to or less than the threshold d.sub.th3, the target track difference determination unit 6c determines that the difference between the two target tracks TT.sub.7 and TT.sub.8 is small. When the target track difference d.sub.e is larger than the threshold d.sub.th3, the target track difference determination unit 6c determines that the difference between the two target tracks TT.sub.7 and TT.sub.a is large.
[0091] Here, the target track obtained with polynomial approximation of a high degree has high accuracy of approximation but has a shape with many curvature variations. Accordingly, the target track has a large number of times of steering when the subject vehicle is caused to travel by thllowing another vehicle. On the other hand, the target track obtained with polynomial approximation of a low degree does not have high accuracy of approximation but has a stable shape with fewer curvature variations. Accordingly, the target track can reduce the number of times of steering when the subject vehicle is caused to travel by following another vehicle and contribute to smooth control of the subject vehicle. Thus, when the shape of the target track obtained with polynomial approximation of a high degree and the shape of the target track obtained with polynomial approximation of a low degree are similar to each other, it is preferable that the target track obtained with polynomial approximation of a low degree be used.
[0092] Thus, when the difference between two target tracks having different degrees is small, the target track correction determination unit 6 according to the third embodiment determines that it is necessary to correct the target track of a high degree into the target track of a low degree in order to implement smooth control of the subject vehicle. Further, when the difference between two target tracks is large, the target track correction determination unit 6 determines that correction of the target track of a high degree is not necessary in order to maintain accuracy of the approximation.
[0093] When it is determined that correction of the target track is necessary, the correction target track generator 7 uses, out of the two target tracks, the target track with polynomial approximation of a lower degree as the correction target track, whereas when it is determined that correction of the target track is not necessary, the correction target track generator 7 uses the target track with polynomial approximation of a higher degree as the correction target track.
[0094] When the difference between two target tracks having different degrees is small, the target track generation apparatus 10 according to the third embodiment can reduce curvature variation of the target track caused by the detection errors by correcting the target track by adopting the target track of a lower degree. Further, the vehicle control apparatus 100 can accurately and smoothly execute control of the subject vehicle by controlling the subject vehicle based on the target track generated by the target track generation apparatus 10.
[0095] With reference to a flowchart, the operation of the vehicle control apparatus 100 according to the third embodiment will be described below. The overall operation of the vehicle control apparatus 100 is largely similar to that of the flowchart of
[0096] In the third embodiment, in Step ST5 of
[0097] Note that the target track generator 5 may generate three or more target tracks having different degrees, and the target track correction determination unit 6 may select two of the target tracks. Further, the target track generator 5 may generate the target track having a lower degree by setting a term of a high degree of the target track having a higher degree to 0.
[0098] The determination processing of Step ST6 in the third embodiment is illustrated in the flowchart of
[0099] The details of the determination processing (target track difference determination) of Step ST6g of
[0100] In Step ST6g1, the target track difference determination unit 6c sets a threshold d.sub.th3 for target track difference determination. In Step ST6g2, the target track difference determination unit 6e calculates a Y coordinate Y.sub.h when an X coordinate is the same as a specific value (for example, of
[0101] In Step ST6g5, the target track difference determination unit 6c determines whether or not the target track difference d.sub.e is equal to or less than the threshold d.sub.th3. When the target track difference d, is equal to or less than the threshold d.sub.th3, the processing proceeds to Step ST6g6, and the target track difference determination unit 6c determines that the difference between the two target tracks is small. When the target track difference d.sub.e is larger than the threshold d.sub.th3, the processing proceeds to Step ST6g7, and it is determined that the difference between the two target tracks is large.
[0102] Further, in the third embodiment, in Step ST7 of
[0103] <Hardware Configuration Example>
[0104]
[0105] When the processing circuit 50 is dedicated hardware, examples of the processing circuit 50 include a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, an application specific integrated circuit (ASIC), a field-programmable gate array (FPGA), or a combination of these, for example. Each of the functions of the components of the target track generation apparatus 10 may be implemented with individual processing circuits, or those functions may be collectively implemented with one processing circuit.
[0106]
[0107] Here, the memory 52 may be, for example, non-volatile or volatile semiconductor memory, such as a random access memory (RAM), a read only memory (ROM), a flash memory, an erasable programmable read only memory (EPROM), and an electrically erasable programmable read only memory (EEPROM), a hard disk drive (HDD), a magnetic disk, a flexible disk, an optical disc, a compact disc, a MiniDisc, a digital versatile disc (DVD), and a drive apparatus or the like therefor, or any storage medium to be used in future.
[0108] The above has described a configuration in which the functions of the components of the target track generation apparatus 10 are implemented with any One of hardware and software or the like. However, this is not restrictive, and a part of the components of the target track generation apparatus 10 may be implemented with dedicated hardware, and another part of the components may be implemented with software or the like, For example, functions of a part of the components can be implemented with the processing circuit 50 as the dedicated hardware, and. functions of another part of the components can be implemented with the processing circuit 50 as the processor 51 reading and executing a program stored in the memory 52.
[0109] As described above, the target track generation apparatus 10 can implement each function described above with hardware, software or the like, or a combination of these,
[0110] Note that, in the present invention, each embodiment can be freely combined and each embodiment can be modified or omitted as appropriate within the scope of the invention.
[0111] While the present invention has been shown and described in detail, the foregoing description is in all aspects illustrative and not restrictive. It is therefore understood that numerous unillustrated modifications can be devised without departing from the scope of the invention.
EXPLANATION OF REFERENCE SIGNS
[0112] 100 Vehicle control apparatus, 10 Target track generation apparatus, 1 Preceding vehicle position acquisition unit, 2 Subject vehicle state quantity acquisition unit, 3 Subject vehicle movement amount calculator, 4 Subject vehicle reference preceding vehicle position calculator, 5 Target track generator, 6 Target track correction determination unit, 7 Correction target track generator, 8 Controller, 6a Preceding vehicle straight travel determination unit, 6b Inter vehicle distance determination unit, 6c Target track difference determination unit.