The present invention relates to a vehicle control device in which a radio receiver is installed in a vehicle, and a position of the vehicle is estimated from at least one of distance information based on reception intensity of a received radio wave from a radio transmitter installed outside the vehicle or orientation information based on a phase difference.
A method is known in which a combination of received radio waves from two or more radio transmitters is acquired in advance, a position of a mobile object on which a radio receiver is mounted is measured on the basis of the combination, and whether or not there is influence of a shielding object on the received radio waves is determined on the basis of a change in reception strength (see PTL 1).
However, not only signal intensity of a radio wave transmitted from a radio receiver decreases due to a shielding object on a communication path, but also a traveling direction of the radio wave changes by diffraction. As illustrated in
It is therefore an object of the present invention to provide a vehicle control device which has enhanced robustness against a shielding object, further, which does not measure a received radio wave from a radio transmitter in advance, and which can, for example, continue automatic driving control by comparing two types of vehicle positions calculated using the radio transmitter installed outside a vehicle and a sensor mounted on the vehicle and detecting an error in order to reduce a detection error of the radio transmitter due to a failure in communication of the radio transmitter.
In order to achieve the above object, the present invention includes: a radio position estimation unit which receives a radio wave from a radio transmitter installed at an arbitrary position outside a vehicle and calculates relative positions of the vehicle and the radio transmitter; an own vehicle position estimation unit which calculates a position of the vehicle on the basis of information acquired by a sensor mounted on the vehicle; and a vehicle sensor error determination unit which determines that the received radio wave is affected by a shielding object on the basis of comparison between a first own vehicle position acquired by the radio position estimation unit and a second own vehicle position acquired by the own vehicle position estimation unit.
According to the present invention, when a failure such as a slip or a step with respect to a sensor mounted on a vehicle and a shielding object or radio wave interference with respect to a radio transmitter occurs, by determining that a detection error has occurred and determining a sensor to be used, it is possible to enhance robustness against the failure in own vehicle position estimation using the radio transmitter. In addition, the above effect can be obtained by using a sensor provided as standard in the vehicle without incorporating an external recognition sensor such as a camera and a sonar in the configuration.
Problems, configurations, and effects other than those described above will be clarified by the following description of embodiments, and the like.
In the following embodiments, description will be divided into a plurality of sections or embodiments when necessary for the sake of convenience, but unless otherwise specified, the sections or embodiments are not unrelated to each other, and one is in a relationship of some or all modifications, details, supplementary explanation, and the like, of the other.
Hereinafter, embodiments of the present invention will be described in detail with reference to
First, a first embodiment of the present invention will be described in detail with reference to
First, a configuration of a vehicle 100 equipped with a vehicle control electronic control unit (ECU) 9 as a vehicle control device according to the first embodiment of the present invention will be described with reference to
The vehicle 100 mainly includes a right front wheel speed sensor 3FR that detects wheel speed of a right front wheel 2FR, a right rear wheel speed sensor 3RR that detects wheel speed of a right rear wheel 2RR, a left rear wheel speed sensor 3RL that detects wheel speed of a left rear wheel 2RL, a left front wheel speed sensor 3FL that detects wheel speed of a left front wheel 2FL, an electric power steering device 4 that changes a direction of each wheel 2 (2FR, 2RR, 2RL, 2FL) according to a steering angle of a steering wheel 11 provided in a driving room of the vehicle 100, a radio receiver 5 that acquires distance and orientation information of a radio transmitter 6 on the basis of a radio wave transmitted from the radio transmitter 6 installed at an arbitrary position outside the vehicle 100, an acceleration sensor 7, a global positioning system (GPS) 8, the vehicle control ECU 9, an actuator ECU 10, and the like. The distance information acquired by the radio receiver 5 can be acquired, for example, from reception strength (received signal strength indicator (RSSI)) using attenuation characteristics according to a propagation distance. Further, for example, the radio receiver 5 includes two or more antennas 12 (
Next, an internal configuration of the vehicle control ECU 9 will be described with reference to
Specifically, as illustrated in
The radio position estimation unit 301 calculates a first own vehicle position, first speed, and a first traveling direction of the own vehicle 100 with a position of the radio transmitter 6 as an origin from distance and/or orientation information of the radio transmitter 6 acquired by the radio receiver 5. The radio position estimation unit 301 transmits the calculated first own vehicle position, first speed, and first traveling direction to the own vehicle position estimation unit 302 and the vehicle sensor error determination unit 303.
The own vehicle position estimation unit 302 acquires the wheel speed of each wheel 2 from the wheel speed sensor 3, acquires a steering angle of the steering wheel 11 from the steering angle sensor of the electric power steering device 4, acquires a yaw rate generated in the own vehicle 100 from the acceleration sensor 7, acquires a first own vehicle position from the radio position estimation unit 301 and calculates a second own vehicle position, second speed, and a second traveling direction of the own vehicle 100. The own vehicle position estimation unit 302 transmits the calculated second own vehicle position, second speed, and second traveling direction to the vehicle sensor error determination unit 303.
The vehicle sensor error determination unit 303 compares the first own vehicle position, the first speed, and the first traveling direction of the own vehicle 100 calculated by the radio position estimation unit 301 with the second own vehicle position, the second speed, and the second traveling direction of the own vehicle 100 calculated by the own vehicle position estimation unit 302, determines which of the wheel speed sensor 3 and/or the radio receiver 5 is affected by the error and determines the own vehicle position of the own vehicle 100 from the first own vehicle position and the second own vehicle position according to the determination result. The vehicle sensor error determination unit 303 transmits the own vehicle position, speed, and traveling direction of the own vehicle 100 to the vehicle control unit 304.
The vehicle control unit 304 calculates command values of various actuators so that the own vehicle 100 travels (autonomously travels) along a predetermined route on the basis of the own vehicle position, the speed, and the traveling direction of the own vehicle 100 calculated by the vehicle sensor error determination unit 303. The vehicle control unit 304 transmits the calculated command values of the various actuators to the actuator ECU 10.
In the actuator ECU 10, the own vehicle 100 can travel (autonomously travel) along the predetermined route by controlling the actuators on the basis of the command values of the various actuators calculated by the vehicle control unit 304.
Next, outline of the entire vehicle control by the vehicle control ECU 9 will be described using the flow of
Application of the present embodiment is not limited, and for example, in area-limited low-speed automatic driving, the radio transmitter 6 that can be identified with an ID is installed in an area, communication between the radio receiver 5 provided in the own vehicle 100 and the radio transmitter 6 is started, and the own vehicle 100 is guided along the predetermined route on the basis of the radio transmitter 6. In a situation where a communication path between the radio receiver 5 and the radio transmitter 6 is shielded by another vehicle or a pillar (shielding object), which is a situation that radio position estimation is not good at, or in a situation where an error is added to the wheel speed sensor 3 due to a road surface state such as a step or low friction, which is a situation that own vehicle position estimation is not good at, when the own vehicle 100 is guided, it is possible to identify a detection error by comparing information acquired by the radio receiver 5 mounted on the vehicle 100 with information acquired by the wheel speed sensor 3 and/or the electric power steering device 4.
Next, details of the radio position estimation S401 of
In S501, the distance and orientation information of the radio transmitter 6 based on reception strength and a phase difference acquired by the radio receiver 5 is acquired. Note that, in a case where the distance and orientation information cannot be acquired, processing for addressing a case where the radio transmitter 6 cannot be detected, such as not executing the processing in S502 and subsequent processing, may be performed.
In S502, the first own vehicle position (Xt, Yt) of the own vehicle 100 with the position of the radio transmitter 6 as the origin is calculated from the distance and orientation information of the radio transmitter 6. Note that a method for detecting the first own vehicle position (Xt, Yt) is not limited thereto. For example, two or more radio receivers 5 may be provided at predetermined positions, and the first own vehicle position may be calculated by triangulation on the basis of the orientation information acquired by the radio receivers 5.
In S503, a first yaw angle Yawt of the own vehicle 100 is calculated from the moving direction of the first own vehicle position (Xt, Yt). Note that a method for detecting the first yaw angle Yawt is not limited thereto. For example, two identifiable radio transmitters 6 may be provided in a predetermined direction, and the first yaw angle may be calculated from relative positions of the radio receiver 5 and the two radio transmitters 6.
In S504, first speed (vehicle speed) Vt of the own vehicle 100 is calculated from a temporal change amount of a moving distance of the first own vehicle position (Xt, Yt).
Next, details of the own vehicle position estimation S402 in
In S601, the first own vehicle position (Xt, Yt) and the first yaw angle Yawt in
In S602, the wheel speed of each wheel 2 is acquired from the wheel speed sensor 3, the steering angle of the steering wheel 11 is acquired from the steering angle sensor of the electric power steering device 4, and a yaw rate generated in the own vehicle 100 is acquired from the acceleration sensor 7.
In S603, second speed (vehicle speed) Vd of the own vehicle 100 is calculated from the wheel speed.
In S604, a second yaw angle Yawd of the own vehicle 100 is calculated from the steering angle and/or the yaw rate. In the present embodiment, the second yaw angle Yawd is a sum of products of the steering angles based on the steering angle sensor, the gyro sensor, or the acceleration sensor 7, and (the wheel speed of) the wheel speed sensor 3 that is greatly affected by the slip and/or the step is not used.
In S605, the moving distance is calculated from the wheel speed, and the second own vehicle position (Xd, Yd) of the own vehicle 100 is calculated from the initial position acquired in S601 and the second yaw angle acquired in S604.
Next, details of the error state determination S403 in
In S701, in order to determine whether an error is included in at least one of the wheel speed sensor 3 or the radio receiver 5, it is determined whether at least one of the deviations |Xt−Xd| or |Yt−Yd| of the respective element components of the first own vehicle position (Xt, Yt) and the second own vehicle position (Xd, Yd) exceeds a predetermined threshold. Here, if the deviation of the own vehicle position is equal to or less than the predetermined threshold, it is determined that the error is not included in the wheel speed sensor 3 and the radio receiver 5, and S703 is executed, and if the deviation of the own vehicle position exceeds the predetermined threshold, it is determined that the error is included in at least one of the wheel speed sensor 3 or the radio receiver 5, and S702 is executed. Further, in a case where the radio transmitter 6 is lost due to a failure, S705 may be unconditionally executed. In order to prevent erroneous determination, the determination in S701 may be made by continuously satisfying the condition for a predetermined determination period or a predetermined determination distance.
In S702, in order to determine which of the wheel speed sensor 3 and the radio receiver 5 includes an error, it is determined whether at least one of temporal changes Δ|Xt−Xd| or Δ|Yt−Yd| of the deviation of the respective element components of the first own vehicle position (Xt, Yt) and the second own vehicle position (Xd, Yd) exceeds a predetermined threshold. Here, if the temporal change of the deviation of the own vehicle position is equal to or less than the predetermined threshold, it is determined that the temporal change is temporary influence due to a step, a slip, or the like, and S704 is executed. If the temporal change of the deviation of the own vehicle position exceeds the predetermined threshold, it is determined that the temporal change is influence due to the own vehicle 100 entering a shadow of a shielding object as viewed from the radio transmitter 6, and S705 is executed. In order to prevent erroneous determination, the determination in S702 may be made by continuously satisfying the condition for a predetermined determination period or a predetermined determination distance.
In S703, an error state ERRSTS is set to 0 indicating that there is no error.
In S704, the error state ERRSTS is set to 1 indicating that there is an error in the wheel speed sensor 3 (in other words, the second own vehicle position).
In S705, the error state ERRSTS is set to 2 indicating that there is an error in the radio receiver 5 (in other words, the first own vehicle position).
In the position information selection S404 in
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
The radio receiver 5 not yet enters the shadow 1103 before time t1, and thus, the position deviations |Xt−Xd| and |Yt−Yd| are equal to or less than the predetermined threshold, the error state ERRSTS is 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t1 and time t2, the radio receiver 5 enters the shadow 1103, so that the position deviations |Xt−Xd| and |Yt−Yd| increase as the own vehicle 100 moves to the dark side of the shadow 1103, and a Y position deviation temporal change amount Δ|Yt−Yd| exceeds a predetermined threshold 4 at the timing when the position deviation |Yt−Yd| exceeds a predetermined threshold 2, so that the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
The radio receiver 5 has lost the radio transmitter 6 between time t2 and time t3, and thus, the error state ERRSTS is maintained at 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
After time t3, the position deviations |Xt−Xd| and |Yt−Yd| decrease as the radio receiver 5 moves to a lighter side of the shadow 1103, the error state ERRSTS becomes 0 at a timing when the position deviation |Yt−Yd| becomes equal to or less than the predetermined threshold 2, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
The right front wheel 2FR not yet gets on the muddy place 1303 before time t2, and thus, the position deviations |Xt−Xd| and |Yt−Yd| are equal to or less than the predetermined threshold, the error state ERRSTS is 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t2 and time t3, the right front wheel 2FR slips due to the muddy place 1303, so that the position deviations |Xt−Xd| and |Yt−Yd| temporarily increase. At the timing when the position deviation |Xt−Xd| exceeds a predetermined threshold 1, an X position deviation temporal change amount Δ|Xt−Xd| and the Y position deviation temporal change amount Δ|Yt−Yd| are equal to or less than the predetermined threshold. Thus, the error state ERRSTS becomes 1, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
After time t3, by resetting the second own vehicle position to the first own vehicle position in S601 (
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
Before time t1, the radio receivers 5a and 5b not yet enter the shadow 1503, and thus, the position deviations |Xt−Xd| and |Yt−Yd| are equal to or less than the predetermined threshold, the error state ERRSTS becomes 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t1 and time t2, the radio receiver 5a enters the shadow 1503, so that the position deviations |Xt−Xd| and |Yt−Yd| increase as the own vehicle 100 moves to a darker side of the shadow 1503, and at the timing when the position deviation |Yt−Yd| exceeds the predetermined threshold 2, the X position deviation temporal change amount Δ|Xt−Xd| exceeds the predetermined threshold 3, and/or the Y position deviation temporal change amount Δ|Yt−Yd| exceeds the predetermined threshold 4, so that the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
Between time t2 and time t3, the radio receiver 5a has lost the radio transmitter 6, and thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation. While the radio receiver 5a is in a recognition failure, the own vehicle position of the own vehicle 100 may be calculated on the basis of the distance information and the orientation information of the radio transmitter 6 acquired by the other radio receiver 5b.
Between time t3 and time t4, the radio receiver 5a detects the radio transmitter 6, and thus, the X position deviation |Xt−Xd| increases as the radio receivers 5a and 5b move in the shadow 1503, the Y position deviation |Yt−Yd| remains at a constant value, the Y position deviation |Yt−Yd| exceeds the predetermined threshold 2, and the X position deviation temporal change amount Δ|Xt−Xd| exceeds the predetermined threshold 3. Thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
Between time t4 and time t5, the radio receiver 5b has lost the radio transmitter 6, and thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation. While the radio receiver 5b is in a recognition failure, the own vehicle position of the own vehicle 100 may be calculated on the basis of the distance information and the orientation information of the radio transmitter 6 acquired by the other radio receiver 5a.
The radio receiver 5b detects the radio transmitter 6 after time t5, and thus, as the radio receivers 5a and 5b move in the direction of exiting the shadow 1503, the position deviations |Xt−Xd| and |Yt−Yd| decrease, the error state ERRSTS becomes 0 at the timing when the X position deviation |Xt−Xd| is equal to or less than the predetermined threshold 1, and the Y position deviation |Yt−Yd| is equal to or less than the predetermined threshold 2, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
According to the above configuration, it is possible to detect the error of the radio receiver 5 by diagnosing the influence of the shielding object of the radio receiver 5 on the basis of the temporal change of the own vehicle position deviation between the first own vehicle position and the second own vehicle position and to reduce the influence of the detection error of the radio receiver 5 that receives the radio wave from the radio transmitter 6 installed at an arbitrary position outside the vehicle 100.
As described above, the vehicle control ECU 9 as the vehicle control device according to the first embodiment includes the radio position estimation unit 301 that receives a radio wave from the radio transmitter 6 installed at an arbitrary position outside the vehicle and calculates relative positions of the vehicle and the radio transmitter 6, the own vehicle position estimation unit 302 that calculates the position of the vehicle on the basis of information acquired by the sensor mounted on the vehicle, and the vehicle sensor error determination unit 303 that determines that the received radio wave is affected by a shielding object on the basis of comparison between the first own vehicle position acquired by the radio position estimation unit 301 and the second own vehicle position acquired by the own vehicle position estimation unit 302.
In addition, the vehicle sensor error determination unit 303 determines that an error is included in the first own vehicle position or the second own vehicle position on the basis of a temporal change of a deviation between the first own vehicle position and the second own vehicle position.
Further, the vehicle sensor error determination unit 303 determines the position of the vehicle from the first own vehicle position and the second own vehicle position on the basis of the result of the determination of the error.
In addition, the radio position estimation unit 301 calculates the relative positions of the vehicle and the radio transmitter 6 from at least one of distance information or orientation information acquired by at least one radio receiver 5 mounted on the vehicle.
In other words, the vehicle sensor error determination unit 303 compares two types of vehicle positions calculated using the sensor mounted on the vehicle and the radio transmitter 6 and determines that the radio transmitter 6 is affected by the shielding object in a case where a temporal change of the vehicle position deviation is detected.
According to the first embodiment, when a failure such as a slip or a step with respect to a sensor mounted on a vehicle or a shielding object or radio wave interference with respect to the radio transmitter 6 occurs, by determining that a detection error has occurred and determining a sensor to be used, it is possible to enhance robustness against the failure in own vehicle position estimation using the radio transmitter 6. In addition, the above effect can be obtained by using a sensor provided as standard in the vehicle without incorporating an external recognition sensor such as a camera and a sonar in the configuration.
A second embodiment is a modification of processing outline of the error state determination S403 illustrated in
First, details of the error state determination S403 different from that of the first embodiment will be described with reference to
In S801, in order to determine whether an error is included in at least one of the wheel speed sensor 3 or the radio receiver 5, it is determined whether at least one of the deviation |Xt−Xd| or |Yt−Yd| of the respective element components of the first own vehicle position (Xt, Yt) and the second own vehicle position (Xd, Yd) exceeds a predetermined threshold. Here, if the deviation of the own vehicle position is equal to or less than the predetermined threshold, it is determined that the error is not included in the wheel speed sensor 3 and the radio receiver 5, and S804 is executed, and if the deviation of the own vehicle position exceeds the predetermined threshold, it is determined that the error is included in at least one of the wheel speed sensor 3 or the radio receiver 5, and S802 is executed. Further, in a case where the radio transmitter 6 is lost due to a failure and the first own vehicle position cannot be acquired, S806 is unconditionally executed. Note that in order to prevent erroneous determination, the determination in S801 may be made by satisfying the condition continuously for a predetermined determination period or a predetermined determination distance.
In S802, in order to determine whether an error is included in the radio receiver 5, it is determined whether a deviation |Yawt−Yawd| between the first yaw angle Yawt and the second yaw angle Yawd exceeds a predetermined threshold. Here, if the yaw angle deviation |Yawt−Yawd| is equal to or less than the predetermined threshold, it is determined that there is a possibility that the error is not included in the radio receiver 5, and S803 is executed. If the yaw angle deviation |Yawt−Yawd| exceeds the predetermined threshold, it is determined that there is influence due to the radio receiver 5 entering the shadow of the shielding object as viewed from the radio transmitter 6, and S806 is executed. In order to prevent erroneous determination, the determination in S802 may be made by continuously satisfying the condition for a predetermined determination period or a predetermined determination distance.
In S803, in order to further determine whether an error is included in the radio receiver 5, it is determined whether the deviation |Vt−Vd| between the first speed (vehicle speed) Vt and the second speed (vehicle speed) Vd exceeds a predetermined threshold. Here, if the vehicle speed deviation |Vt−Vd| is equal to or less than the predetermined threshold, it is determined that there is a possibility that the error is not included in the radio receiver 5, and S805 is executed. If the vehicle speed deviation |Vt−Vd| exceeds the predetermined threshold, it is determined that there is influence due to the radio receiver 5 entering the shadow of the shielding object as viewed from the radio transmitter 6, and S806 is executed. In to order prevent erroneous determination, the determination in S803 may be made by continuously satisfying the condition for a predetermined determination period or a predetermined determination distance.
In S804, the error state ERRSTS is set to 0 indicating that there is no error.
In S805, the error state ERRSTS is set to 1 indicating that there is an error in the wheel speed sensor 3 (in other words, the second own vehicle position).
In S806, the error state ERRSTS is set to 2 indicating that there is an error in the radio receiver 5 (in other words, the first own vehicle position).
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
The radio receiver 5 not yet enters the shadow 1103 of the shielding object before time t1, and thus, the X position deviation |Xt−Xd| is equal to or less than the predetermined threshold, and the Y position deviation |Yt−Yd| is equal to or less than the predetermined threshold, the error state ERRSTS becomes 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t1 and time t2, the radio receiver 5 enters the shadow 1103 of the shielding object, so that the position deviations |Xt−Xd| and |Yt−Yd|, the yaw angle deviation |Yawt−Yawd| and the speed deviation |Vt−Vd| increase as the own vehicle 100 moves to the darker side of the shadow 1103, and the error state ERRSTS becomes 2 at the timing when the position deviation |Xt−Xd| and/or |Yt−Yd| exceeds the predetermined threshold, and the yaw angle deviation |Yawt−Yawd| and/or the speed deviation |Vt−Vd| exceeds the predetermined threshold, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
The radio receiver 5 has lost the radio transmitter 6 between time t2 and time t3, and thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
After time t3, as the radio receiver 5 moves to the lighter side of the shadow 1103, the position deviations |Xt−Xd| and |Yt−Yd|, the yaw angle deviation |Yawt−Yawd|, and the speed deviation |Vt−Vd| decrease, and the error state ERRSTS becomes 0 at the timing when the position deviations |Xt−Xd| and |Yt−Yd| are each equal to or less than the predetermined threshold, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
Before time t2, the wheel 2 rotates according to a traveling distance before getting on the muddy place 1303, so that the X position deviation |Xt−Xd| is equal to or less than the predetermined threshold, and the Y position deviation |Yt−Yd| is equal to or less than the predetermined threshold. Thus, the error state ERRSTS becomes 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t2 and time t3, the right front wheel 2FR slips due to the muddy place 1303, so that the position deviations |Xt−Xd| and |Yt−Yd| and the speed deviation |Vt−Vd| temporarily increase. At the timing when the position deviation |Xt−Xd| and/or |Yt−Yd| exceeds the predetermined threshold, the yaw angle deviation |Yawt−Yawd| is equal to or less than the predetermined threshold, and the speed deviation |Vt−Vd| is equal to or less than the predetermined threshold. Thus, the error state ERRSTS becomes 1, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
After time t3, by resetting the second own vehicle position to the first own vehicle position in S601 (
Next, an example of processing from the radio position estimation S401 to the position information selection S404 in the scene of
Before time t1, the radio receivers 5a and 5b not yet enter the shadow 1503, and thus, the position deviations |Xt−Xd| and |Yt−Yd| are equal to or less than the predetermined threshold, the error state ERRSTS becomes 0, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
Between time t1 and time t2, the radio receiver 5a enters the shadow 1503, so that the position deviations |Xt−Xd| and |Yt−Yd| increase as the own vehicle 100 moves to the dark side of the shadow 1503, and at the timing when the position deviation |Yt−Yd| exceeds the predetermined threshold 2, the yaw angle deviation |Yawt−Yawd| exceeds the predetermined threshold, and/or the speed deviation |Vt−Vd| exceeds the predetermined threshold, so that the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
Between time t2 and time t3, the radio receiver 5a has lost the radio transmitter 6, and thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation. While the radio receiver 5a is in a recognition failure, the own vehicle position of the own vehicle 100 may be calculated on the basis of the distance information and the orientation information of the radio transmitter 6 acquired by the other radio receiver 5b.
Between time t3 and time t4, the radio receiver 5a detects the radio transmitter 6, and thus, as the radio receivers 5a and 5b move in the shadow 1503, the X position deviation |Xt−Xd| increases, the Y position deviation |Yt−Yd| remains at a constant value, and the vehicle speed deviation |Vt−Vd| exceeds a predetermined threshold. Thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation.
Between time t4 and time t5, the radio receiver 5b has lost the radio transmitter 6, and thus, the error state ERRSTS becomes 2, and the own vehicle position of the own vehicle 100 is calculated by the own vehicle position estimation. While the radio receiver 5b is in a recognition failure, the own vehicle position of the own vehicle 100 may be calculated on the basis of the distance information and the orientation information of the radio transmitter 6 acquired by the other radio receiver 5a.
The radio receiver 5b detects the radio transmitter 6 after time t5, and thus, as the radio receivers 5a and 5b move in the direction of exiting the shadow 1503, the position deviations |Xt−Xd| and |Yt−Yd| decrease, the error state ERRSTS becomes 0 at the timing when the X position deviation |Xt−Xd| is equal to or less than the predetermined threshold 1, and the Y position deviation |Yt−Yd| is equal to or less than the predetermined threshold 2, and the own vehicle position of the own vehicle 100 is calculated by the radio position estimation.
According to the above configuration, it is possible to detect the error of the radio receiver 5 by diagnosing the influence of the shielding object of the radio receiver 5 on the basis of the behavior change of the apparent position of the radio transmitter 6 by the radio position estimation and to reduce the influence of the detection error of the radio receiver 5 that receives the radio wave from the radio transmitter 6 installed at an arbitrary position outside the vehicle 100.
As described above, in the vehicle control ECU 9 as the vehicle control device according to the second embodiment, the vehicle sensor error determination unit 303 further determines that the received radio wave is affected by a shielding object in a case where a change in behavior of the first own vehicle position generated by shielding of the received radio wave is detected.
The change in the behavior includes at least one of behavior of losing the first own vehicle position (radio transmitter 6), behavior in which a traveling direction (first yaw angle Yawt) of the vehicle based on the first own vehicle position is different, by greater than a predetermined threshold, from a traveling direction (second yaw angle Yawd) of the vehicle based on the information acquired by the sensor (based on the second own vehicle position), and behavior in which vehicle speed (first speed Vt) of the vehicle based on the first own vehicle position is different, by greater than a predetermined threshold, from vehicle speed (second speed Vd) of the vehicle based on the information acquired by the sensor (based on the second own vehicle position).
In other words, the vehicle sensor error determination unit 303 compares two types of vehicle positions calculated using the sensor mounted on the vehicle and the radio transmitter 6 and determines that the radio transmitter 6 is affected by the shielding object when a behavior change of the vehicle position (first own vehicle position) based on the radio transmitter 6 is detected.
According to the second embodiment, when a failure such as a slip or a step with respect to a sensor mounted on a vehicle or a shielding object or radio wave interference with respect to the radio transmitter 6 occurs, by determining that a detection error has occurred and determining a sensor to be used, it is possible to enhance robustness against the failure in the own vehicle position estimation using the radio transmitter 6. In addition, the above effect can be obtained by using a sensor provided as standard in the vehicle without incorporating an external recognition sensor such as a camera and a sonar in the configuration.
A third embodiment is a modification of part of the processing outline of the error state determination S403 illustrated in
First, processing in S901 of the error state determination S403 different from that in the second embodiment will be described with reference to
In S901, in order to further determine whether an error is included in the radio receiver 5, it is determined whether a deviation between the first own vehicle position and a GPS own vehicle position (hereinafter, also referred to as GPS coordinates) exceeds a predetermined threshold. The GPS coordinates are absolute coordinates of the vehicle acquired from an artificial satellite, and refer to an own vehicle position of the own vehicle 100 calculated on the basis of a change amount of the own vehicle position of the own vehicle 100 acquired from the GPS 8 while setting a first own vehicle position acquired first as an initial position. Here, if the deviation between the first own vehicle position and the GPS coordinates is equal to or less than a predetermined threshold, it is determined that the error is not included in the radio receiver 5, and S805 is executed. If the deviation between the first own vehicle position and the GPS coordinates exceeds the predetermined threshold, it is determined that there is influence due to the radio receiver 5 entering the shadow of the shielding object as viewed from the radio transmitter 6, and S806 is executed. In order to prevent erroneous determination, the determination in S901 may be made by continuously satisfying the condition for predetermined determination period or a predetermined determination distance.
According to the above configuration, it is possible to accurately detect the error of the radio receiver 5 by further diagnosing the influence of the shielding object of the radio receiver 5 on the basis of the own vehicle position (GPS coordinates) acquired from the GPS 8 and to reduce the influence of the detection error of the radio receiver 5 that receives the radio wave from the radio transmitter 6 installed at an arbitrary position outside the vehicle 100.
As described above, in the vehicle control ECU 9 as the vehicle control device according to the third embodiment, in a case where the deviation between the absolute coordinates (GPS coordinates) of the vehicle acquired from the artificial satellite and the first own vehicle position is greater than a predetermined threshold, the vehicle sensor error determination unit 303 determines that the received radio wave is affected by the shielding object.
According to the third embodiment, similarly to the first and second embodiments described above, when a failure such as a slip or a step with respect to a sensor mounted on a vehicle or a shielding object or radio wave interference with respect to the radio transmitter 6 occurs, by determining that a detection error has occurred and determining a sensor to be used, it is possible to enhance robustness against the failure in own vehicle position estimation using the radio transmitter 6. In addition, the above effect can be obtained by using a sensor provided as standard in the vehicle without incorporating an external recognition sensor such as a camera and a sonar in the configuration.
The present invention is not limited to the above-described embodiments and includes various modifications. For example, the above-described embodiments have been described in detail for easy understanding of the present invention, and the present invention is not necessarily limited to those having all the described configurations.
In addition, part or all of each of the above-described components, functions, processing units, processing means, and the like, may be implemented by hardware, for example, by designing with an integrated circuit or may be implemented by software, by a processor interpreting and executing a program for implementing each function.
Information such as a program, a table, and a file for implementing each function can be stored in a storage device such as a memory, a hard disk, and a solid state drive (SSD), or a recording medium such as an IC card, an SD card, and a DVD.
In addition, control lines and information lines indicate what is considered to be necessary for the description, and not all the control lines and information lines necessary for implementation are necessarily indicated. In practice, it may be considered that almost all the components are connected to each other.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2021-107413 | Jun 2021 | JP | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/JP2022/009967 | 3/8/2022 | WO |