Bias estimation device, forklift, bias estimation method and program

Abstract

To provide a bias estimation device capable of accurately estimating a bias of a value measured by an inertia measurement instrument.SOLUTION: The bias estimation device comprises: a determination unit that determines whether a forklift is stationary on the basis of a value measured by a first sensor for detecting information about movement of the forklift and a value measured by a second sensor for detecting information about a loading device installed in the forklift; an accumulation unit that accumulates IMU measured values which are values measured by an inertia measurement instrument installed in the forklift when the determination unit determines that the forklift is stationary, and stops accumulation of the IMU measured values when the determination unit determines that the forklift is not stationary; and a calculation unit that calculates biases of the IMU measured values on the basis of the IMU measured values accumulated in the accumulation unit.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present disclosure relates to a bias estimation device, a forklift, a bias estimation method, and a program. [Background technology]

[0002] When positioning a moving object such as a forklift, the measurement results of a global positioning system (GPS) and an inertial measurement unit (IMU) are used and combined to improve the accuracy of the positioning (for example, Patent Document 2). However, since the IMU measurement values ​​(acceleration, velocity, angular velocity, etc.) contain bias, the positioning result may deteriorate if the bias is not compensated for. An example of a worsening positioning result is when, even though the vehicle is stopped, the measurement value of the yaw angular velocity does not become 0 due to the bias, resulting in a positioning result that the vehicle body is rotating.

[0003] In response to this problem, Patent Document 1 proposes a method of estimating bias using a measurement value immediately after IMU startup, when it is highly likely that the moving object is stationary, by utilizing the fact that it is easy to separate bias elements contained in the measurement value when the moving object is stationary, and a method of estimating bias using an IMU measurement value when it is determined from a camera image that the vehicle is stationary. However, in an environment in which a moving object is actually operated, a user may operate the moving object immediately after IMU startup, so it is insufficient to determine that the moving object is stationary only on the condition that the IMU is immediately after startup. Also, even in the case of stationary determination using a camera, when the camera captures a relatively distant object, the change in the image (for example, the amount of movement of a feature point) becomes small relative to the movement of the vehicle body, so that the IMU measurement value may be affected by the movement of the worker or the vibration of the vehicle body caused by the lifting and lowering of the fork.

[0004] Also, Patent Document 2 proposes a method of estimating bias to reduce the error of the positioning result by comparing the positioning result using IMU with the past positioning result using GPS, or comparing with the positioning result of the system until the positioning result using GPS is updated (a value obtained by integrating the positioning result using GPS and the positioning result using IMU using a Kalman filter). When the moving object is moving, the change in the IMU measurement value due to the movement is dominant, and the influence of the bias is relatively reduced. Therefore, it is difficult to separate the bias from the IMU measurement value, and there is a high possibility that the estimation accuracy is insufficient compared to bias estimation in a stationary state. However, the technology disclosed in Patent Document 2 estimates the bias regardless of whether the moving object is stopped or moving. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] International Publication No. 2021 / 157116 [Patent Document 2] JP 2010-019703 A Summary of the Invention [Problem to be solved by the invention]

[0006] Regarding forklift positioning, technology is needed to accurately estimate the bias of IMU measurements.

[0007] The present disclosure provides a bias estimation device, a forklift, a bias estimation method, and a program that can solve the above problems. [Means for solving the problem]

[0008] The bias estimation device of the present disclosure includes a determination unit that determines whether the forklift is stationary based on a measurement value by a first sensor that detects information related to movement of the forklift and a measurement value by a second sensor that detects information related to a loading device equipped on the forklift, and a storage unit that accumulates IMU measurement values, which are measurements by an inertial measurement unit equipped on the forklift, when the determination unit determines that the forklift is stationary, and stops accumulating the IMU measurement values ​​when the determination unit determines that the forklift is not stationary; a sample number monitoring unit that determines that a sufficient number of samples for calculating a bias of the IMU measurement value has been obtained when the number of the IMU measurement values ​​accumulated in the accumulation unit becomes equal to or greater than a threshold value; and when the sample number monitoring unit determines that a sufficient number of samples has been obtained, A calculation unit that calculates a bias of the IMU measurement value based on the IMU measurement value stored in the storage unit; an end determination unit that deletes the IMU measurement value stored in the storage unit when the calculation unit ends the bias calculation or when the determination unit determines that the vehicle is not stationary; Equipped with.

[0009] The forklift of the present disclosure includes a running body, a loading device, the above-mentioned bias estimation device, and a positioning device that compensates for the IMU measurement value using the bias estimation device and locates the position of the forklift based on the compensated IMU measurement value.

[0010] The bias estimation method disclosed herein includes a step of repeatedly judging whether the forklift is stationary or not based on a measurement value by a first sensor that detects information related to movement of the forklift and a measurement value by a second sensor that detects information related to a loading device equipped on the forklift, a step of accumulating an IMU measurement value, which is a measurement value by an inertial measurement unit equipped on the forklift, when it is determined in the step of judging that the forklift is stationary, and a step of stopping the accumulation of the IMU measurement value when it is determined in the step of judging that the forklift is not stationary. and delete the stored IMU measurements. and When the number of accumulated IMU measurement values ​​becomes equal to or greater than a threshold value, a step of determining that a sufficient number of samples for calculating a bias of the IMU measurement values ​​has been obtained, and when it is determined that a sufficient number of samples has been obtained in the step of determining that a sufficient number of samples has been obtained, calculating a bias of the IMU measurement based on the accumulated IMU measurement; deleting the accumulated IMU measurements once the bias calculation is complete; has.

[0011] The program of the present disclosure further includes a step of repeatedly judging whether the forklift is stationary based on a measurement value by a first sensor that detects information related to movement of the forklift and a measurement value by a second sensor that detects information related to a loading device equipped in the forklift, accumulating an IMU measurement value, which is a measurement value by an inertial measurement unit equipped in the forklift, if it is determined in the determining step that the forklift is stationary, and stopping the accumulation of the IMU measurement value if it is determined in the determining step that the forklift is not stationary. and delete the stored IMU measurements. and When the number of accumulated IMU measurement values ​​becomes equal to or greater than a threshold value, a step of determining that a sufficient number of samples for calculating a bias of the IMU measurement values ​​has been obtained, and when it is determined that a sufficient number of samples has been obtained in the step of determining that a sufficient number of samples has been obtained, calculating a bias of the IMU measurement based on the accumulated IMU measurement; deleting the accumulated IMU measurements once the bias calculation is complete; Execute the command. Effect of the Invention

[0012] According to the above-described bias estimation device, positioning device, forklift, bias estimation method and program, it is possible to accurately estimate the bias of IMU measurement values ​​in relation to the positioning of the forklift, taking into account the operating environment of the forklift. [Brief description of the drawings]

