Estimating apparatus
An odometry acquiring unit acquires odometry information including a yaw rate applied to a vehicle and a steering angle of the vehicle. An estimate calculating unit calculates an estimate of a turning radius based on the steering angle and the yaw rate acquired by the odometry acquiring unit. A change rate calculating unit calculates a yaw change rate representing a degree of change in the yaw rate acquired by the odometry acquiring unit. A contribution adjusting unit makes an adjustment of decreasing a contribution of the yaw rate and increasing a contribution of the steering angle, to calculation of an estimate performed by the estimate calculating unit, as the yaw change rate increases.
1. An estimating apparatus mounted on a vehicle to estimate a turning radius of the vehicle based on a steering angle and a yaw rate of the vehicle, the estimating apparatus comprising:
a processor;
a non-transitory computer-readable storage medium; and
a set of computer-executable instructions stored on the non-transitory computer-readable storage medium that cause the processor to:
acquire odometry information including the yaw rate of the vehicle and the steering angle of the vehicle;
calculate an estimated turning radius of the vehicle based on a contribution of the steering angle and a contribution of the yaw rate;
calculate a yaw change rate representing a degree of change in the yaw rate;
determine a positional relationship between an object and the vehicle based on the estimated turning radius of the vehicle; and
output an alarm that indicates a presence of the object for a state in which the positional relationship between the object and the vehicle satisfies a predetermined condition, wherein
the contribution of the yaw rate decreases and the contribution of the steering angle increases as the yaw change rate increases.
2. The estimating apparatus according to claim 1 , wherein the set of computer-executable instructions further cause the processor to:
set the contribution of the yaw rate to 100% in response to the yaw change rate being lower than a preset threshold.
3. The estimating apparatus according to claim 1 , wherein
the odometry information acquired includes a vehicle speed that is a speed of the vehicle; and
decrease the contribution of the yaw rate decreases and the contribution of the steering angle decreases as the vehicle speed decreases.
4. The estimating apparatus according to claim 1 , wherein
the contribution of the steering angle decreases as the steering angle increases.
5. The estimating apparatus according to claim 1 , wherein the set of computer-executable instructions further cause the processor to:
calculate the estimated turning radius based on a weighted summation of a yaw radius and a steering angle radius, the yaw radius being a turning radius calculated from the yaw rate, the steering angle radius being a turning radius calculated from the steering angle; and
adjust the contribution of the yaw rate by increasing or decreasing a weight of the weighted summation.
6. The estimating apparatus according to claim 1 , wherein the set of computer-executable instructions further cause the processor to:
calculate a travel trajectory of the vehicle based on the estimated turning radius.
7. The estimating apparatus according to claim 6 , wherein
the travel trajectory is utilized by at least one of a lane departure alarm system, a lane keeping system and an automatic driving control system.
8. The estimating apparatus according to claim 1 , wherein
the estimated turning radius is utilized by at least one of a lane departure alarm system, a lane keeping system and an automatic driving control system.
9. The estimating apparatus according to claim 1 , wherein the predetermined condition is satisfied based on comparing at least one of:
(i) a relative distance between the vehicle and the object to a predetermined distance threshold; and
(ii) a rate of change of the relative distance between the vehicle and the object to a predetermined rate of change threshold.
10. A computer-implemented method for calculating an estimated turning radius of a vehicle based on a steering angle and a yaw rate of the vehicle, in which the estimated turning radius is used to calculate a travel trajectory of the vehicle, the method comprising:
acquiring odometry information of the vehicle including the yaw rate and the steering angle of the vehicle;
calculating an estimated turning radius of the vehicle based on a contribution of the steering angle and a contribution of the yaw rate;
calculating a yaw change rate representing a degree of change in the yaw rate;
determining a positional relationship between an object and the vehicle based on the estimated turning radius of the vehicle; and
outputting an alarm that indicates a presence of the object for a state in which the positional relationship between the object and the vehicle satisfies a predetermined condition, wherein
the contribution of the yaw rate decreases and the contribution of the steering angle increases as the yaw change rate increases.
11. The computer-implemented method according to claim 10 , further comprising:
calculating a travel trajectory of the vehicle based on the estimated turning radius.
12. The computer-implemented method according to claim 11 , wherein
the travel trajectory is utilized by at least one of a lane departure alarm system, a lane keeping system and an automatic driving control system.
13. The computer-implemented method according to claim 10 , wherein
the estimated turning radius is utilized at least one of a lane departure alarm system, a lane keeping system and an automatic driving control system.
14. The computer-implemented method according to claim 10 , wherein the predetermined condition is satisfied based on comparing at least one of:
(i) a relative distance between the vehicle and the object to a predetermined distance threshold; and
(ii) a rate of change of the relative distance between the vehicle and the object to a predetermined rate of change threshold.