Navigation apparatus and navigation method with image recognition

1. A navigation apparatus with image recognition, comprising:

an imaging section for obtaining a stereo image of a target spot;

an inertial information detecting section for measuring an attitude angle of a body and an acceleration of the body;

an image process calculating section for calculating a relative position of the body with respect to the target spot based on the stereo image and the attitude angle; and

a navigation calculating section which comprises a position calculating section for calculating a body position based on the acceleration; and a position error calculating unit for calculating a position error by comparing between the relative position and the body position, and wherein said navigation calculating section for calculating navigation information calculates navigation information on the basis of attitude angle, the acceleration and the position error.

2. The apparatus according to claim 1 , wherein the position calculating section comprises:

a velocity calculating unit for calculating velocity by integrating the acceleration; and

a position calculating unit for calculating the body position by integrating the velocity, and

the apparatus corrects the acceleration, the velocity and the body position based on the position error and outputs the corrected velocity and the corrected body position as the navigation information.

3. The apparatus according to claim 2 , wherein the navigation calculating section comprises:

an error estimating filter for estimating errors of the acceleration, the velocity and the body position based on the position error calculated by the position error calculating unit.

4. The apparatus according to claim 3 , wherein the error estimating filter is one of a linear filter and a Kalman filter.

5. The apparatus according to claim 1 , wherein the navigation information includes at least one of the acceleration of the body with respect to the target spot, a velocity of the body with respect to the target spot, the relative position of the body with respect to the target spot, an acceleration error correction value of the body, a velocity error correction value of the body and a position error correction value of the body.

6. A navigation method with image recognition comprising:

obtaining a stereo image of a target spot;

measuring an attitude angle of a body and an acceleration of the body;

calculating a relative position of the body with respect to the target spot based on the stereo image and the attitude angle;

calculating a body position based on the acceleration;

calculating a position error by comparing between the relative position and the body position; and

calculating navigation information based on the attitude angle, the acceleration and the position error.

7. The method according to claim 6 , wherein calculating the navigation information comprises:

calculating a velocity by integrating the acceleration;

calculating the body position by integrating the velocity;

correcting the acceleration, the velocity and the body position based on the position error; and

outputting the corrected velocity and the corrected body position as the navigation information.

8. The method according to claim 7 , further comprising:

estimating errors of the acceleration, the velocity and the body position based on the calculated position error.

9. The method according to claim 8 , wherein the estimating the errors is performed by using one of a linear filter and a Kalman filter.

10. The method according to claim 6 , wherein the navigation information includes at least one of the acceleration of the body with respect to the target spot, a velocity of the body with respect to the target spot, the relative position of the body with respect to the target spot, an acceleration error correction value of the body, a velocity error correction value of the body and a position error correction value of the body.

11. The method according to claim 6 , further comprises automatically operating the body based on the navigation information.

12. The method according to claim 11 , wherein the automatically operating the body includes operating the body to land based on the navigation information.

13. The method according to claim 11 , wherein the automatically operating the body includes operating the body to take off based on the navigation information.

14. The method according to claim 11 , wherein the automatically operating the body includes operating the body to hover based on the navigation information.