[0013] [Figure 1] FIG. 1 is a schematic diagram illustrating an example of a forklift according to a first embodiment. [Diagram 2] 1 is a diagram illustrating an example of a positioning system according to a first embodiment. [Diagram 3] 5 is a flowchart showing an example of a bias estimation process according to the first embodiment. [Figure 4] FIG. 6 is a schematic diagram illustrating an example of a forklift according to a second embodiment. [Diagram 5] FIG. 11 is a diagram illustrating an example of a positioning system according to a second embodiment. [Figure 6] 10 is a flowchart showing an example of a bias estimation process according to the second embodiment. [Figure 7] FIG. 11 is a diagram illustrating an example of a positioning system according to a third embodiment. [Figure 8]13 is a flowchart showing an example of a bias estimation process according to the third embodiment. [Figure 9] FIG. 13 is a diagram illustrating an example of a positioning system according to a fourth embodiment. [Figure 10] 13 is a flowchart showing an example of a bias estimation process according to the fourth embodiment. [Figure 11] FIG. 13 is a schematic view showing an example of a forklift according to a fifth embodiment. [Figure 12] FIG. 13 is a diagram illustrating an example of a positioning system according to a fifth embodiment. [Figure 13] 13 is a flowchart showing an example of a bias estimation process according to the fifth embodiment. [Figure 14] FIG. 2 is a diagram illustrating an example of a hardware configuration of a positioning system according to each embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0014] First Embodiment The bias estimation method of the present disclosure will be described below with reference to the drawings. (Forklift body structure) FIG. 1 is a schematic diagram illustrating an example of a forklift according to a first embodiment. The manned forklift 1 includes a running body 2, a loading device 3, and a computing device 20. The running body 2 includes tires and a driving device and a steering device (not shown) to run the forklift 1. The loading device 3 includes a fork 4 and a lifting device 5 for raising and lowering the fork 4, and performs loading and unloading operations by raising and lowering the load loaded on the fork 4. The running body 2 includes an IMU 10, a first encoder 11, and a second encoder 12. The IMU 10 includes an acceleration sensor and a gyro sensor, and can detect the moving speed, acceleration, moving direction, and turning direction of the forklift 1. The first encoder 11 is a rotary encoder that detects the number of rotations of the tires (e.g., rear wheels) of the forklift 1. The second encoder 12, which can detect the movement of the forklift 1 based on the measurement value of the first encoder 11, is a rotary encoder that detects the steering angle of the tires (e.g., front wheels) of the forklift 1. The steering operation of the operator with respect to the forklift 1 can be detected based on the measurement value of the second encoder 12. The loading device 3 is provided with a height sensor 13 and a load sensor 14. The height sensor 13 detects the lifted position of the forks 4. The load sensor 14 detects the weight of the cargo loaded on the forks 4. The height sensor 13 and the load sensor 14 can detect the loading operation of the loading device 3, changes in the cargo loaded on the forks 4, etc.

[0015] If the measurement value of the first encoder 11 and / or the second encoder 12 is not 0 (including a predetermined range that can be regarded as 0), the traveling body 2 is performing some kind of operation (moving, rotating, etc.), and this operation affects the measurement value of the IMU 10 (sometimes referred to as the IMU measurement value). If there is a change in the measurement value of the lifting height sensor 13, the forks 4 are rising and falling. If there is a change in the measurement value of the load sensor 14, there is a possibility that the forks 4 are being loaded or unloaded. In these cases, even if the forklift 1 is not traveling, vibrations are generated in the vehicle body, which may affect the IMU measurement value.

[0016] Each of the sensors, the IMU 10, the first encoder 11, the second encoder 12, the lifting height sensor 13, and the load sensor 14, is connected to the arithmetic unit 20, and the measurement values ​​measured by each sensor are sent to the arithmetic unit 20. The arithmetic unit 20 is configured with a computer equipped with a processor. The arithmetic unit 20 determines the position of the forklift 1 (its own position) using the measurement values ​​from each of the above sensors.

[0017] (Positioning system configuration) FIG. 2 is a diagram illustrating an example of a positioning system according to the first embodiment. 2, the positioning system 100 includes a positioning system main body 201, a measurement start determination unit 202, an IMU measurement value accumulation unit 203, an accumulated sample number monitoring unit 204, a bias calculation unit 205, a bias update unit 206, an end determination unit 207, an IMU 10, a first encoder 11, a second encoder 12, a lift sensor 13, and a load sensor 14. Among these, the positioning system main body 201, the measurement start determination unit 202, the IMU measurement value accumulation unit 203, the accumulated sample number monitoring unit 204, the bias calculation unit 205, the bias update unit 206, and the end determination unit 207 are functions implemented in the calculation device 20.

[0018] The positioning system main body 201 calculates (locates) position information of the forklift 1 by dead reckoning or the like based on the measurement value of the IMU 10. At this time, the positioning system main body 201 compensates the IMU measurement value by subtracting the bias value updated by the bias update unit 206 from the measurement value of the IMU 10. If the position information is calculated by accumulating the IMU measurement values ​​including the bias, the accuracy of the position information decreases. For this reason, the positioning system main body 201 calculates the position information based on the accurate IMU measurement value that has been subjected to bias compensation.

[0019] The measurement start determination unit 202 confirms that no unexpected vehicle motion has occurred during the startup sequence of the positioning system 100, and determines to start accumulating the IMU measurement values. During the startup sequence, operations such as acquiring and confirming various sensor values ​​and establishing communication with other systems are performed. In principle, it is assumed that the forklift 1 is not moved during the startup sequence. Since it takes some time to complete the startup sequence, it is possible to acquire a sufficient number of samples of IMU measurement values ​​when the vehicle is simply stationary for estimation. Furthermore, in order to reliably use the IMU measurement values ​​when the vehicle is not moving for bias estimation, it is also confirmed that no unexpected vehicle motion has occurred in the forklift 1. A state in which no unexpected vehicle motion has occurred is, for example, a state in which the values ​​of the first encoder 11 and the second encoder 12 are not 0, and the measurement values ​​of the lifting height sensor 13 and the load sensor 14 change. If the forklift 1 is stationary, the IMU measurement value is 0. Therefore, if the IMU measurement value fluctuates even though the forklift 1 is stationary, it is possible to recognize the fluctuation as a bias. However, it is difficult to detect bias in the IMU measurement value measured while the forklift 1 is in operation because the operation is reflected in the IMU measurement value. Therefore, in this embodiment, the measurement values ​​of the sensors 11 to 14 other than the IMU 10 are observed to confirm that the forklift 1 is stationary, and when it is confirmed that the forklift 1 is stationary, the IMU measurement value during the stationary state is accumulated to estimate the bias. Since it is considered that the forklift 1 is often stationary during the start-up sequence of the positioning system 100, the measurement start determination unit 202 confirms that the forklift 1 is stationary during the start-up sequence of the positioning system 100 and performs a determination to start accumulating the IMU measurement value.

[0020] The IMU measurement value accumulation unit 203 includes a storage medium such as a memory, a hard disk drive (HDD), etc. When the measurement start determination unit 202 determines to start accumulating the IMU measurement values, the IMU measurement value accumulation unit 203 starts accumulating the measurement values ​​measured by the IMU 10. When the number of accumulated IMU measurement values ​​reaches or exceeds a threshold (or when the storage area for accumulating the IMU measurement values ​​becomes full), the IMU measurement value accumulation unit 203 sequentially deletes the oldest measurement values ​​to free up the storage area, and prioritizes accumulating the newest IMU measurement values.

[0021] The accumulated sample number monitoring unit 204 monitors the number of IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203. When the number of accumulated IMU measurement values ​​becomes equal to or greater than a threshold, the accumulated sample number monitoring unit 204 notifies the bias calculation unit 205 that a sufficient number of samples has been obtained to estimate the bias of the IMU measurement values.

[0022] When the bias calculation unit 205 is notified by the accumulated sample number monitoring unit 204 that a sufficient number of samples has been accumulated, the bias calculation unit 205 calculates an estimated value of the bias of the IMU measurement value based on the IMU measurement value accumulated in the IMU measurement value accumulation unit 203. For example, the bias calculation unit 205 calculates an average value of the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203, and sets this average value as the bias. Alternatively, the bias calculation unit 205 may calculate a mode or median of the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203, and set the calculated value as the bias.

[0023] The bias update unit 206 updates the bias value referred to by the positioning system main body 201 with the new bias value calculated by the bias calculation unit 205. The bias update unit 206 may be configured to include a storage medium such as a memory, and may be configured to store the latest bias calculated by the bias calculation unit 205.

[0024] The end determination unit 207 controls the end of the process of estimating the bias of the IMU measurement value. For example, it confirms that the start-up sequence of the positioning system 100 has ended, that an unexpected movement of the forklift 1 has occurred, or that the update of the bias has been completed, and when it has confirmed these, it ends the accumulation of the IMU measurement value and deletes the IMU measurement value accumulated so far.

