DRIVING ASSISTANCE APPARATUS AND ADJUSTMENT METHOD THEREOF
20200331471 ยท 2020-10-22
Inventors
Cpc classification
B60W30/0956
PERFORMING OPERATIONS; TRANSPORTING
G01S7/4082
PHYSICS
B60W60/0015
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A driving assistance apparatus of a vehicle includes a first sensor, a second sensor and a control unit. The first sensor obtains a position of an object with respect to the first sensor. The second sensor obtains a position of an object with respect to the vehicle. The control unit assists driving of the vehicle utilizing first vehicle relative position for an object detected by the first sensor which indicates a position of that object with respect to the vehicle. The control unit obtains the first vehicle relative position based on a correction angle formed between a reference axis of the vehicle and a reference axis of the first sensor. The correction angle is obtained based on a position of a target with respect to the first sensor obtained by the first sensor, and a position of the target with respect to the vehicle obtained by the second sensor.
Claims
1. A driving assistance apparatus comprising: a first sensor device, including a first detecting section placed at a predetermined first installation position of a vehicle, and configured to obtain first position data indicative of a position of a first object with respect to said first detecting section, said first object being an object present in a first detection region around said vehicle, and said first position data including a combination of a distance between said first detecting section and said first object and an angle formed between a straight line connecting said first detecting section and said first object and a first sensor reference axis extending from said first detecting section to a first predetermined direction; a second sensor device, including a second detecting section placed at a predetermined second installation position of said vehicle, and configured to obtain second vehicle relative position data indicative of a position of a second object with respect to said vehicle, said second object being an object present in a second detection region around said vehicle, and said second detection region including an overlapping detecting region where said first detection region and said second detection region overlap each other; and a control unit implemented by at least one programmed processor and configured to: assist driving of said vehicle utilizing first vehicle relative position data indicative of the position of said first object with respect to said vehicle, said first vehicle relative position data being determined on the basis of said first position data obtained by said first sensor device; start to execute correction angle obtaining processing to obtain an correction angle on the basis of a combination of said first position data obtained by said first sensor device for a first target as a reference object and said second vehicle relative position data obtained by said second sensor device for said first target when it is determined that an operator performs a predetermined correction angle obtainment starting operation, said correction angle being an angle formed between a vehicle reference axis defined based on said vehicle and said first sensor reference axis; and obtain said first vehicle relative position data for an object present in said first detection region on the basis of a combination of said first position data for that object obtained by said first sensor device and said correction angle obtained through said correction angle obtaining processing in a predetermined period other than a period in which said correction angle obtaining processing is being executed.
2. The driving assistance apparatus according to claim 1, wherein, said second sensor device is configured to: obtain second position data including a combination of a distance between said second detecting section and said second object and an angle formed between a straight line connecting said second detecting section and said second object and said vehicle reference axis; and obtain said second vehicle relative position data on the basis of said second position data and a position of said second installation position with respect to said vehicle.
3. The driving assistance apparatus according to claim 2, wherein said first sensor device is a radar apparatus comprising: a radar transmission section which is a part of said first detecting section and is configured to transmit an electromagnetic wave to said first detection region; a radar reception section which is a part of said first detecting section and is configured to receive an electromagnetic wave; and a radar control section configured to obtain said first position data on the basis of said transmitted electromagnetic wave and said received electromagnetic wave; said first detecting section is disposed at a center of a front end of said vehicle in a lateral direction, and said second sensor device is a camera apparatus comprising: an image obtaining section which is placed, as said second detecting section, at said second installation position, and is configured to obtain image data by capturing an image containing an object present in said second detection region, said second installation position being a predetermined position on a cabin side of a front windshield of said vehicle; and an image processing section configured to obtain, as image position data, on the basis of said image data, a combination of a distance between said second detecting section and said second object and an angle formed between a straight line connecting said second detecting section and said second object and a second sensor reference axis extending from said second detecting section to a second predetermined direction with respect to said image processing section, and to treat said image position data as said second position data when said image obtaining section has been fixed to said vehicle such that said second sensor reference axis is parallel to a vehicle longitudinal axis extending in a longitudinal direction of said vehicle, said vehicle longitudinal axis serving as said vehicle reference axis.
4. An adjusting method for the driving assistance apparatus according to claim 1 comprising: placing said first target at a position in said overlapped detecting region; letting said control unit start to execute said correction angle obtaining processing by performing said correction angle obtainment starting operation; and storing said correction angle obtained as a result of said correction angle obtaining processing into a readable and writable storage device.
5. An adjusting method of the driving assistance apparatus according to claim 3 comprising: placing a second target at a center of a front end of said vehicle in the lateral direction, said second target being used for adjusting an axis direction of said second sensor reference axis; letting said second sensor device obtain said second position data for said second target and adjusting a direction of said second detecting section such that the position of said second target indicated by said second position data coincides with a predetermined position, to thereby let said second sensor reference axis parallel to said vehicle longitudinal axis; placing said first target at a position in said overlapped detecting region; letting said control unit start to execute said correction angle obtaining processing by performing said correction angle obtainment starting operation; and storing said correction angle obtained as a result of said correction angle obtaining processing into a readable and writable storage device.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
DETAILED DESCRIPTION
[0035] A driving assistance apparatus according to an embodiment of the present disclosure (hereinafter also referred to as the present assistance apparatus) will now be described with reference to the drawings. The present control apparatus is applied to a vehicle 10 shown in
[0036] The ECU 20 includes a micro-computer, as a major component, which is equipped with a CPU, a ROM, a RAM and a non-volatile memory. The CPU performs data reading, numerical computation, computation result output, and so on, by repeatedly executing predetermined programs (routines). The ROM stores the programs executed by the CPU, lookup tables (maps) read by the CPU during execution of the programs, and so on. The RAM stores data read by the CPU temporarily. The non-volatile memory formed by a rewritable flash memory and stores data peculiar to the vehicle 10 itself such as a correction angle , which is described later.
[0037] The ECU 20 is connected to a radar apparatus 30, a camera apparatus 40, a display 51 and a speaker 52. The radar apparatus 30 is also referred to as a first sensor device for convenience'sake. The camera apparatus 40 is also referred to as a second sensor device for convenience'sake.
(ConfigurationRadar Apparatus)
[0038] The radar apparatus 30 is a millimeter-wave radar apparatus, and disposed at the center of the front end of the vehicle 10 (at the center position in the lateral direction) as shown in
[0039] The radar apparatus 30 can detect an object(s) that is (are) present in a region referred to as a radar detection region. The radar detection region is approximately equal to a range/area between a straight line LRr and a straight line LLr in the horizontal plane and within a predetermined distance from the radar apparatus 30. The center angle of the radar detection region is equal to the angle formed between the straight line LRr and the straight line LLr. The radar detection region is also referred to as a first detection region for convenience' sake.
[0040] A radar central axis Cr is on a straight line (half line) which extends from the radar apparatus 30 (more specifically, from a radar base point Pr described later) to the front direction (referred to as the first predetermined direction) of the radar apparatus 30. The radar central axis Cr is also referred to as a first sensor reference axis for convenience'sake. An angle formed between the radar central axis Cr and the straight line LRr is an angle p and an angle formed between the radar central axis Cr and the straight line LLr is also the angle p. Therefore, the radar central axis Cr is on a bisector of the angle formed between the straight line LRr and the straight line LLr.
[0041] The radar apparatus 30 obtains (measures) location data (also referred to as a first position data for convenience'sake) that identifies a position of an object with respect to the radar apparatus 30 and velocity data that represents velocity (or moving velocity) of the object.
[0042] The first position data includes a combination (pair) of a radar object distance Dr and a radar object angel r described as (Dr, r) hereinafter. The radar object distance Dr is a distance between the radar apparatus 30 (more specifically, the radar base point Pr) and an object. The radar object angel r is an angle formed between a straight line (line segment) from the radar base point Pr to the object and the radar central axis Cr.
[0043] When an object is on the radar central axis Cr, the radar object angel r is 0. When an object is in a region between the radar central axis Cr and the straight line LRr, the radar object angel r is a positive value (namely, r>0), and the magnitude of the radar object angel r becomes larger as the object comes closer to the straight line LRr. When an object is in a region between the radar central axis Cr and the straight line LLr, the radar object angel r is a negative value (namely, r<0), and the magnitude of the radar object angel r becomes larger as the object comes closer to the straight line LLr. Therefore, the radar object angel r falls within the range of (1)p to p.
[0044] A position where the radar object distance Dr is 0 is also referred to as the radar base point Pr. As shown in
[0045] An angle formed between the x axis (namely, the longitudinal direction of the vehicle 10) and the radar central axis Cr is referred to as a correction angle . A method to obtain the correction angle is described later. When the radar central axis Cr is in a region where x>0 and y>0 (namely, when the radar central axis Cr extends in a diagonally right direction of the vehicle 10), the correction angle is a positive value (namely, >0). When the radar central axis Cr is in a region where x>0 and y<0 (namely, the radar central axis Cr extends in a diagonally left direction of the vehicle 10), the correction angle is a negative value (namely, <0). In the case shown in
[0046] The velocity data obtained by the radar apparatus 30 contains a combination (pair) of an object distance velocity Vd and an object angular velocity Va. The object distance velocity Vd indicates the change amount of/in the radar object distance Dr per unit time. The object angular velocity Va indicates the change amount of/in the radar object angel r per unit time.
[0047] As shown in
[0048] The radar transmission section 31 and the radar reception section 32 are also referred to as first detecting section collectively. Therefore, the radar base point Pr coincides with the position of the first detecting section. Notably, the radar transmission section 31, the radar reception section 32 and the radar control section 33 according to the present embodiment are housed in a housing (case), however, the first detecting section which includes the radar transmission section 31 and the radar reception section 32, and the radar control section 33 may be housed in deferent housings (cases) respectively to be separated from each other.
[0049] When the vehicle 10 is in a drivable state, the radar control section 33 executes radar object detecting processing every time a predetermined time interval Tr (fixed value) elapses. The vehicle 10 is in the drivable state in a period from a point in time when an ON operation to an unillustrated ignition switch of the vehicle 10 is performed to a point in time when an OFF operation to the ignition switch is performed, except for a camera axis adjustment period described later and a correction angle obtainment period described later.
[0050] The radar object detecting processing is processing to obtain (measure) and/or figure out the first position data and the velocity data of an object (also referred to as a first object for convenience'sake) that is present in the first detection region on the basis of strength, the frequency and the phase of the radar reflected wave, the time difference from the transition of the radar transmission wave to the reception of the radar reflection wave, and the like.
[0051] The radar control section 33 assigns an identifier to an object (hereinafter, also referred to as a radar detected object) of which the first position data has been obtained. When a plurality of the radar detected objects are present, the radar control section 33 assigns different (unique) identifiers to them.
[0052] After executing the radar object detecting processing, the radar control section 33 transmits radar object information to the ECU 20. When the radar detected object is present, the radar object information includes the identifier, the first position data (Dr, r) and the velocity data of the radar detected object. A position represented (indicated) by first position data (Dr, r) is also referred to as a radar detected position.
(ConfigurationCamera Apparatus)
[0053] The camera apparatus 40 is disposed at a position on the cabin side of a front windshield of the vehicle 10 near an unillustrated inner rear-view mirror (a room mirror) fixed at a center upper portion of the front windshield. More specifically, the center in the lateral direction of the housing of the camera apparatus 40 is positioned at the center of the vehicle 10 in the lateral direction (namely, on the x coordinate). As shown in
[0054] The image obtaining section 41 is disposed (positioned) in the housing of the camera apparatus 40 and at a position displaced by a short length (specifically, lateral base point difference Ay described later) to the right side of the vehicle 10 from the center of the camera apparatus 40 in the lateral direction. The position at which the image obtaining section 41 is disposed with respect to the vehicle 10 is also referred to as a second installation position for convenience'sake. The image obtaining section 41 is also referred to as a second detecting section for convenience'sake.
[0055] The image obtaining section 41 obtains (captures) an image data (more specifically, static image data) representing a front image every time a predetermined time interval Tc (fixed value) elapses, and outputs the front image to the image processing section 42. The front image contain(s) an object(s) in front of the vehicle 10 and a landscape. A detection region of the image obtaining section 41 (namely, camera detecting region) in the lateral plane is equal to a range between a straight line LRc and a straight line LLc shown in
[0056] A camera central axis Cc shown in
[0057] When the vehicle 10 is in the drivable state, the image processing section 42 executes camera object detecting processing every time the image processing section 42 receives image data from the image obtaining section 41 (namely, every time the time interval Tc elapses). The camera object detecting processing is processing to detect (extract) an object contained in the image data (specifically, the front image represented by the image data) by means of a well-known method (in the present embodiment, a template matching method) and to obtain position data representing (indicating) a position of the detected object with respect to the camera apparatus 40. This obtained position data is also referred to as image position data and second position data for convenience'sake. Namely, the camera object detecting processing is processing to obtain (measure) and/or figure out the second position data of an object (also referred to as second object and camera detected object) which is present in the second detecting region.
[0058] The second position data includes a combination (pair) of a camera object distance Dc and a camera object angle c, described as (Dc, c) hereinafter. The camera object distance Dc is a distance between the camera apparatus 40 (more specifically, the camera base point Pc) and an object (namely, the camera detected object). The camera object angle c is an angle formed between a straight line (line segment) from the camera base point Pc to the camera detected object and the camera central axis Cc.
[0059] When an object is on the camera central axis Cc, the camera object angle c is 0. When an object is in a region between the camera central axis Cc and the straight line LRc, the camera object angle c is a positive value (namely, c>0), and the magnitude of the camera object angle c becomes larger as the object comes closer to the straight line LRc. When an object is in a region between the camera central axis Cc and the straight line LLc, the camera object angle c is a negative value (namely, c<0), and the magnitude of the camera object angle c becomes larger as the object comes closer to the straight line LLc. Therefore, the camera object angle c falls within the range of (1)q to q.
[0060] A position where the camera object distance Dc is 0 is also referred to as the camera base point Pc shown in
[0061] The image processing section 42 assigns an identifier to the camera detected object of which the second position data has been obtained. When a plurality of the camera detected objects are present, the image processing section 42 assigns different (unique) identifiers to them. In addition, if the camera detected object which has been detected by the camera object detecting processing executed last time is detected this/current time again (namely, if the camera detected object is detected both at a time point the time interval Tc before and at the present time), the image processing section 42 assigns the same identifier as that assigned to the object when the camera object detecting processing is executed last time (so that the identifier remains unchanged).
[0062] After executing the camera object detecting processing, the image processing section 42 transmits camera object information to the ECU 20. When the camera detected object is present, the camera object information includes the identifier and the second position data (Dc, c). A position represented by the second position data (Dc, c) is also referred to as a camera detected position.
(ConfigurationOthers)
[0063] The display 51 shown in
[0064] The speaker 52 is disposed inside a vehicle compartment of the vehicle 10. A warning sound, a voice message and the like played by the speaker 52 are controlled by the ECU 20.
(Collision Alert Processing)
[0065] When the vehicle 10 is in the drivable state, the ECU 20 determines whether or not an object which is highly likely to collide with the vehicle 10 is present by means of a method described later. In addition, when the ECU 20 determines that such an object is present, the ECU 20 generates an alert to the driver using the display 51 and the speaker 52. Specifically, the ECU 20 displays, on the display 51, characters and figures showing that the vehicle 10 is highly likely to collide with the object, and causes the speaker 52 to reproduce a warning sound.
[0066] An object which is to be subjected to the alert (namely, an object which is determined to be highly likely to collide with the vehicle 10, and thus, for which the alert should be generated) is also referred to as an alert target object. This series of processes is also referred as collision alert processing. The collision alert processing is also referred to as a driving assistance processing for convenience'sake, since it is executed in order to assist the driver of the vehicle 10 to drive.
[0067] When an object which satisfies both a condition (1) and a condition (2) described below is present, the ECU 20 determines that the object is the alert target object.
[0068] Condition (1): the magnitude IDA of the lateral distance Dy (namely, an absolute value of the y coordinate value of the object in the x-y coordinate system) of the object is less than a predetermined distance threshold Dth shown in
[0069] Condition (2): a collision time (or time to collision) TTC that is an estimated time length from a current time point to a time point at which the vehicle 10 will collide with the object is less than a predetermined time threshold Tth.
[0070] In order to determine whether or not the radar detected object is the alert target object, the ECU 20 figures out a longitudinal distance Dx (namely, the x coordinate value) and the lateral distance Dy on the basis of the first data (namely, the radar object distance Dr and the radar object angle r) of the radar detected object in accordance with the following expression (1) and expression (2). Notably, data of a radar detected object including the longitudinal distance Dx and the lateral distance Dy is data which represents (indicates) the position of the radar detected object (first object) with respect to the vehicle 10 and is also referred to as first vehicle relative position data for convenience'sake.
Dx=Drcos(r+)(1)
Dy=Drsin(r+)(2)
[0071] When the radar detected object whose magnitude of the lateral distance Dy figured out in accordance with the expression (2) is less than the distance threshold Dth is present (namely, the condition (1) is satisfied), the ECU 20 figures out the collision time TTC of that object. Specifically, the ECU 20 figures out the collision time TTC on the basis of the quotient of division of the longitudinal distance Dx by a longitudinal relative velocity Vx of the object (namely, TTC=Dx/Vx). Further, the ECU 20 determines whether or not the condition (2) is satisfied on the basis of the collision time TTC. Notably, the longitudinal relative velocity Vx indicates the change amount of the longitudinal distance Dx per unit time, and the ECU 20 figures out the longitudinal relative velocity Vx on the basis of the velocity data (namely, the object distance velocity Vd and the object angular velocity Va) by means of a well-known method.
[0072] In addition, in order to determine whether or not the camera detected object is an alert target object, the ECU 20 figures out the longitudinal distance Dx and the lateral distance Dy on the basis of the second data (namely, the camera object distance Dc and the camera object angle c) of the camera detected object in accordance with the following expression (3) and expression (4). Notably, data of the camera detected object including the longitudinal distance Dx and the lateral distance Dy is data which represents (indicates) the position of the camera detected object (second object) with respect to the vehicle 10 and is also referred as second vehicle relative position data for convenience'sake.
Dx=Dccos(c)+x(3)
Dy=Dcsin(c)+y(4)
[0073] When the camera detected object whose magnitude of the lateral distance Dy figured out in accordance with the expression (4) is less than the distance threshold Dth is present (namely, the condition (1) is satisfied), the ECU 20 determines whether or not the condition (2) is satisfied on the basis of the collision time TTC of that object. Specifically, in order to figure out the collision time TTC, the ECU 20 figures out the longitudinal relative velocity Vx by dividing the difference between the longitudinal distance Dx and a previous longitudinal distance Dxp, which is described later, by the time interval Tc (namely, Vx=(DxDxp)/Tc). In addition, the ECU 20 figures out the collision time TTC on the basis of the quotient of division of the longitudinal distance Dx by the longitudinal relative velocity Vx of the object (namely, TTC=Dx/Vx).
[0074] It should be noted that the longitudinal distance Dx is a value figured out on the basis of the second position data contained in the latest camera object information (latest object information) received from the camera apparatus 40. Meanwhile, the previous longitudinal distance Dxp is a value figured out on the basis of the second position data contained in camera object information received from the camera apparatus 40 just before the latest object information (namely, camera object information received at a point in time before a point in time when the ECU 20 received the latest object information by the time interval Tc).
(Camera Axis Adjustment Operation)
[0075] When the camera apparatus 40 is installed/disposed to the vehicle 10, the camera axis adjustment operation/work is performed for adjusting the axial direction of the camera central axis Cc (namely, the second sensor reference axis). The camera axis adjustment operation is an operation to adjust the mounting angle of the camera apparatus 40 in the horizontal direction/plane with respect to the vehicle 10 such that the direction of the camera central axis Cc and the longitudinal direction of the vehicle 10 are parallel to each other (namely, the second sensor reference axis is parallel to the vehicle reference axis (the vehicle longitudinal axis)). More specifically, the camera axis adjustment operation is performed to adjust the angle of the camera apparatus 40 so as to make the lateral distance Dy obtained on the basis of the camera object information coincide with the actual/true value of the lateral distance Dy.
[0076] For example, after repair or replacement of the camera apparatus 40, the camera axis adjustment operation is performed. Of course, the camera axis adjustment operation is performed when the vehicle 10 is manufactured (the camera apparatus 40 is installed) in a factory.
[0077] When the camera axis adjustment operation is performed, a camera target 60 shown in
[0078] The back side of the target section 61 is fixed to the pillar section 62 such that a lateral center line of the target section 61 (namely, a line extending in the vertical direction through the center in the horizontal direction of the target section 61) coincides with a lateral center line of the pillar section 62. A broken line Lc in
[0079] The pillar section 62 is supported by and stands on the base section 63 such that the pillar section 62 extends from the center of the base section 63 in the vertical direction. The base section 63 is a disk-shaped base. Therefore, when the camera target 60 is placed on a horizontal place/plane, the axis line of the pillar section 62 extends in the vertical direction. The camera target 60 has been previously formed/made such that the height of the optical target benchmark point Ptc coincides with the height of the camera apparatus 40 installed in (fixed to) the vehicle 10.
[0080] As shown in
[0081] Consequently, the position of the optical target benchmark point Ptc on the target section 61 with respect to the vehicle 10 coincides with the radar base point Pr (namely, the origin of the x-y coordinate). Namely, at this time, the actual value of the lateral distance Dy of the optical target benchmark point Ptc is 0. This step for placing (positioning) the camera target 60 at the center in the lateral direction of the front end of the vehicle 10 is also referred to as a second target placing for convenience'sake.
[0082] When the operator performs a predetermined camera axis adjustment starting operation (manipulation) to the display 51 (namely, the touch panel) so that a signal indicating that the camera axis adjustment starting operation has been performed is input to the ECU 20, the ECU 20 starts camera axis adjustment processing. The camera axis adjustment processing is processing to repeat obtaining (figuring out) the lateral distance Dy of the optical target benchmark point Ptc on the target section 61 contained in the front image in accordance with the expression (4) and displaying that obtained lateral distance Dy on the display 51 at a prescribed time interval.
[0083] When the camera axis adjustment processing is executed, the ECU 20 searches for a partial region (similar region) in the front image that is similar to a stored template corresponding to the color pattern on the surface of the target section 61. When the ECU 20 succeeds to find the similar region, the ECU 20 obtains the lateral distance Dy of the center in the lateral direction of the similar region (namely, the lateral distance Dy of the optical target benchmark point Ptc) and displays that lateral distance Dy on the display 51. Meanwhile, if the ECU 20 fails to find the similar region, the ECU 20 displays, on the display 51, characters and figures showing that the target section 61 is not contained in the front image.
[0084] The operator adjusts the mounting angle of the camera apparatus 40 such that the lateral distance Dy displayed on the display 51 becomes 0. As described above, the camera apparatus 40 (specifically, the image obtaining section 41) is installed/arranged such that the camera base point Pc is displaced to the right side by the lateral base point difference Ay from the center in the lateral direction of the vehicle 10. Therefore, if the camera central axis Cc and the longitudinal direction of the vehicle 10 (namely, the vehicle longitudinal axis) are parallel to each other, the first term of the right side in the expression (4) (=Dcsin(c)) becomes equal to y, since the camera object angle c of the optical target benchmark point Ptc is obtained accurately. In other words, when the camera central axis Cc and the vehicle longitudinal axis are parallel to each other, the lateral distance Dy of the optical target benchmark point Ptc figured out in accordance with the expression (4) becomes equal to 0.
[0085] In view of the above, when the lateral distance Dy displayed on the display 51 becomes 0, the operator fixes the mounting angle of the camera apparatus 40 firmly. This step in which the operator makes (lets) the ECU 20 start executing the camera axis adjustment processing and fixes (adjusts) the mounting angle of the camera apparatus 40 such that the lateral distance Dy displayed on the display 51 becomes 0 is also referred to as a second sensor reference axis adjustment step for convenience'sake.
[0086] After that, the operator performs a predetermined camera axis adjustment stopping operation (manipulation) using the display 51 to input, to the ECU 20, a signal indicating that the camera axis adjustment stopping operation has been performed. Consequently, the ECU 20 stops executing the camera axis adjustment processing. Thus, the camera axis adjustment operation is finished. A period in which the ECU 20 executes camera axis adjustment processing (namely, a period from a point in time when the camera axis adjustment starting operation is performed to a point in time when the camera axis adjustment stopping operation is performed) is also referred to as the camera axis adjustment period.
(Correction Angle Obtaining Operation of Radar Apparatus)
[0087] Meanwhile, when the radar apparatus 30 is installed/attached to the vehicle 10, a correction angle obtaining operation is performed for causing the ECU 20 to obtain the correction angle described above (see the expression (1) and the expression (2)). For example, after repair or replacement of the radar apparatus 30, the correction angle obtaining operation is performed. The correction angle obtaining operation is also performed when the vehicle 10 is manufactured (the radar apparatus 30 is installed) in a factory.
[0088] The correction angle obtaining operation is performed in a state where the camera central axis Cc and the vehicle longitudinal axis (namely, the x axis) are parallel to each other (namely, in a state where the camera axis adjustment operation has already been performed). Therefore, for example, when both the camera apparatus 40 and the radar apparatus 30 are replaced, the camera axis adjustment operation is performed at first, and then, the correction angle obtaining operation is performed.
[0089] When the correction angle obtaining operation is performed, a combined target 70 shown in
[0090] The center in horizontal and vertical directions of the surface of the millimetric-wave target 72 is also referred to as a millimetric-wave target benchmark point Ptm. In order for the radar apparatus 30 to obtain the position of the millimetric-wave target 72 accurately, material and shape having high reflectance to the radar transmission wave are employed for the surface of the millimetric-wave target 72. Therefore, when the radar apparatus 30 detects the millimetric-wave target 72 as the radar detected object, the position of the millimetric-wave target benchmark point Ptm with respect to the radar apparatus 30 is obtained as the radar detected position.
[0091] The back side of the optical target 71 and the back side of the millimetric-wave target 72 are fixed to the pillar section 73 respectively such that each of lateral center lines of the optical target 71 and the millimetric-wave target 72 in the vertical direction coincides with a lateral center line of the pillar section 73 (namely, the lateral center line of the pillar section 73 which extends in the vertical direction through the centers in the horizontal direction of the optical target 71 and the millimetric-wave target 72). A broken line Lf in
[0092] The pillar section 73 is supported by and stands on the base section 74 such that the pillar section 73 extends from the center of the base section 74 in the vertical direction. The base section 74 is a disk-shaped base. Therefore, when the combined target 70 is placed on a horizontal place/plane, the axis line of the pillar section 73 extends in the vertical direction. The combined target 70 has been previously made such that the height of the optical target benchmark point Ptc of the optical target 71 coincides with the height of the camera apparatus 40 installed in (fixed to) the vehicle 10 and the height of the millimetric-wave target benchmark point Ptm coincides with the height of the radar apparatus 30 installed in (fixed to) the the vehicle 10.
[0093] Therefore, if the camera axis adjustment operation has already been finished and the correction angle has already been obtained accurately, a combination (pair) of the longitudinal distance Dx and the lateral distance Dy of the millimetric-wave target benchmark point Ptm on the millimetric-wave target 72 obtained on the basis of the radar object information coincides with (is the same as) a combination (pair) of the longitudinal distance Dx and the lateral distance Dy of the optical target benchmark point Ptc on the optical target 71 obtained on the basis of the camera object information.
[0094] The operator of the correction angle obtaining operation places/positions the combined target 70 at a position which is included in (which is within) both the camera detecting region and the radar detecting region. A region where the camera detecting region and the radar detecting region overlap each other is also referred to as an overlapped detecting region for convenience'sake. The position at which the combined target 70 is located/positioned is also referred to as a reference position for convenience'sake. The reference position is an arbitrary position in the overlapped detecting region. In placing the combined target 70 at the reference position, the operator places (arranges) the combined target 70 such that the surface of the millimetric-wave target 72 and the surface of the optical target 71 are approximately parallel to the lateral direction of the vehicle 10. This step in which the operator places the combined target 70 at the reference position is also referred to as a first target placing step for convenience' sake.
[0095]
[0096] Thus, the radar object angel r of the combined target 70 (the millimetric-wave target benchmark point Ptm) obtained by the radar apparatus 30 is equal to the difference between the actual angle m and the correction angle (namely, r=m). Therefore, the relationship represented by the following expression (5) is satisfied.
=mr(5)
[0097] Meanwhile, as understood from
Tx=Drcos(m)=Dccos(c)+x(6)
Ty=Drsin(m)=Dcsin(c)+y(7)
[0098] Further, the relationship represented by the following expression (8) is obtained by eliminating the camera object distance Dc from the expression (6) and the expression (7). Therefore, the relationship represented by the following expression (9) obtained based on the expression (8) is satisfied.
Drsin(mc)=xsin(c)ycos(c)(8)
m=arcsin({xsin(c)ycos(c)}/Dr)+c(9)
[0099] The correction angle obtaining operation is performed on the basis of the relationships between parameters described above. Specifically, the operator performs a predetermined correction angle obtainment starting operation (manipulation) to the display 51 after placing the combined target 70 at a position in the overlapped detecting region (namely, the reference position).
[0100] Accordingly, a signal indicating that the correction angle obtainment starting operation has been performed is input to the ECU 20, and then, the ECU 20 executes correction angle obtaining processing. The correction angle obtaining processing includes following processes (a) to (e). The step in which the operator performs the correction angle obtainment starting operation so as to cause the ECU 20 to start executing the correction angle obtaining processing is also referred to as a correction angle obtaining step for convenience' sake.
[0101] (a) the ECU 20 receives the camera detected position (Dc, c) of the optical target benchmark point Ptc of the combined target 70 from the camera apparatus 40.
[0102] (b) the ECU 20 receives the radar detected position (Dr, r) of the millimetric-wave target benchmark point Ptm of the combined target 70 from the radar apparatus 30.
[0103] (c) the ECU 20 figures out the actual angle m by assigning (applying) the obtained c and Dr to the expression (9).
[0104] (d) the ECU 20 figures out the correction angle by assigning the actual angle m which has been figured out and the radar object angel r which has been received from the radar apparatus 30 to the expression (5).
[0105] (e) the ECU 20 stores the correction angle which has been figured out into the non-volatile memory (namely, a storage device) and displays, on the display 51, a message showing that the correction angle has been figured out.
[0106] Confirming that the message showing that the correction angle has been figured out is displayed on the display 51, the operator performs a predetermined correction angle obtainment stopping operation (manipulation) to the display 51. Accordingly, a signal indicating that the correction angle obtainment stopping operation has been performed is input to the ECU 20, and then, the ECU 20 stops executing the correction angle obtaining processing. The step in which the ECU 20 stores the correction angle which is figured out in/into the non-volatile memory is also referred to as a correction angle storing step for convenience'sake.
[0107] Thus, the correction angle obtaining operation is finished. A period from a point in time when the correction angle obtainment starting operation is performed to a point in time when the correction angle obtainment stopping operation is performed is also referred to as the correction angle obtainment period. The correction angle obtainment period is a period for which the ECU 20 executes a correction angle obtaining processing routine described later.
(Specific Operation)
[0108] Next, specific operation of the ECU 20 in a case where the correction angle obtaining operation is performed will be described. First, the operator places the combined target 70 in the overlapped detecting region in accordance with the procedure described above. Then, when the operator performs the correction angle obtainment starting operation, the CPU of the ECU 20 (also referred to as the CPU for simplification) executes the correction angle obtaining processing routine represented by a flowchart shown in
[0109] Subsequently, the CPU proceeds to step 610 so as to determine whether or not a response (response to the position obtainment request) including the position of the optical target 71 has been received from the camera apparatus 40. If the response has not been received from the camera apparatus 40, the CPU makes a No determination in step 610 and executes the process of step 610 again.
[0110] Meanwhile, if the response has been received from the camera apparatus 40, the CPU makes a Yes determination in step 610 and proceeds to step 615 so as to transmit a request (position obtainment request) to the radar apparatus 30 (specifically, the radar control section 33) in order to obtain the position of the millimetric-wave target benchmark point Ptm (namely, a combination of the radar object distance Dr and the radar object angel r) of the millimetric-wave target 72.
[0111] Subsequently, the CPU proceeds to step 620 so as to determine whether or not a response (response to the position obtainment request) including the position of the millimetric-wave target 72 has been received from the radar apparatus 30. If the response has not been received from the radar apparatus 30, the CPU makes a No determination in step 620 and executes the process of step 620 again.
[0112] Meanwhile, if the response has been received from the radar apparatus 30, the CPU makes a Yes determination in step 620 and proceeds to step 625. In step 625, the CPU figures out the actual angle m in accordance with the expression (9) on the basis of the camera object distance Dc and the camera object angle c which indicate the position of the optical target 71 and the radar object distance Dr and the radar object angel r which indicate the position of the millimetric-wave target 72.
[0113] Subsequently, the CPU proceeds to step 630 so as to figure out the correction angle in accordance with the expression (5) on the basis of the actual angle m which has been figured out and the radar object angel r of the millimetric-wave target 72. In addition, the CPU stores the correction angle which has been figured out in/into the non-volatile memory.
[0114] Further, the CPU proceeds to step 635 so as to display, on the display 51, the message (calculating completion message) showing that the correction angle has been figured out. Subsequently, the CPU proceeds to step 640 so as to determine whether or not the operation (manipulation) to the display 51 as the touch panel (namely, the correction angle obtainment stopping operation) has been performed. If the correction angle obtainment stopping operation has not been performed, the CPU makes a No determination in step 640 and executes the process of step 640 again.
[0115] Meanwhile, if the correction angle obtainment stopping operation has been performed, the CPU makes a Yes determination in step 640 and proceeds to step 645 so as to stop displaying the calculating completion message on the display 51. Subsequently, the CPU proceeds to step 695 so as to end the present routine.
[0116] Meanwhile, when the vehicle 10 is in the drivable state (namely, the present time is included by neither the camera axis adjustment period nor the correction angle obtainment period), the CPU executes a routine (not shown) so as to determine the alert target object is present in accordance with the expression (1) to the expression (4), the condition (1) and the condition (2). When the alert target object is present (detected), the CPU generates an alert using the display 51 and the speaker 52. Namely, the CPU executes the driving assistance processing during a period other than the correction angle obtainment period and the camera axis adjustment period.
[0117] As having been described above, in the correction angle obtaining operation to obtain the correction angle of the radar apparatus 30, the position of the combined target 70 obtained by the camera apparatus 40 whose mounting angle to the vehicle 10 has already been adjusted by the camera axis adjustment operation is utilized. After the correction angle is obtained, the ECU 20 can obtain the longitudinal distance Dx and the lateral distance Dy of the radar detected object on the basis of the radar detected position (Dr, r) obtained by the radar apparatus 30 and the correction angle .
[0118] In addition, in the correction angle obtaining operation of the radar apparatus 30, it is not necessary to place the combined target 70 at a position on the vehicle longitudinal axis of the vehicle 10 passing through the radar base point Pr (namely, the x axis) exactly/accurately, rather the operator may simply place the combined target 70 at a position in the overlapped detecting region (namely, the reference position).
[0119] The embodiment of the driving assistance apparatus according to the present disclosure has been described; however, the present disclosure is not limited to the above-described embodiment, and various modifications are possible without departing from the scope of the disclosure. For example, in the present embodiment, the first sensor device is the radar apparatus 30 (namely, the millimeter-wave radar apparatus). However, the first sensor device may be an apparatus different from the millimeter-wave radar apparatus. Specifically, the first sensor device may be an apparatus having the reference axis for specifying the position of an object such as a LiDAR (Light Detection and Ranging) apparatus and a camera apparatus other than the camera apparatus 40.
[0120] In addition, the ECU 20 according to the present embodiment executes the collision alert processing as the driving assistance processing. However, the ECU 20 may execute processing different from the collision alert processing as the driving assistance processing. For example, the driving assistance processing may be collision avoiding processing for automatically generating brake force at the vehicle 10 in addition to the collision alert processing, or cruise control processing for automatically controlling the acceleration of the vehicle 10 such that the inter-vehicular distance between the vehicle 10 and another vehicle travelling at a position in front of the vehicle 10 detected by the radar apparatus 30 coincides with a predetermined target distance. Furthermore, the driving assistance processing may be processing for controlling the steering angle and the acceleration of the vehicle 10 such that the vehicle 10 travels on (along) a preconfigured (preset) route automatically.
[0121] In addition, the ECU 20 according to the present embodiment obtains the correction angle by executing the correction angle obtaining processing, and obtains the first vehicle relative position data (namely, the longitudinal base point difference x and the lateral base point difference y of the radar detected object) on the basis of that correction angle . However, the radar apparatus 30 may execute these processing in place of the ECU 20. In this case, the radar apparatus 30 (radar control section 33) may receive, from the camera apparatus 40, the camera detected position (Dc, c) related to the optical target benchmark point Ptc of the optical target 71, and obtain the correction angle on the basis of that camera detected position. For example, in this case, the radar control section 33 stores that correction angle in a non-volatile memory included in the radar control section 33. Furthermore, in this case, the radar control section 33 may obtain the first vehicle relative position data on the basis of the correction angle stored in the radar control section 33 and the radar detected position (Dr, r), and send that first vehicle relative position data to the ECU 20.
[0122] Alternatively, the correction angle obtaining processing may be executed by a processing apparatus other than the ECU 20. For example, when an operator performs the correction angle obtaining operation of the radar apparatus 30, the operator may cause a vehicle maintenance terminal which is temporarily connected to the radar apparatus 30 and the camera apparatus 40 to execute the correction angle obtaining processing. In this case, for example, the vehicle maintenance terminal is a general-purpose computer into which programs for vehicle maintenance have been installed. In addition, the correction angle which is obtained by the vehicle maintenance terminal may be registered to the ECU 20 (namely, may be written to the non-volatile memory of the ECU 20) via communication between the vehicle maintenance terminal and the ECU 20. In another case, the operator may operate the display 51 as the touch panel so as to register (input), to the ECU 20, the correction angle displayed on a display of the vehicle maintenance terminal.
[0123] Similarly, the camera axis adjustment processing executed by the ECU 20 according to the present embodiment may be executed by a vehicle maintenance terminal. In this case, when an operator performs the camera axis adjustment operation, the operator may cause the vehicle maintenance terminal temporarily connected to the camera apparatus 40 to display the lateral distance Dy related to the optical target benchmark point Ptc of the target section 61. In this case, the vehicle maintenance terminal may be configured to display, on its display, the lateral distance Dy related to the optical target benchmark point Ptc of the target section 61 obtained by the camera apparatus 40 which is temporarily connected to that terminal.
[0124] In addition, in the present embodiment, the radar apparatus 30 (namely, the first sensor device) is disposed at the center of the front end of the vehicle 10 and the camera apparatus 40 (namely, the second sensor device) is disposed at the position from which an object(s) in the camera detecting region lying in front of the vehicle 10 can be captured as the front image. However, each of the radar apparatus 30 and the camera apparatus 40 may be disposed at a position different from the above-described position. For example, the first sensor device may be disposed at the rear end of the vehicle 10. In this case, the second sensor device may be disposed inside the vehicle compartment of the vehicle 10 such that the second sensor device can capture an image of an object(s) behind the vehicle 10.
[0125] In addition, the vehicle 10 may be equipped with two of the first sensor devices, and the correction angles obtained for each of the first sensor devices may be stored in the non-volatile memory of the ECU 20 respectively. In this case, the first sensor devices may be disposed at each of the right front end and the left front end of the vehicle 10.