Movement distance estimation device
The travel distance estimating device uses a prediction function based on tire rotation speed to accurately calculate vehicle distance, addressing inaccuracies from tire diameter changes and enhancing autonomous navigation precision.
Patent Information
- Application Number
- JP2023079428
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-12
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2043-05-12
AI Technical Summary
Existing methods for estimating vehicle travel distance in autonomous navigation are inaccurate due to changes in tire outer diameter caused by factors like temperature and air pressure, leading to errors in self-position estimation.
A travel distance estimating device that calculates a reference distance based on tire rotation speed using a prediction function generated from multiple points, approximated by a logistic equation, to determine the travel distance accurately, eliminating the need for a correction table.
The device estimates vehicle travel distance with high accuracy, reducing errors in self-position estimation by dynamically adjusting to changes in tire outer diameter, thus improving the precision of autonomous navigation.
Smart Images

Figure 2024163640000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a travel distance estimation device. [Background technology]
[0002] For example, Patent Document 1 describes a technology in which a correction table is stored that describes the amount of correction for the rotational speed for each directional displacement and rotational speed of the vehicle, the rotational speed of the wheels and the rotational angle around the yaw axis of the vehicle body are calculated, a correction amount specified by both the rotational speed and the rotational angle is extracted from the correction table, the correction amount is added to the rotational speed, and the corrected rotational speed is transmitted together with the rotational angle. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2006-118994 A Summary of the Invention [Problem to be solved by the invention]
[0004] When estimating the travel distance of a vehicle in autonomous navigation, the travel distance is calculated based on, for example, the number of tire rotations and the vehicle's reference distance (the vehicle's travel distance per tire rotation). However, the outside diameter of the tire changes due to the outside air temperature, vehicle speed, physical individual differences of the tire (e.g., air pressure), etc. When the outside diameter of the tire changes, the reference distance also fluctuates. For this reason, if a single correction table is used for the reference distance as in the above embodiment, an error in the reference distance leads to a decrease in the estimation accuracy of the travel distance. In autonomous driving of a vehicle, a decrease in the estimation accuracy of the travel distance leads to a decrease in the estimation accuracy of the vehicle's own position.
[0005] An object of the present invention is to provide a travel distance estimation device that can estimate the travel distance of a vehicle with high accuracy regardless of changes in the outer diameter of the tires. [Means for solving the problem]
[0006] One aspect of the present invention is a travel distance estimation device that estimates a vehicle's travel distance using a reference distance traveled by the vehicle per tire rotation, and includes a rotation detection unit that detects the number of tire rotations and the rotation speed, a position information acquisition unit that acquires vehicle position information, a reference distance calculation unit that calculates reference distances corresponding to the tire rotation speed at multiple points based on the tire rotation speed detected by the rotation detection unit and the vehicle position information detected by the position information acquisition unit, a prediction function generation unit that generates a prediction function representing the relationship between the tire rotation speed and the reference distance based on the tire rotation speed and the reference distance at the multiple points, a reference distance determination unit that determines a reference distance corresponding to the tire rotation speed detected by the rotation detection unit using the prediction function generated by the prediction function generation unit, and a travel distance calculation unit that calculates the vehicle's travel distance based on the tire rotation speed detected by the rotation detection unit and the reference distance determined by the reference distance determination unit.
[0007] In such a travel distance estimation device, a reference distance corresponding to the tire rotation speed is calculated at multiple points based on the tire rotation speed and the vehicle position information, and a prediction function expressing the relationship between the tire rotation speed and the reference distance is generated based on the tire rotation speed and the reference distance at the multiple points. Then, a reference distance corresponding to the tire rotation speed is determined using the prediction function. Then, a travel distance of the vehicle is calculated based on the tire rotation speed and the reference distance. The reference distance changes depending on the outer diameter of the tire. Even if such a change in the outer diameter of the tire occurs, a prediction function expressing the relationship between the tire rotation speed and the reference distance corresponding to the outer diameter of the tire is generated again, and the reference distance corresponding to the tire rotation speed is determined using the new prediction function. As a result, the travel distance of the vehicle is estimated with high accuracy regardless of the change in the outer diameter of the tire. In addition, by determining the reference distance corresponding to the tire rotation speed using the prediction function, a correction table expressing the relationship between the tire rotation speed and the reference distance is not required, so that the burden of creating the correction table is reduced.
[0008] The prediction function may be a function that is approximated by a solution curve of a logistic equation that changes so as to asymptotically approach the lower and upper limits of the reference distance. In this configuration, by generating a prediction function that is approximated by a solution curve of the logistic equation, an appropriate reference distance according to the tire rotation speed can be obtained.
[0009] The travel distance estimation device may further include a temperature detection unit that detects an outside air temperature, and the reference distance calculation unit and the prediction function generation unit may be executed when the outside air temperature detected by the temperature detection unit has changed by a predetermined amount or more since the previous generation of the prediction function. In this configuration, when the outside air temperature has changed by a predetermined amount or more since the previous generation of the prediction function, the calculation process of the reference distance corresponding to the tire rotation speed and the generation process of the prediction function are automatically executed.
[0010] The travel distance estimation device may further include an air pressure detection unit that detects the air pressure of the tires, and the reference distance calculation unit and the prediction function generation unit may be executed when the air pressure of the tires detected by the air pressure detection unit has changed by a predetermined amount or more since the previous generation of the prediction function. In this configuration, when the air pressure of the tires has changed by a predetermined amount or more since the previous generation of the prediction function, the calculation process of the reference distance corresponding to the tire rotation speed and the generation process of the prediction function are automatically executed. Effect of the Invention
[0011] According to the present invention, the travel distance of a vehicle can be estimated with high accuracy regardless of changes in the outer diameter of the tires. [Brief description of the drawings]
[0012] [Figure 1] 1 is a block diagram showing a configuration of a self-position estimation device including a travel distance estimation device according to an embodiment of the present invention. [Diagram 2] 1 is a conceptual diagram showing how the outer diameter of a tire increases as the tire rotates at a higher speed. [Diagram 3] 1 is a graph showing an example of a relationship between a rotational speed of a tire and an outer diameter of the tire. [Figure 4] 2 is a flowchart showing the procedure of a function generating process executed by the arithmetic processing unit shown in FIG. 1. [Diagram 5] 11 is a graph showing how a reference distance is predicted from a tire rotation speed using a fitting function that represents the relationship between the tire rotation speed and the reference distance. [Figure 6] 2 is a flowchart showing a procedure of a distance calculation process executed by the arithmetic processing unit shown in FIG. 1. [Figure 7] 11 is a table showing an example of a correction table showing a relationship between a vehicle traveling speed and a reference distance. [Figure 8] FIG. 11 is a conceptual diagram showing how a travel distance of a vehicle is calculated from a reference distance. [Figure 9] 11 is a graph showing how the logistic curve of a fitting function changes depending on the outside air temperature condition. [Figure 10] FIG. 13 is a block diagram showing a configuration of a self-position estimation device including a travel distance estimation device according to another embodiment of the present invention. [Figure 11] 11 is a flowchart showing the procedure of a function generating process executed by the arithmetic processing unit shown in FIG. 10. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0013] Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings. In the drawings, the same or equivalent elements are designated by the same reference numerals, and duplicated explanations will be omitted.
[0014] Fig. 1 is a block diagram showing the configuration of a self-location estimation device including a travel distance estimation device according to one embodiment of the present invention. In Fig. 1, the self-location estimation device 1 is mounted on a vehicle 2. The vehicle 2 is an automobile or an industrial vehicle such as a forklift. The self-location estimation device 1 is a device that estimates the self-location of the vehicle 2 when the vehicle 2 is autonomously driven.
[0015] The self-position estimation device 1 includes a rotation sensor 3, a GPS receiver 4, an input device 5, and a processing unit 6.
[0016] The rotation sensor 3 is a rotation detection unit that detects the number of rotations and the rotation speed of a tire 7 (see FIG. 2) of the vehicle 2. For example, a rotary encoder or the like is used as the rotation sensor 3. The rotation sensor 3 outputs a detection value as an electric signal value such as a current value.
[0017] The GPS receiver 4 receives radio signals from a plurality of GPS satellites and measures, as position information, the current position of the vehicle 2. The GPS receiver 4 is a position information acquisition unit that acquires the position information of the vehicle 2.
[0018] The input device 5 is a device for inputting data related to self-position estimation of the vehicle 2. As the input device 5, a car navigation system or a dedicated touch panel or the like is used.
[0019] The arithmetic processing unit 6 is composed of a CPU, a RAM, a ROM, an input / output interface, etc. The arithmetic processing unit 6 executes a predetermined process based on the number of rotations and the rotation speed of the tires 7 detected by the rotation sensor 3 and the position information of the vehicle 2 measured by the GPS receiver 4, and estimates the self-position of the vehicle 2 by odometry.
[0020] Here, the distance traveled by the vehicle 2 when the tire 7 makes one rotation is defined as a reference distance. The reference distance depends on the outer diameter of the tire 7. When the air pressure of the tire 7 changes, the outer diameter of the tire 7 physically changes. In addition, when the traveling speed of the vehicle 2 and the temperature of the tire 7 change, the outer diameter of the tire 7 also physically changes.
[0021] For example, as shown in FIG. 2, when the traveling speed of the vehicle 2 is high (see FIG. 2(b)), the tire 7 rotates at a higher speed than when the traveling speed of the vehicle 2 is low (see FIG. 2(a)). As a result, the tire 7 is more likely to expand due to centrifugal force, and the outer diameter r of the tire 7 becomes larger.
[0022] As shown in Fig. 3, the outer diameter r of the tire 7 has a physical upper limit Lu and a lower limit Ll. The upper limit Lu of the outer diameter r of the tire 7 is the limit value beyond which the tire 7 cannot expand or change. As the traveling speed of the vehicle 2 increases, the outer diameter r of the tire 7 approaches the upper limit Lu. The lower limit Ll of the outer diameter r of the tire 7 is the limit value beyond which the tire 7 cannot contract or change. When the vehicle 2 stops traveling, the outer diameter r of the tire 7 becomes the lower limit Ll.
[0023] 3, the change in the outer diameter of the tire 7 can be approximately predicted with respect to the rotational speed of the tire 7 by a solution curve P of a logistic equation such as a sigmoid curve. In other words, the change in the outer diameter of the tire 7 with respect to the rotational speed of the tire 7 changes so as to asymptotically approach the upper limit value Lu and lower limit value Ll of the outer diameter of the tire 7. The rotational speed of the tire 7 is the number of rotations of the tire 7 per unit time, and is proportional to the traveling speed of the vehicle 2.
[0024] Therefore, the arithmetic processing unit 6 determines the reference distance of the vehicle 2 by predicting the outer diameter r of the tire 7 while the vehicle 2 is traveling based on the solution curve of the logistic equation, taking into consideration the traveling speed of the vehicle 2, the outside air temperature, and the change characteristics of the tire 7 due to the air pressure of the tire 7, etc. Then, the arithmetic processing unit 6 uses the reference distance to calculate the travel distance of the vehicle 2 and estimates the self-position of the vehicle 2.
[0025] The arithmetic processing unit 6 has a traveling information acquisition section 11 , a reference distance calculation section 12 , a prediction function generation section 13 , a reference distance determination section 14 , a travel distance calculation section 15 , and a self-position estimation section 16 .
[0026] The driving information acquisition unit 11 acquires the rotation speed of the tires 7 detected by the rotation sensor 3 and the position information of the vehicle 2 measured by the GPS receiver 4 in response to an instruction input by the input device 5. The rotation speed of the tires 7 and the position information of the vehicle 2 are driving information of the vehicle 2.
[0027] The reference distance calculation unit 12 calculates a plurality of reference distances corresponding to the rotational speed of the tires 7 based on the rotational speed of the tires 7 acquired by the traveling information acquisition unit 11 and the position information of the vehicle 2 .
[0028] The prediction function generating unit 13 calculates a prediction function that represents the relationship between the number of rotations of the tire 7 and the reference distance, based on the rotation speed of the tire 7 at a plurality of points and the reference distance. The reference distance corresponds to the outer diameter of the tire 7.
[0029] The reference distance determination unit 14 determines a reference distance according to the rotation speed of the tire 7 by using the prediction function generated by the prediction function generation unit 13 .
[0030] The travel distance calculation unit 15 calculates the travel distance of the vehicle 2 based on the number of rotations of the tire 7 detected by the rotation sensor 3 and the reference distance determined by the reference distance determination unit 14 .
[0031] The self-position estimating unit 16 estimates the self-position of the vehicle 2 based on the travel distance of the vehicle 2 calculated by the travel distance calculating unit 15.
[0032] The rotation sensor 3, the GPS receiver 4, the input device 5, the travel information acquisition section 11 of the arithmetic processing unit 6, the reference distance calculation section 12, the prediction function generation section 13, the reference distance determination section 14, and the travel distance calculation section 15 constitute a travel distance estimation device 10 of this embodiment. The travel distance estimation device 10 estimates the travel distance of the vehicle 2 by using a reference distance traveled by the vehicle 2 per one rotation of the tires 7.
[0033] 4 is a flowchart showing the procedure of the function generation process executed by the arithmetic processing unit 6. The function generation process is executed by the travel information acquisition unit 11, the reference distance calculation unit 12, and the prediction function generation unit 13.
[0034] 4, the arithmetic processing unit 6 first determines whether or not a command to generate a function has been input by the input device 5 (step S101). When it is determined that a command to generate a function has been input, the arithmetic processing unit 6 acquires the rotational speed of the tire 7 detected by the rotation sensor 3 and the position information of the vehicle 2 measured by the GPS receiver 4 (step S102).
[0035] 5, the arithmetic processing unit 6 calculates a reference distance according to the rotational speed of the tire 7 based on the rotational speed of the tire 7 and the position information of the vehicle 2 (step S103). The reference distance is calculated from the history of the position information of the vehicle 2.
[0036] Next, the arithmetic processing unit 6 judges whether the reference distances corresponding to the rotational speed of the tire 7 have been calculated for a specified number of points (step S104). The specified number of points is, for example, three points (see FIG. 5). When the arithmetic processing unit 6 judges that the reference distances corresponding to the rotational speed of the tire 7 have not been calculated for the specified number of points, it executes the above steps S102 and S103 again.
[0037] When the calculation processing unit 6 determines that the reference distances corresponding to the rotation speed of the tire 7 have been calculated for the specified number of points, the calculation processing unit 6 fits the rotation speed of the tire 7 and the reference distances at the specified number of points to a logistic curve Q (solution curve) such as a sigmoid curve using the least squares method as shown in Fig. 5, and generates a fitting function (prediction function) (step S105). The logistic curve Q is set so as to pass through all the specified points.
[0038] The fitting function is expressed by the following formula.
number
[0039] In the example shown in FIG. 5, the reference distance when the tire 7 rotates 10 times per unit time is 1.30 m, the reference distance when the tire 7 rotates 60 times per unit time is 1.35 m, and the reference distance when the tire 7 rotates 80 times per unit time is 1.36 m.
[0040] Here, the travel information acquisition unit 11 executes steps S101 and S102. The reference distance calculation unit 12 executes step S103. The prediction function generation unit 13 executes steps S104 and S105.
[0041] 6 is a flowchart showing the procedure of the distance calculation process executed by the arithmetic processing unit 6. The distance calculation process is executed by the reference distance determination unit 14 and the movement distance calculation unit 15.
[0042] 6, the arithmetic processing unit 6 first acquires the number of rotations and the rotation speed of the tire 7 detected by the rotation sensor 3 (step S111). Next, the arithmetic processing unit 6 uses the fitting function shown in FIG. 5 to obtain a predicted value of the reference distance according to the rotation speed V of the tire 7 (step S112).
[0043] Next, the arithmetic processing unit 6 calculates the travel distance of the vehicle 2 based on the number of revolutions of the tire 7 and the predicted value of the reference distance (step S113). The travel distance of the vehicle 2 is calculated by multiplying the predicted value of the reference distance by the number of revolutions of the tire 7.
[0044] Here, the reference distance determination unit 14 executes steps S111 and S112. The movement distance calculation unit 15 executes steps S111 and S113.
[0045] Conventionally, a reference distance corresponding to the traveling speed of the vehicle 2 is determined using a correction table as shown in FIG. 7. The correction table indicates the relationship between the traveling speed of the vehicle 2 and the reference distance, and is prepared in advance. The traveling speed of the vehicle 2 corresponds to the rotation speed of the tires 7.
[0046] However, if the outer diameter of the tire 7 changes due to conditions such as the temperature of the tire 7, the reference distance also changes. For example, as shown in FIG. 8, if the reference distance is 100 cm, the traveled distance is 500 cm after five rotations of the tire 7. If the outer diameter of the tire 7 increases due to an increase in temperature of the tire 7, and the reference distance becomes 103 cm, the traveled distance becomes 515 cm after five rotations of the tire 7. In other words, even if the tire 7 rotates only five times, the traveled distance of the vehicle 2 is shifted by 15 cm, and an error of 15 cm occurs in the self-location estimation value of the vehicle 2. Such a self-location estimation error is fatal to autonomous driving.
[0047] In order to suppress the self-location estimation error, it is conceivable to use a correction table that indicates the relationship between the traveling speed of the vehicle 2 and the reference distance for each temperature of the tire 7. In that case, however, a correction table for each temperature of the tire 7 is required, which increases the burden of creating the correction tables.
[0048] To address such a problem, in this embodiment, when a reference distance corresponding to the rotational speed of the tire 7 is calculated at a plurality of points, a fitting function (prediction function) is generated based on the rotational speed of the tire 7 and the reference distance at the plurality of points. At this time, even if the outer diameter of the tire 7 changes due to a change in the temperature of the tire 7, a fitting function suitable for the temperature of the tire 7 is generated. For example, as shown in FIG. 9, when the temperature of the tire 7 is high (see FIG. 9(b)), a fitting function is generated such that the upper limit value Lu and the lower limit value Ll of the logistic curve Q are higher than when the temperature of the tire 7 is low (see FIG. 9(a)). Therefore, an optimal reference distance can be obtained regardless of the change in temperature of the tire 7.
[0049] As described above, according to the present embodiment, a reference distance corresponding to the rotational speed of the tire 7 is calculated at a plurality of points based on the rotational speed of the tire 7 and the position information of the vehicle 2, and a prediction function expressing the relationship between the rotational speed of the tire 7 and the reference distance is generated based on the rotational speed of the tire 7 and the reference distance at the plurality of points. Then, a reference distance corresponding to the rotational speed of the tire 7 is determined using the prediction function. Then, a travel distance of the vehicle 2 is calculated based on the number of rotations of the tire 7 and the reference distance. The reference distance changes depending on the outer diameter of the tire 7. Even if such a change in the outer diameter of the tire 7 occurs, a prediction function expressing the relationship between the rotational speed of the tire 7 and the reference distance corresponding to the outer diameter of the tire 7 is generated again, and the reference distance corresponding to the rotational speed of the tire 7 is determined using the new prediction function. As a result, the travel distance of the vehicle 2 is estimated with high accuracy regardless of the change in the outer diameter of the tire 7. As a result, the estimation accuracy of the self-position of the vehicle 2 can be improved. In addition, by determining the reference distance corresponding to the rotational speed of the tire 7 using the prediction function, a correction table expressing the relationship between the rotational speed of the tire 7 and the reference distance is not required, and the burden of creating the correction table is reduced.
[0050] In addition, in this embodiment, a prediction function is generated that is approximated by a solution curve of a logistic equation that changes so as to asymptotically approach the lower and upper limits of the reference distance, thereby obtaining an appropriate reference distance according to the rotational speed of the tire 7.
[0051] Fig. 10 is a block diagram showing the configuration of a self-location estimation device including a travel distance estimation device according to another embodiment of the present invention. In Fig. 10, the self-location estimation device 1A includes the rotation sensor 3, the GPS receiver 4, a temperature sensor 21, an air pressure sensor 22, and a calculation processing unit 6A.
[0052] The temperature sensor 21 is a temperature detection unit that detects the outside air temperature. When the outside air temperature increases, the temperature of the tire 7 increases. The air pressure sensor 22 is an air pressure detection unit that detects the air pressure of the tire 7.
[0053] The arithmetic processing unit 6A has a driving information acquisition section 11A instead of the driving information acquisition section 11 in the above-described embodiment.
[0054] The driving information acquisition unit 11A acquires the rotational speed of the tire 7 detected by the rotation sensor 3 and the position information of the vehicle 2 measured by the GPS receiver 4 in accordance with the outside air temperature detected by the temperature sensor 21 and the air pressure of the tire 7 detected by the air pressure sensor 22.
[0055] The rotation sensor 3, the GPS receiver 4, the temperature sensor 21, the air pressure sensor 22, the driving information acquisition unit 11A of the arithmetic processing unit 6A, the reference distance calculation unit 12, the prediction function generation unit 13, the reference distance determination unit 14 and the travel distance calculation unit 15 constitute the travel distance estimation device 10A of this embodiment.
[0056] Fig. 11 is a flowchart showing the procedure of the function generation process executed by the arithmetic processing unit 6A, and corresponds to Fig. 4. Note that the first fitting function is generated when a function generation instruction is inputted by the input device 5, for example.
[0057] 11, the arithmetic processing unit 6A first determines whether the amount of change in the outside air temperature since the previous generation of the fitting function is smaller than a specified temperature amount based on the detection value of the temperature sensor 21 (step S107). The specified temperature amount is determined in advance.
[0058] When the calculation processing unit 6A determines that the amount of change in the outside air temperature since the previous generation of the fitting function is smaller than the specified temperature amount, it determines whether or not the amount of change in the air pressure of the tire 7 since the previous generation of the fitting function is smaller than the specified pressure amount based on the detection value of the air pressure sensor 22 (step S108). The specified pressure amount is determined in advance.
[0059] When the arithmetic processing unit 6A determines that the amount of change in the air pressure of the tire 7 from the time when the fitting function was generated the previous time is smaller than the specified pressure amount, it executes the above-mentioned step S107 again.
[0060] When the calculation processing unit 6A determines in step S107 that the amount of change in the outside air temperature since the previous generation of the fitting function is equal to or greater than the specified temperature amount, or when the calculation processing unit 6A determines in step S108 that the amount of change in the air pressure of the tire 7 since the previous generation of the fitting function is equal to or greater than the specified pressure amount, the calculation processing unit 6A executes steps S102 to S105 as in the above-described embodiment.
[0061] Here, the travel information acquisition unit 11A executes steps S107, S108, and S102. Therefore, the reference distance calculation unit 12 and the prediction function generation unit 13 are executed when the outside air temperature detected by the temperature sensor 21 has changed by a predetermined temperature regulation amount or more since the previous fitting function was generated, and when the air pressure of the tire 7 detected by the air pressure sensor 22 has changed by a predetermined pressure regulation amount or more since the previous fitting function was generated.
[0062] In the present embodiment as described above, when the outside air temperature has changed by more than a specified temperature amount since the previous time the prediction function was generated, the process of calculating the reference distance corresponding to the rotational speed of the tire 7 and the process of generating the prediction function are automatically executed.
[0063] In addition, in this embodiment, when the air pressure of the tire 7 has changed by more than a specified pressure amount since the previous time the prediction function was generated, the process of calculating the reference distance corresponding to the rotational speed of the tire 7 and the process of generating the prediction function are automatically executed.
[0064] The present invention is not limited to the above embodiment. For example, in the above embodiment, the rotation sensor 3 that detects the number of rotations and the rotation speed of the tire 7 outputs the detection value as an electric signal value, but the rotation sensor 3 is not particularly limited to this form, and a rotary encoder that outputs the detection value as a pulse signal may be used. In this case, the reference distance is the travel distance per pulse of the rotation sensor 3.
[0065] In addition, in the above embodiment, the rotation number and rotation speed of the tire 7 are detected by the rotation sensor 3, but this is not particularly limited to the embodiment, and the rotation sensor 3 may detect only the rotation number of the tire 7, and the rotation speed of the tire 7 may be calculated by the arithmetic processing unit 6, 6A. In this case, the rotation sensor 3 and some functions of the arithmetic processing units 6, 6A constitute a rotation detection unit.
[0066] In addition, in the above embodiment, the position information of the vehicle 2 is acquired by a global navigation satellite system (GNSS) using a GPS receiver 4. However, the method for acquiring the position information of the vehicle 2 is not limited to this form, and for example, a simultaneous localization and mapping (SLAM) method using light detection and ranging (LIDAR) or the like may be adopted.
[0067] In addition, in the above embodiment, the self-position of the vehicle 2 is estimated by odometry, but the present invention is also applicable to a case where the self-position of the vehicle 2 is primarily estimated by GNSS or SLAM, and the self-position of the vehicle 2 is estimated by odometry as a complement.
[0068] In addition, in the above embodiment, the distance traveled by vehicle 2 is calculated and the vehicle's own position is estimated when vehicle 2 is being driven automatically. However, the present invention is also applicable to cases where the distance traveled by vehicle 2 is calculated when vehicle 2 is being driven manually, for example. [Explanation of symbols]
[0069] 2...vehicle, 3...rotation sensor (rotation detection unit), 4...GPS receiver (position information acquisition unit), 7...tire, 10, 10A...travel distance estimation device, 11, 11A...driving information acquisition unit, 12...reference distance calculation unit, 13...prediction function generation unit, 14...reference distance determination unit, 15...travel distance calculation unit, 21...temperature sensor (temperature detection unit), 22...air pressure sensor (air pressure detection unit), Q...logistic curve (solution curve).
Claims
1. A travel distance estimation device that estimates a travel distance of a vehicle by using a reference distance that the vehicle travels per one rotation of a tire, comprising: A rotation detection unit that detects the number of rotations and the rotation speed of the tire; a location information acquisition unit that acquires location information of the vehicle; a reference distance calculation unit that calculates a plurality of reference distances corresponding to the rotational speed of the tire based on the rotational speed of the tire detected by the rotation detection unit and the position information of the vehicle detected by the position information acquisition unit; a prediction function generating unit configured to generate a prediction function representing a relationship between the rotational speed of the tire and the reference distance based on the rotational speed of the tire at the plurality of points and the reference distance; a reference distance determination unit that determines a reference distance according to the rotation speed of the tire detected by the rotation detection unit, using the prediction function generated by the prediction function generation unit; a travel distance calculation unit that calculates a travel distance of the vehicle based on the number of tire rotations detected by the rotation detection unit and the reference distance determined by the reference distance determination unit.
2. 2. The travel distance estimation device according to claim 1, wherein the prediction function is a function expressed by approximation with a solution curve of a logistic equation that changes so as to asymptotically approach lower and upper limits of the reference distance.
3. Further comprising a temperature detection unit for detecting an outside air temperature, 3. The travel distance estimation device according to claim 1, wherein the reference distance calculation unit and the prediction function generation unit are executed when the outside air temperature detected by the temperature detection unit has changed by a predetermined amount or more since the previous generation of the prediction function.
4. An air pressure detection unit that detects the air pressure of the tire is further provided, 3. The travel distance estimation device according to claim 1, wherein the reference distance calculation unit and the prediction function generation unit are executed when the tire air pressure detected by the air pressure detection unit has changed by a predetermined amount or more since the previous generation of the prediction function.
Citation Information
Patent Citations
Speed and distance meter
JP1997054105A
Vehicle travel distance correcting method and device executing this method
JP1998239092A
Current position detection device
JP2006343219A
Distance coefficient approximate expression creating device, distance coefficient approximate expression creating method, and distance coefficient approximate expression creating program
JP2009229268A
Method for navigating a terrestrial vehicle
US6349260B1