[0025] (operation) Next, the bias estimation process performed by the positioning system 100 will be described with reference to FIG. FIG. 3 is a flowchart illustrating an example of the bias estimation process according to the first embodiment. The measurement start determination unit 202 determines whether the positioning system 100 is in the startup sequence (step S1). For example, when an operator turns on the power of the forklift 1, the positioning system 100 starts up and the startup sequence is executed. The measurement start determination unit 202, for example, monitors the execution log of the startup sequence and checks whether the startup sequence is being executed. If the startup sequence is not in progress (step S1; False), the bias estimation process is terminated. If the startup sequence is in progress (step S1; True), the measurement start determination unit 202 determines whether the measurement value by the first encoder 11 and / or the second encoder 12 is 0 and the measurement value of the lifting height sensor 13 and the measurement value of the load sensor 14 have not changed (step S2). If the measurement values ​​of the first encoder 11 and the second encoder 12 are not 0, or the measurement value of the lifting height sensor 13 or the measurement value of the load sensor 14 have changed (step S2; False), the bias estimation process is terminated.

[0026] When the measurement values ​​of the sensors satisfy the above conditions (step S2; True), the measurement start determination unit 202 determines to start accumulating the IMU measurement values, and instructs the IMU measurement value accumulation unit 203 to start accumulating the IMU measurement values. Then, the IMU measurement value accumulation unit 203 acquires the measurement values ​​from the IMU 10 and accumulates the acquired IMU measurement values ​​(step S3). The IMU measurement value accumulation unit 203 writes and stores the IMU measurement values ​​in a storage medium. While the IMU measurement value accumulation unit 203 accumulates the IMU measurement values, the end determination unit 207 determines whether the positioning system 100 is in a startup sequence (step S4). For example, the end determination unit 207 monitors an execution log of the startup sequence, etc., and checks whether the startup sequence is being executed. When the startup sequence is not being executed (step S4; False), the end determination unit 207 deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203 (step S9), and ends the bias estimation process. If the startup sequence is in progress (step S4; True), the end determination unit 207 determines whether the measurement values ​​from the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​from the height sensor 13 and the load sensor 14 (step S5). If this condition is not met (step S5; False), the end determination unit 207 deletes the IMU measurement values ​​stored in the IMU measurement value storage unit 203 (step S9) and ends the bias estimation process.

[0027] When the measurement values ​​of the sensors satisfy the above condition (step S5; True), the accumulated sample number monitor 204 judges whether a sufficient number of IMU measurement values ​​have been accumulated in the IMU measurement value accumulation unit 203 (step S6). For example, the accumulated sample number monitor 204 compares the number of IMU measurement values ​​stored in the IMU measurement value accumulation unit 203 with a threshold value to judge whether a sufficient number of IMU measurement values ​​have been accumulated. When a sufficient number of IMU measurement values ​​have not been accumulated (step S6; False), the process from step S3 onward is repeatedly executed. When a sufficient number of IMU measurement values ​​have been accumulated (step S6; True), the bias calculation unit 205 calculates a bias (step S7). For example, the bias calculation unit 205 calculates any one of the average value, median value, and mode value of the IMU measurement values ​​stored in the IMU measurement value accumulation unit 203. The bias calculation unit 205 outputs the calculated value to the bias update unit 206. The bias update unit 206 updates the bias of the positioning system 100 (bias value referred to by the positioning system main body 201) (step S8). For example, the bias update unit 206 outputs the bias acquired from the bias calculation unit 205 to the positioning system main body 201. The positioning system main body 201 compensates the IMU measurement value using the bias acquired from the bias update unit 206, and performs positioning of the forklift 1 based on the compensated IMU measurement value. Next, the end determination unit 207 deletes the IMU measurement value accumulated in the IMU measurement value accumulation unit 203 (step S9), and ends the bias estimation process.

[0028] (effect) As described above, according to this embodiment, the forklift 1 is in a stationary state suitable for bias calculation of the IMU measurement value when (1) the positioning system 100 that estimates the self-position of the forklift 1 is in the startup sequence, (2) the measurement values ​​of the first encoder 11 and / or the second encoder 12 that detect the movement of the forklift 1 indicate that the forklift 1 is not in operation (these measurement values ​​are 0), and (3) the measurement values ​​of the lifting height sensor 13 and / or the load sensor 14 indicate that the forklift 1 is not in the loading / unloading operation (there is no fluctuation in these measurement values), and when it is confirmed that the positioning system 100 is in the startup sequence and the forklift 1 is stationary (not moving and not performing loading / unloading operation), the bias is estimated. In the startup sequence, which is a situation in which the vehicle is basically stationary, and after confirming that the forklift 1 is stationary, the IMU measurement values ​​are accumulated and the data is used to estimate the bias with higher accuracy. By estimating the bias with high accuracy, the position of the forklift 1 can be accurately located.

[0029] <Second embodiment> A positioning system 100A according to a second embodiment of the present disclosure will be described below with reference to Fig. 4 to Fig. 6. In the first embodiment, the bias was estimated by confirming that the forklift 1 was not in operation during the start-up sequence of the positioning system 100. In contrast, in the second embodiment, the bias is estimated while the forklift 1A is being charged, taking advantage of the fact that the forklift 1A is likely not to be in operation while being charged.

[0030] (Forklift configuration) FIG. 4 is a schematic diagram illustrating an example of a forklift according to the second embodiment. The forklift 1A is an electric (rechargeable) forklift. The forklift 1A includes a traveling body 2A, a loading device 3, and a computing device 20A. The traveling body 2A is provided with a vehicle charging system 15 in addition to the IMU 10 and the like. The vehicle charging system 15 includes a secondary battery and a charging / discharging circuit. The vehicle charging system 15 receives power from a commercial power source and charges the secondary battery. The vehicle charging system 15 also discharges the secondary battery and supplies the discharged power to each unit to drive the forklift 1A. The vehicle charging system 15 is connected to the computing device 20A. The vehicle charging system 15 notifies the computing device 20A of the charge / discharge state of the secondary battery (for example, a notification of the start of charging or a notification of the end of charging). The computing device 20A will be described next with reference to FIG. 5. The other configurations of the forklift 1A are the same as those of the forklift 1 of the first embodiment.

[0031] (Positioning system configuration) FIG. 5 is a diagram illustrating an example of a positioning system according to the second embodiment. As shown in FIG. 5, the positioning system 100A includes a positioning system main body 201, a measurement start determination unit 202A, an IMU measurement value storage unit 203, an accumulated sample number monitoring unit 204, a bias calculation unit 205, a bias update unit 206, an end determination unit 207A, and an IMU 10. Of these, the positioning system main body 201, the measurement start determination unit 202A, the IMU measurement value storage unit 203, the accumulated sample number monitoring unit 204, the bias calculation unit 205, the bias update unit 206, and the end determination unit 207A are implemented in a calculation device 20A. Among the configurations according to the second embodiment, the same reference numerals are used for the same components as those in the positioning system 100 according to the first embodiment, and the description of each component is omitted. In this embodiment, if the forklift 1A is charging, the forklift 1A does not move during that time, and it is considered that an IMU measurement value suitable for calculating a bias value can be collected.

[0032] The measurement start determination unit 202A determines whether to start accumulating the IMU measurement values ​​based on a notification of the charge / discharge state from the vehicle charging system 15. For example, when the measurement start determination unit 202A receives a notification of the start of charging from the vehicle charging system 15, it determines to start accumulating the IMU measurement values.

[0033] The end determination unit 207A determines whether to end the accumulation of the IMU measurement values ​​based on a charge / discharge state notification from the vehicle charging system 15. For example, the measurement start determination unit 202A determines to end the accumulation of the IMU measurement values ​​when it receives a notification of charging completion from the vehicle charging system 15. Alternatively, the measurement start determination unit 202A determines to end the accumulation of the IMU measurement values ​​when the bias update unit 206 updates the bias.

