| 摘要 |
PROBLEM TO BE SOLVED: To prevent the deterioration of position calculating precision based on the pitch angle error of a moving body by correcting the speed error of the moving body by the difference between the pitch angle stored in a pitch angle memory part and the present pitch angle calculated by a pitch angle calculating part. SOLUTION: A pitch angle calculating part 25 calculates the pitch angle of a moving body 21 from the acceleration measured by an acceleration sensor 22, the calculated pitch angle is stored in an output memory part 26 for a prescribed time, and the acceleration is stored in an output part 27 for a prescribed time. A speed correcting part 28 corrects the speed of the moving body from the difference between the pitch angle stored in the output memory part 26 and the present pitch angle calculated by the pitch angle calculating part 25. An acceleration dispersion evaluating part 29 calculates the statistical evaluation of the acceleration stored in the output memory part 17. A moving distance calculating part 30 calculates the moving distance of the moving body 21 from the acceleration measured by the acceleration sensor 22 and the pitch angle calculated by the pitch angle calculating part 25, and calculates the position of the moving body 21 from the calculated moving distance and the moving azimuth calculated by a moving azimuth calculating part 24. |