[0034] (operation) Next, the bias estimation process by the positioning system 100A will be described with reference to Fig. 6. Fig. 6 is a flowchart showing an example of the bias estimation process according to the second embodiment. The measurement start determination unit 202A determines whether the forklift 1A is charging (step S11). When the measurement start determination unit 202A receives a notification of the start of charging from the vehicle charging system 15, it determines that the forklift 1A is charging. If the forklift 1A is not charging (step S11; False), the bias estimation process ends. If the forklift 1A is charging (step S11; True), the measurement start determination unit 202A determines to start accumulating IMU measurement values. The measurement start determination unit 202A commands the IMU measurement value accumulation unit 203 to start accumulating the IMU measurement values. Then, the IMU measurement value accumulation unit 203 acquires the measurement values ​​from the IMU 10 and accumulates the acquired IMU measurement values ​​(step S12). While the IMU measurement value accumulation unit 203 is accumulating the IMU measurement values, the end determination unit 207A monitors whether the forklift 1A is charging (step S13). The measurement start determination unit 202A determines that the forklift 1A is charging until it receives a notification of charging completion from the vehicle charging system 15, and determines that the forklift 1A is not charging after receiving the notification of charging completion. If the forklift 1A is not charging (step S13; False), the end determination unit 207A deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203 (step S17) and ends the bias estimation process.

[0035] If charging is in progress (step S13; True), the accumulated sample number monitor 204 determines whether a sufficient number of IMU measurement values ​​have been accumulated in the IMU measurement value accumulation unit 203 (step S14). If a sufficient number of IMU measurement values ​​have not been accumulated (step S14; False), the process of step S12 and subsequent steps is repeated. If a sufficient number of IMU measurement values ​​have been accumulated (step S14; True), the bias calculation unit 205 calculates a bias (step S15). For example, the bias calculation unit 205 calculates any one of the average, median, and mode of the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203. The bias calculation unit 205 outputs the calculated value to the bias update unit 206. The bias update unit 206 updates the bias of the positioning system 100A (step S16). For example, the bias update unit 206 outputs the latest bias calculated by the bias calculation unit 205 to the positioning system main body 201. The positioning system main body 201 compensates the IMU measurement value by using the bias value acquired from the bias update unit 206, and performs positioning of the forklift 1A. Next, the termination determination unit 207A deletes the IMU measurement value stored in the IMU measurement value storage unit 203 (step S17), and terminates the bias estimation process.

[0036] (effect) As described above, according to this embodiment, the IMU measurement values ​​are accumulated and the bias value is calculated for the electric forklift 1A by taking advantage of the fact that the vehicle is stationary during charging. When the forklift 1A is being charged, the forklift 1A is more likely to be stationary (unexpected situations are less likely to occur) than during the startup sequence of the positioning system 100A, so more stable and highly accurate bias estimation is possible, and the positioning can be performed with high accuracy.

[0037] In the second embodiment, as in the first embodiment, it may be confirmed that the forklift 1A is not in operation based on the measurement values ​​of the first encoder 11, the second encoder 12, the lifting height sensor 13, and the load sensor 14 (for example, steps S2 and S6 in FIG. 3), and the bias of the IMU measurement value may be calculated only when the forklift 1A is charging and not in operation.

[0038] <Third embodiment> A positioning system 100B according to a third embodiment of the present disclosure will be described below with reference to Figs. 7 and 8. In the first embodiment, the bias is estimated by confirming that the forklift 1 is not in operation during the startup sequence of the positioning system 100. In contrast, in the third embodiment, the bias of the IMU measurement value is estimated if the forklift 1 is not in operation, regardless of whether the startup sequence of the positioning system 100 is in progress or not. The configuration of the forklift according to the third embodiment is similar to that of the forklift 1 according to the first embodiment.

[0039] (Positioning system configuration) FIG. 7 is a diagram illustrating an example of a positioning system according to the third embodiment. As shown in Fig. 7, the positioning system 100B includes a positioning system main body 201, a measurement start determination unit 202B, an IMU measurement value accumulation unit 203, an accumulated sample number monitoring unit 204, a bias calculation unit 205, a bias update unit 206, an end determination unit 207B, an IMU 10, a first encoder 11, a second encoder 12, a lift sensor 13, and a load sensor 14. Of these, the positioning system main body 201, the measurement start determination unit 202B, the IMU measurement value accumulation unit 203, the accumulated sample number monitoring unit 204, the bias calculation unit 205, the bias update unit 206, and the end determination unit 207B are implemented in a calculation device 20B (not shown). Among the configuration according to the third embodiment, the same reference numerals are used for the same components as those in the positioning system 100 according to the first embodiment, and the description of each component is omitted.

[0040] The measurement start determination unit 202B confirms that the forklift 1 is stationary, and determines whether to start accumulating the IMU measurement values. The end determination unit 207B determines to end the accumulation of the IMU measurement values ​​when the forklift 1 starts some kind of operation. Other functions are similar to those of the end determination unit 207 in the first embodiment.

[0041] (operation) Next, the bias estimation process by the positioning system 100B will be described with reference to Fig. 8. Fig. 8 is a flowchart showing an example of the bias estimation process according to the third embodiment. The measurement start determination unit 202B determines whether the measurement values ​​by the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the height sensor 13 and the load sensor 14 (step S21). If the measurement values ​​of the first encoder 11 and the second encoder 12 are not 0, or the measurement value of the height sensor 13 or the measurement value of the load sensor 14 has changed (step S21; False), the bias estimation process is terminated.

[0042] When the measurement values ​​of the sensors satisfy the above condition (step S21; True), the measurement start determination unit 202B determines to start accumulating the IMU measurement values, and commands the IMU measurement value accumulation unit 203 to start accumulating the IMU measurement values. Then, the IMU measurement value accumulation unit 203 acquires the measurement values ​​from the IMU 10 and accumulates the acquired IMU measurement values ​​(step S22). While the IMU measurement value accumulation unit 203 accumulates the IMU measurement values, the end determination unit 207B determines whether the measurement values ​​of the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the lift sensor 13 and the load sensor 14 (step S23). When this condition is not satisfied (step S23; False), the end determination unit 207B deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203 (step S27), and ends the bias estimation process.

[0043] When the measurement values ​​of the sensors satisfy the above condition (Step S23; True), the accumulated sample number monitor 204 judges whether a sufficient number of IMU measurement values ​​have been accumulated in the IMU measurement value accumulation unit 203 (Step S24). When a sufficient number of IMU measurement values ​​have not been accumulated (Step S24; False), the process of Step S22 and the following steps is repeatedly executed. When a sufficient number of IMU measurement values ​​have been accumulated (Step S24; True), the bias calculation unit 205 calculates the bias (Step S25). Next, the bias update unit 206 updates the bias of the positioning system 100B (Step S26). The positioning system main body 201 compensates the IMU measurement values ​​using the bias updated by the bias update unit 206 to perform positioning of the forklift 1. Next, the end judgment unit 207B deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203 (Step S27), and ends the bias estimation process. The series of processes from Step S21 to S27 may be repeatedly executed while the forklift 1 is in operation.

[0044] (effect) As described above, according to this embodiment, even if the start-up sequence of the positioning system 100B is not in progress, the bias can be estimated as long as the forklift 1 is stationary. As a result, even if the operator performs some operation on the forklift 1 during the start-up sequence and misses the opportunity for bias estimation, the bias can be estimated if the conditions are met in another situation. In addition, since the bias of the IMU measurement value may change over time, even during the operation of the forklift 1, by finding a section where the vehicle is likely to be stationary and performing bias estimation based on the IMU measurement value measured in that section, positioning can always be performed using the (latest) bias after the change over time.

[0045] Incidentally, instead of or in addition to determining whether the forklift 1 is stationary based on the measurement values ​​of the first encoder 11, the second encoder 12, the lifting height sensor 13, and the load sensor 14, the measurement start determination unit 202B and the end determination unit 207B may be configured to detect whether the brakes are applied on the forklift 1, and the IMU measurement values ​​may be accumulated when the brakes are applied to estimate the bias. Note that the third embodiment can be combined with either the first or second embodiment.

[0046] <Fourth embodiment> Hereinafter, a positioning system 100C according to a fourth embodiment of the present disclosure will be described with reference to FIG. 9 to FIG. 10. In a manned forklift 1, an operator may perform work while the vehicle 2 is stopped. In this case, even if the traveling body 2 is stopped, the operator's movement may affect the IMU measurement value. Such operator movements include reading barcodes of loads, operating an in-vehicle terminal of a warehouse management system, unpacking / loading multiple loads on a pallet, and getting on / off the forklift 1. Each of these movements may cause the vehicle body to vibrate or change its posture. Therefore, in the fourth embodiment, a sudden change in the measurement value that is thought to be caused by the operator's movement is detected from the IMU measurement value, and the IMU measurement value around the detection timing is excluded from the calculation target of the bias estimation, thereby preventing the accuracy of the bias estimation from deteriorating. The configuration of the forklift according to the fourth embodiment is the same as that of the forklift 1 according to the first embodiment.

[0047] (Positioning system configuration) FIG. 9 is a diagram showing an example of a positioning system according to the fourth embodiment. The fourth embodiment can be combined with any of the configurations of the first to third embodiments, but FIG. 9 shows a configuration example in the case of combining with the third embodiment. As shown in FIG. 9, the positioning system 100C includes a positioning system main body 201, a measurement start determination unit 202B, an IMU measurement value accumulation unit 203C, an accumulated sample number monitoring unit 204, a bias calculation unit 205, a bias update unit 206, an end determination unit 207B, a measurement value sudden change detection unit 208, an IMU 10, a first encoder 11, a second encoder 12, a lift sensor 13, and a load sensor 14. Among these, the positioning system main body 201, the measurement start determination unit 202B, the IMU measurement value accumulation unit 203C, the accumulated sample number monitoring unit 204, the bias calculation unit 205, the bias update unit 206, the end determination unit 207B, and the measurement value sudden change detection unit 208 are implemented in a calculation device 20C (not shown). Among the components according to the fourth embodiment, the same components as those in the positioning system 100 according to the first embodiment are denoted by the same reference numerals, and the description of each component will be omitted. The measurement start determination unit 202B and the end determination unit 207B are as described in the third embodiment.

[0048] The IMU measurement value storage unit 203C has, in addition to the functions described in the first embodiment, a function for deleting data before and after a point where the IMU measurement value changes suddenly due to the action of the worker. The measurement value sudden change detection unit 208 refers to the IMU measurement value accumulated in the IMU measurement value accumulation unit 203C, detects a sudden change point from the accumulated IMU measurement value data, and notifies the IMU measurement value accumulation unit 203C of the result. The sudden change point of the IMU measurement value detected by the measurement value sudden change detection unit 208 can be applied to detection of not only the movement of the worker but also vibration caused by the sudden stop of the vehicle. The manned forklift 1 has a high vehicle speed during operation, and some vehicle body vibration may occur immediately after the vehicle stops. In such a situation, there may be cases where the accumulation of the IMU measurement value is started by, for example, the bias estimation process described in the third embodiment without any change in the measurement values ​​of the first encoder 11, the second encoder 12, the lifting height sensor 13, and the load sensor 14, but in reality, the vehicle body may vibrate and its influence may appear in the IMU measurement value. By applying the fourth embodiment, data that is not suitable for bias estimation can be removed from the IMU measurement value accumulated in such a situation.

[0049] (operation) Next, the bias estimation process by the positioning system 100C will be described with reference to Fig. 10. Fig. 10 is a flowchart showing an example of the bias estimation process according to the fourth embodiment. The measurement start determination unit 202B determines whether the measurement values ​​by the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the height sensor 13 and the load sensor 14 (step S31). If the measurement values ​​of the first encoder 11 and the second encoder 12 are not 0, or the measurement value of the height sensor 13 or the measurement value of the load sensor 14 has changed (step S31; False), the bias estimation process is terminated.

[0050] When the measurement values ​​of the sensors satisfy the above conditions (step S31; True), the measurement start determination unit 202B determines to start accumulating the IMU measurement values ​​and commands the IMU measurement value accumulation unit 203C to start accumulating the IMU measurement values. Then, the IMU measurement value accumulation unit 203C acquires the measurement values ​​from the IMU 10 and accumulates the acquired IMU measurement values ​​(step S32). While the IMU measurement value accumulation unit 203 accumulates the IMU measurement values, the end determination unit 207B determines whether the measurement values ​​of the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the lift sensor 13 and the load sensor 14 (step S33). When this condition is not satisfied (step S33; False), the end determination unit 207B deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203C (step S3B) and ends the bias estimation process.

[0051] If the measurement values ​​of each sensor satisfy the above conditions (step S33; True), the measurement value sudden change detection unit 208 refers to the IMU measurement values ​​stored in the IMU measurement value storage unit 203C (step S34). The measurement value sudden change detection unit 208 executes a sudden change detection process to detect a sudden change location from the stored data (step S35). The measurement value sudden change detection unit 208 determines whether or not a sudden change location has been detected (step S36). If a sudden change location has not been detected (step S36; False), the process proceeds to step S38. If a sudden change location has been detected (step S36; True), the measurement value sudden change detection unit 208 notifies the IMU measurement value storage unit 203C of information on the sudden change location (e.g., the start time and end time of the sudden change location). The IMU measurement value accumulation unit 203C deletes the sudden change point and the IMU measurement values ​​before and after it (a predetermined range before and after it in terms of time series) from the time series data of the accumulated IMU measurement values ​​(step S37).

[0052] Regarding the processing of steps S35 and S37, for example, the measurement value sudden change detection unit 208 identifies a section including data that deviates from the average IMU measurement value of the section by a certain width or more in a time-continuous section in the accumulated data as a sudden change portion. The IMU measurement value accumulation unit 203C deletes the IMU measurement values ​​of the identified section and before and after it (for example, 0.5 seconds before and after). Alternatively, the measurement value sudden change detection unit 208 applies a RANSAC (Random Sample Consensus) algorithm to the accumulated IMU measurement value data to distinguish between an outlier and a normal value. The IMU measurement value accumulation unit 203C deletes the IMU measurement value determined to be an outlier and before and after it. Alternatively, the measurement value sudden change detection unit 208 may detect a sudden change portion of the IMU measurement value by learning the data that does not include the sudden change portion remaining after step S37 and the data deleted in step S37 and building a model that distinguishes between them. For example, the measurement value sudden change detection unit 208 constructs a model using a k-nearest neighbor method or the like, and determines whether each piece of data stored in the IMU measurement value storage unit 203C belongs to a sudden change location based on this learned model. The IMU measurement value storage unit 203C deletes the data determined to belong to a sudden change location and the data before and after it.

[0053] Next, the accumulated sample number monitor 204 judges whether a sufficient number of IMU measurement values ​​have been accumulated in the IMU measurement value accumulation unit 203C (step S38). If a sufficient number of IMU measurement values ​​have not been accumulated (step S38; False), the process from step S32 onward is repeated. If a sufficient number of IMU measurement values ​​have been accumulated (step S38; True), the bias calculation unit 205 calculates the bias (step S39). Next, the bias update unit 206 updates the bias of the positioning system D (step S3A). The positioning system main body 201 compensates the IMU measurement values ​​using the bias updated by the bias update unit 206 to perform positioning of the forklift 1. Next, the end judgment unit 207B deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203C (step S3B), and ends the bias estimation process. The series of processes from step S31 to S3B may be repeatedly executed while the forklift 1 is in operation.

[0054] (effect) As described above, according to the present embodiment, it is possible to avoid the influence of the motion of the worker or the sudden stop of the forklift 1 on the bias estimation, and to estimate the bias more appropriately.

[0055] <Fifth embodiment> Hereinafter, bias estimation according to the fifth embodiment of the present disclosure will be described with reference to Figs. 11 to 13. Temperature change is one of the main factors that change the bias of the IMU measurement value. A manned forklift may move between a normal temperature area and a freezer or refrigerated warehouse, and since the temperature change is large, the bias is likely to change depending on the position of the forklift. Therefore, in the fifth embodiment, a temperature gauge attached to the vehicle body detects the surrounding temperature change, and the bias is estimated after the temperature change and when the vehicle is stationary.

[0056] In the first to fourth embodiments, the bias is estimated if the number of samples of the IMU measurement values ​​measured when it is determined that the forklift 1 to 1A is stationary is sufficient, but in consideration of the limited calculation resources of the arithmetic devices 20 to 20C (on-board devices), it may be better to reduce the number of times the bias estimation process is performed. Therefore, in the fifth embodiment, a series of bias estimation processes are performed only when the temperature change is equal to or greater than a reference value, thereby reducing the calculation load.

[0057] (Forklift configuration) FIG. 11 is a schematic view showing an example of a forklift according to the fifth embodiment. The forklift 1D includes a running body 2D, a loading device 3, and a calculation device 20D. The running body 2D is provided with a temperature sensor 16. The temperature sensor 16 measures the air temperature (air temperature value) around the forklift 1D. The temperature sensor 16 is connected to the calculation device 20D, and the air temperature value measured by the temperature sensor 16 is sent to the calculation device 20D. Other configurations of the forklift 1D are similar to those of the forklift 1 of the first embodiment.

[0058] (Positioning system configuration) FIG. 12 is a diagram showing an example of a positioning system according to the fifth embodiment. The fifth embodiment can be combined with any of the configurations of the first to fourth embodiments, but FIG. 12 shows a configuration example in the case of combining with the fourth embodiment. As shown in FIG. 12, the positioning system 100D includes a positioning system main body 201, a measurement start determination unit 202D, an IMU measurement value accumulation unit 203C, an accumulated sample number monitoring unit 204, a bias calculation unit 205, a bias update unit 206, an end determination unit 207B, a measurement value sudden change detection unit 208, a temperature value accumulation unit 209, a temperature change detection unit 210, an IMU 10, a first encoder 11, a second encoder 12, a lift sensor 13, a load sensor 14, and a temperature sensor 16. Among these, the positioning system main body 201, the measurement start determination unit 202D, the IMU measurement value accumulation unit 203C, the accumulated sample number monitoring unit 204, the bias calculation unit 205, the bias update unit 206, the end determination unit 207D, the measurement value sudden change detection unit 208, the temperature value accumulation unit 209, and the temperature change detection unit 210 are implemented in the calculation device 20D. Among the configuration according to the fifth embodiment, the same components as those in the positioning system 100 according to the first embodiment are denoted by the same reference numerals, and the description of each component will be omitted.

[0059] The temperature value accumulation unit 209 includes a storage medium such as a memory. The temperature value accumulation unit 209 acquires and accumulates air temperature values ​​from the temperature sensor 16. The temperature value accumulation unit 209 deletes data of the accumulated air temperature values ​​for which the time that has elapsed since measurement exceeds a certain time.

[0060] The temperature change detection unit 210 refers to the time-series temperature value data accumulated in the temperature value accumulation unit 209 and determines whether the temperature change is equal to or greater than a reference value. For example, the temperature change detection unit 210 determines that a temperature change has occurred if the difference between the average of the most recently acquired data (for example, several temperature values ​​going back from the latest temperature value, or temperature values ​​acquired in the most recent period, for example, 1 to 2 seconds) among the data accumulated in the temperature value accumulation unit 209 and the average of the data acquired before that is equal to or greater than a predetermined reference value.

[0061] When the measurement start determination unit 202D confirms that a temperature change has been detected by the temperature change detection unit 210, that no bias update has been performed after the detection, that the measurement values ​​of the first encoder 11 and / or the second encoder 12 are 0, and that the change in the measurement values ​​of the height sensor 13 and the load sensor 14 is 0, the measurement start determination unit 202D determines to start accumulating IMU measurement values. The end determination unit 207D is similar to the end determination unit 207B of the third embodiment.

[0062] (operation) Next, the bias estimation process by the positioning system 100D will be described with reference to Fig. 13. Fig. 13 is a flowchart showing an example of the bias estimation process according to the fifth embodiment. The temperature value accumulation unit 209 acquires the air temperature value from the temperature sensor 16 and accumulates the air temperature value (step S41). Next, the temperature change detection unit 210 refers to the accumulated air temperature value (step S42). The temperature change detection unit 210 calculates the temperature change (step S43). Next, the temperature change detection unit 210 determines whether the temperature change is equal to or greater than a reference (step S44). If the temperature change is less than the reference (step S44; False), the bias estimation process ends. If the calculated temperature change is equal to or greater than the reference (step S44; True), the temperature change detection unit 210 notifies the measurement start determination unit 202D that a temperature change has been detected. This starts the bias estimation process. The subsequent processes are the same as those in the fourth embodiment, and will be described briefly. When the measurement start determination unit 202D receives a notification of temperature change detection from the temperature change detection unit 210, it determines whether the measurement values ​​by the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the height sensor 13 and the load sensor 14 (step S45). If the measurement values ​​of the first encoder 11 and the second encoder 12 are not 0 or the measurement value of the height sensor 13 or the measurement value of the load sensor 14 has changed (step S45; False), the bias estimation process ends.

[0063] If the measurement values ​​of the sensors satisfy the above conditions (step S45; True), the measurement start determination unit 202D determines to start accumulating the IMU measurement values, and commands the IMU measurement value accumulation unit 203C to start accumulating the IMU measurement values. The IMU measurement value accumulation unit 203C acquires the measurement values ​​from the IMU 10 and accumulates the acquired IMU measurement values ​​(step S46). The end determination unit 207D determines whether the measurement values ​​from the first encoder 11 and / or the second encoder 12 are 0 and there is no change in the measurement values ​​of the lift sensor 13 and the load sensor 14 (step S47). If this condition is not satisfied (step S47; False), the end determination unit 207D deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203C (step S4F), and ends the bias estimation process.

[0064] If the measurement values ​​of each sensor satisfy the above condition (step S47; True), the measurement value sudden change detection unit 208 refers to the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203C (step S48). The measurement value sudden change detection unit 208 executes a sudden change detection process (step S49). The measurement value sudden change detection unit 208 determines whether or not a sudden change point has been detected (step S4A). If a sudden change point has not been detected (step S4A; False), the process proceeds to step S4C. If a sudden change point has been detected (step S4A; True), the IMU measurement value accumulation unit 203C deletes the sudden change point and the data before and after it from the time series data of the accumulated IMU measurement values ​​(step S4B).

[0065] Next, the accumulated sample number monitoring unit 204 judges whether a sufficient number of IMU measurement values ​​have been accumulated in the IMU measurement value accumulation unit 203C (step S4C). If a sufficient number of IMU measurement values ​​have not been accumulated (step S4C; False), the processing from step S46 onward is repeatedly executed. If a sufficient number of IMU measurement values ​​have been accumulated (step S4C; True), the bias calculation unit 205 calculates the bias (step S4D). Next, the bias update unit 206 updates the bias of the positioning system 100D (step S4E). Next, the end judgment unit 207D deletes the IMU measurement values ​​accumulated in the IMU measurement value accumulation unit 203C (step S4F) and ends the bias estimation processing. The series of processes from step S41 to S4F may be repeatedly executed while the forklift 1D is in operation.

[0066] (effect) As described above, according to this embodiment, the bias estimation and update are performed only when there is a temperature change, which is the main cause of the bias change, so that the calculation load can be reduced while ensuring the positioning accuracy.

[0067] 14 is a diagram showing an example of the hardware configuration of the positioning system according to each embodiment. A computer 900 includes a CPU 901, a main storage device 902, an auxiliary storage device 903, an input / output interface 904, and a communication interface 905. The above-mentioned arithmetic units 20 to 20D are implemented in a computer 900. The above-mentioned functions are stored in the auxiliary storage device 903 in the form of a program. The CPU 901 reads the program from the auxiliary storage device 903, loads it in the main storage device 902, and executes the above-mentioned processing in accordance with the program. The CPU 901 also secures a storage area in the main storage device 902 in accordance with the program. The CPU 901 also secures a storage area in the auxiliary storage device 903 for storing data being processed in accordance with the program.

[0068] In addition, a program for realizing all or part of the functions of the arithmetic devices 20 to 20D may be recorded in a computer-readable recording medium, and the program recorded in the recording medium may be read into a computer system and executed to perform processing by each functional unit. The term "computer system" as used herein includes hardware such as an OS and peripheral devices. In addition, if a WWW system is used, the term "computer system" also includes a homepage providing environment (or display environment). In addition, the term "computer-readable recording medium" refers to a portable medium such as a CD, DVD, or USB, or a storage device such as a hard disk built into a computer system. In addition, if the program is distributed to the computer 900 through a communication line, the computer 900 that receives the program may expand the program in the main storage device 902 and execute the above processing. In addition, the above program may be for realizing part of the above-mentioned functions, and may further be capable of realizing the above-mentioned functions in combination with a program already recorded in the computer system.

[0069] As described above, several embodiments according to the present disclosure have been described, but all of these embodiments are presented as examples and are not intended to limit the scope of the invention. These embodiments can be implemented in various other forms, and various omissions, substitutions, and modifications can be made without departing from the gist of the invention. These embodiments and their modifications are included in the scope of the invention and its equivalents as described in the claims, as well as in the scope and gist of the invention.

[0070] <Additional Notes> The bias estimation device, the forklift, the bias estimation method, and the program described in each embodiment can be understood, for example, as follows.

[0071] (1) A bias estimation device (calculation device 20-20D) according to a first aspect includes a determination unit (measurement start determination unit 202-202D, end determination unit 207-207D) that determines whether the forklift is stationary or not based on a measurement value by a first sensor (first encoder 11, second encoder 12) that detects information regarding the movement of the forklift 1-1D and a measurement value by a second sensor (lifting height sensor 13, load sensor 14) that detects information regarding a loading device of the forklift, a storage unit (IMU measurement value storage unit 203, 203C) that accumulates an IMU measurement value, which is a measurement value by an inertial measurement unit (IMU 10) equipped in the forklift, when the determination unit determines that the forklift is stationary, and stops accumulating the IMU measurement value when the determination unit determines that the forklift is not stationary, and a calculation unit (bias calculation unit 205) that calculates a bias of the IMU measurement value based on the IMU measurement value accumulated in the storage unit. This allows the bias to be estimated with high accuracy.

[0072] (2) A bias estimation device according to a second aspect is a bias estimation device of (1), wherein the determination unit determines that the forklift is stationary if a first condition is satisfied in which the measurement value by the first sensor does not indicate that the forklift is moving and the measurement value by the second sensor does not indicate that the forklift is performing a loading / unloading operation, and determines that the forklift is not stationary if the first condition is not satisfied. This makes it possible to determine with high accuracy whether the forklift is stationary or not (third embodiment).

[0073] (3) A bias estimation device according to a third aspect is the bias estimation device of (2), wherein the judgment unit acquires information as to whether the inertial measurement unit is activated or not, and if the inertial measurement unit is activated and satisfies the first condition, judges that the forklift is stationary, and if not, judges that the forklift is not stationary. This makes it possible to determine with high accuracy whether the forklift is stationary or not (first embodiment).

[0074] (4) A bias estimation device according to a fourth aspect is a bias estimation device of (1) to (3), wherein the judgment unit acquires information on whether the forklift is charging or not, and if charging, judges that the forklift is stationary, and if not charging, judges that the forklift is not stationary. This makes it possible to determine whether the forklift is stationary or not (second embodiment).

[0075] (5) A bias estimation device according to a fifth aspect is a bias estimation device according to any one of (1) to (4), further comprising a sudden change point detection unit that detects a sudden change point in the IMU measurement value stored in the storage unit, wherein the storage unit deletes the IMU measurement value of the stored point detected by the sudden change point detection unit from the stored IMU measurement values, and the calculation unit calculates the bias based on the IMU measurement value after deletion. This makes it possible to perform bias estimation by removing data that is not suitable for bias estimation and that is mixed in with the IMU measurement values ​​stored in the storage unit.

[0076] (6) A bias estimation device according to a sixth aspect is a bias estimation device according to any one of (1) to (5), further comprising a temperature value accumulation unit that accumulates time-series temperature data on the ambient temperature of the forklift, and a temperature change detection unit that detects whether the ambient temperature has changed by more than a reference value based on the time-series temperature data accumulated in the temperature value accumulation unit, and the accumulation unit accumulates the IMU measurement value when the temperature change detection unit determines that the ambient temperature has changed by more than a reference value and the determination unit determines that the forklift is stationary. By estimating the bias, which is easily affected by temperature changes, only when there is a temperature change, it is possible to reduce the calculation load while ensuring the accuracy of the bias.

[0077] (7) A bias estimation device according to a seventh aspect is a bias estimation device of (1) to (7), wherein the first sensor is a sensor that detects the rotation speed and / or total steering angle of tires equipped on the forklift, and the second sensor is a sensor that detects the raised position of forks equipped on the forklift and / or the weight of cargo loaded on the forks. This makes it possible to detect whether the forklift is moving or rotating, or whether loading and unloading operations are being performed using the forklift, and to determine whether the forklift is stationary from both perspectives.

[0078] (8) A bias estimation device (calculation device 20B) according to an eighth aspect includes a judgment unit (measurement start judgment unit 202A, end judgment unit 207A) that acquires information on whether or not a forklift is charging, judges that the forklift is stationary if the forklift is charging, and judges that the forklift is not stationary if the forklift is not charging, an accumulation unit (IMU measurement value accumulation units 203, 203C) that accumulates IMU measurement values, which are measurements made by an inertial measurement unit (IMU10) equipped in the forklift, if the judgment unit determines that the forklift is stationary, and stops accumulating the IMU measurement values ​​if the judgment unit determines that the forklift is not stationary, and a calculation unit (bias calculation unit 205) that calculates a bias of the IMU measurement values ​​based on the IMU measurement values ​​accumulated in the accumulation unit. By performing bias estimation by utilizing the fact that the forklift is stationary during charging, the bias can be estimated with high accuracy (second embodiment).

[0079] (9) A forklift according to a ninth aspect includes a bias estimation device according to any one of (1) to (7), a positioning device (positioning system main body 201) that compensates for the IMU measurement value using the bias estimation device to estimate a position of the forklift, a running body, and a loading device.

[0080] (10) A bias estimation method according to a tenth aspect includes the steps of: repeatedly determining whether the forklift is stationary based on a measurement value by a first sensor that detects information related to movement of the forklift and a measurement value by a second sensor that detects information related to a loading device equipped on the forklift; accumulating an IMU measurement value, which is a measurement value by an inertial measurement unit equipped on the forklift, if it is determined in the determining step that the forklift is stationary; stopping the accumulation of the IMU measurement values, if it is determined in the determining step that the forklift is not stationary; and calculating a bias of the IMU measurement value based on the accumulated IMU measurement values.

[0081] (11) A program according to an eleventh aspect causes a computer 900 to execute the steps of repeatedly determining whether the forklift is stationary or not based on a measurement value by a first sensor that detects information regarding the movement of the forklift and a measurement value by a second sensor that detects information regarding a loading device equipped on the forklift, accumulating an IMU measurement value, which is a measurement value by an inertial measurement unit equipped on the forklift, if it is determined in the determining step that the forklift is stationary, stopping the accumulation of the IMU measurement values ​​if it is determined in the determining step that the forklift is not stationary, and calculating a bias of the IMU measurement value based on the accumulated IMU measurement values. [Explanation of symbols]

[0082] 100, 100A, 100B, 100C, 100D... Positioning system 1, 1A, 1D...Forklift 2. Traveling body 3. Cargo handling equipment 4. Fork 5. Lifting device 10. IMU 11 First encoder 12 Second encoder 13. Height sensor 14...Load sensor 15. Vehicle charging system 16 Temperature sensor 20, 20A, 20B, 20C, 20D...Arithmetic unit 201 Positioning system main unit 202, 202B, 202D: Measurement start determination section 203C···IMU measurement value storage unit 204: Accumulated sample number monitoring unit 205 Bias calculation unit 206 Bias update unit 207, 207B, 207D... Completion determination section 208... Measurement value sudden change detection unit 209 Temperature value storage unit 210 Temperature change detection unit 900...Computer 901···CPU 902...Main memory 903...Auxiliary storage device 904 Input / Output Interface 905 Communication Interface

Claims

1. a determination unit that determines whether the forklift is stationary based on a measurement value obtained by a first sensor that detects information related to the movement of the forklift and a measurement value obtained by a second sensor that detects information related to a loading device provided on the forklift; a storage unit that stores an IMU measurement value, which is a measurement value by an inertial measurement unit provided in the forklift, when the determination unit determines that the forklift is stationary, and stops storing the IMU measurement value when the determination unit determines that the forklift is not stationary; a sample number monitoring unit that determines that a sufficient number of samples for calculating a bias of the IMU measurement value is obtained when the number of the IMU measurement values ​​stored in the storage unit becomes equal to or greater than a threshold value; a calculation unit that calculates a bias of the IMU measurement value based on the IMU measurement value stored in the storage unit when the sample number monitoring unit determines that a sufficient number of samples has been obtained; an end determination unit that deletes the IMU measurement value stored in the storage unit when the calculation unit ends the bias calculation or when the determination unit determines that the IMU measurement value is not stationary; A bias estimation device comprising:

2. The determination unit determines that the forklift is stationary if a first condition is satisfied, that is, the measurement value by the first sensor does not indicate that the forklift is moving and the measurement value by the second sensor does not indicate that the forklift is performing a loading / unloading operation, and determines that the forklift is not stationary if the first condition is not satisfied. The bias estimation apparatus according to claim 1 .

3. the determination unit acquires information as to whether the inertial measurement unit is activated or not, and if the inertial measurement unit is activated and the first condition is satisfied, determines that the forklift is stationary, and if not, determines that the forklift is not stationary. The bias estimation device according to claim 2 .

4. The determination unit acquires information on whether the forklift is charging or not, and determines that the forklift is stationary if the forklift is charging, and determines that the forklift is not stationary if the forklift is not charging. The bias estimation device according to claim 1 or 2.

5. A sudden change point detection unit that detects a sudden change point of the IMU measurement value stored in the storage unit, The storage unit deletes the sudden change point detected by the sudden change point detection unit and the IMU measurement values ​​before and after the sudden change point, The calculation unit calculates the bias based on the IMU measurement value remaining after the deletion, The sudden change portion detection unit identifies, as the sudden change portion, a section including data that deviates from an average of the IMU measurement values ​​in a time-continuous section in the accumulated data by a certain amount or more. The bias estimation device according to claim 1 or 2.

6. Further comprising a sudden change detection unit that applies a RANSAC (Random Sample Consensus) algorithm to the data stored in the storage unit to distinguish between outliers and normal values, The storage unit deletes the IMU measurement value determined to be an outlier by the sudden change point detection unit and the IMU measurement values ​​before and after the outlier, The calculation unit calculates the bias based on the IMU measurement value remaining after the deletion. The bias estimation device according to claim 1 or 2.

7. The sudden change point detection unit learns the IMU measurement values ​​that do not include the sudden change points and the deleted IMU measurement values, constructs a model to distinguish between them, and determines whether the IMU measurement values ​​stored in the storage unit are IMU measurement values ​​that belong to the deleted IMU measurement values ​​based on the model, The storage unit deletes the IMU measurement value determined to belong to the deleted IMU measurement value and data before and after the IMU measurement value. The bias estimation device according to claim 5 .

8. A temperature value storage unit that stores time-series temperature data regarding the ambient temperature of the forklift; a temperature change detection unit that detects whether the ambient temperature has changed by a reference value or more based on the time-series temperature data stored in the temperature value storage unit; Further equipped with The storage unit stores the IMU measurement value when the temperature change detection unit determines that the ambient temperature has changed by a reference value or more and the determination unit determines that the vehicle is stationary. The bias estimation device according to claim 1 or 2.

9. The first sensor is a sensor for detecting a rotation speed and / or a total steering angle of tires of the forklift, and the second sensor is a sensor for detecting a lifting position of forks of the forklift and / or a weight of a load loaded on the forks. The bias estimation device according to claim 1 or 2.

10. a determination unit that acquires information on whether or not a forklift is charging, and determines that the forklift is stationary if the forklift is charging, and determines that the forklift is not stationary if the forklift is not charging; a storage unit that stores an IMU measurement value, which is a measurement value by an inertial measurement unit provided in the forklift, when the determination unit determines that the forklift is stationary, and stops storing the IMU measurement value when the determination unit determines that the forklift is not stationary; a sample number monitoring unit that determines that a sufficient number of samples for calculating a bias of the IMU measurement value is obtained when the number of the IMU measurement values ​​stored in the storage unit becomes equal to or greater than a threshold value; a calculation unit that calculates a bias of the IMU measurement value based on the IMU measurement value stored in the storage unit when the sample number monitoring unit determines that a sufficient number of samples has been obtained; an end determination unit that deletes the IMU measurement value stored in the storage unit when the calculation unit ends the bias calculation or when the determination unit determines that the IMU measurement value is not stationary; A bias estimation device comprising:

11. A traveling body, a loading device, A bias estimation device according to claim 1 or 10, a positioning device that compensates the IMU measurement value by the bias estimation device and locates a position of the forklift based on the compensated IMU measurement value; A forklift equipped with:

12. a step of repeatedly determining whether the forklift is stationary based on a measurement value by a first sensor that detects information related to the movement of the forklift and a measurement value by a second sensor that detects information related to a loading device provided on the forklift; When it is determined that the forklift is stationary in the determining step, accumulating an IMU measurement value that is a measurement value by an inertial measurement unit provided in the forklift; When it is determined that the vehicle is not stationary in the determining step, stopping accumulation of the IMU measurement value and deleting the accumulated IMU measurement value; When the number of accumulated IMU measurement values ​​is equal to or greater than a threshold, determining that a sufficient number of samples is obtained to calculate a bias of the IMU measurement values; calculating a bias of the IMU measurement value based on the accumulated IMU measurement value when it is determined that a sufficient number of samples have been obtained in the step of determining that a sufficient number of samples have been obtained; When the bias calculation is completed, deleting the accumulated IMU measurement values; The bias estimation method has the following structure:

13. On the computer, a step of repeatedly determining whether the forklift is stationary based on a measurement value by a first sensor that detects information related to the movement of the forklift and a measurement value by a second sensor that detects information related to a loading device provided on the forklift; When it is determined that the forklift is stationary in the determining step, accumulating an IMU measurement value that is a measurement value by an inertial measurement unit provided in the forklift; When it is determined that the vehicle is not stationary in the determining step, stopping accumulation of the IMU measurement value and deleting the accumulated IMU measurement value; When the number of accumulated IMU measurement values ​​is equal to or greater than a threshold, determining that a sufficient number of samples is obtained to calculate a bias of the IMU measurement values; calculating a bias of the IMU measurement value based on the accumulated IMU measurement value when it is determined that a sufficient number of samples have been obtained in the step of determining that a sufficient number of samples have been obtained; When the bias calculation is completed, deleting the accumulated IMU measurement values; A program that executes the following.

Images