Method of estimating the motion of a carrier with respect to an environment and calculation device for navigation system
A method for estimating the motion of a carrier with respect to an environment in relation to which the carrier is moving. The carrier bearing a navigation sensor and a vision sensor producing images of the environment. In the images acquired by the vision sensor, the characteristic elements of the images representing characteristic elements of the environment are identified. At least one condensed measurement is calculated as a function of characteristic elements of at least two images acquired at different instants. The motion of the carrier by a navigation filter is estimated, as a function of navigation measurements carried out and as a function of the condensed measurement. The condensed measurement is calculated as a function furthermore of a priori estimation of the motion, as provided by the navigation filter.
1. A method for estimating a motion of a carrier with respect to an environment in relation to which the carrier is moving, the carrier bearing on board at least one navigation sensor and at least one vision sensor producing images of the environment, the method comprising the steps, performed by a calculation device, of:
identifying, in the images acquired by said at least one vision sensor, characteristic elements of the images representing characteristic elements of the environment;
calculating at least one condensed measurement as a function of the characteristic elements of at least two images acquired at different times, said at least one condensed measurement being representative of characteristics of the motion of the carrier during acquisition of said at least two images;
estimating the motion of the carrier by a navigation filter performed as a function of navigation measurements performed by said at least one navigation sensor and as a function of said at least one condensed measurement;
wherein said at least one condensed measurement is calculated as a function furthermore of an a priori estimation of the motion of the carrier provided by the navigation filter; and
estimating an error made in said at least one condensed measurement; estimating a relation between an error made in the a priori estimation of the motion of the carrier and the error made in said at least one condensed measurement; and wherein the navigation filter estimates the motion of the carrier as a function furthermore of the error made in said at least one condensed measurement, and as a function of the relation between the error made in the a priori estimation of the motion of the carrier and the error made in said at least one condensed measurement.
2. The method as claimed in claim 1 , wherein the navigation filter estimating the motion of the carrier is a Kalman filter.
3. The method as claimed in claim 1 , wherein the calculation device determines, during the calculation step, a condensed measurement representative of a ratio of distances traveled by the carrier between times of acquisition of two pairs of images of a triplet of images, as a function of characteristic elements of the images of the triplet representing the characteristic elements of the environment which are visible in each of the images of the triplet.
4. A method for estimating a motion of a carrier with respect to an environment in relation to which the carrier is moving, the carrier bearing on board at least one navigation sensor and at least one vision sensor producing images of the environment, the method comprising the steps, performed by a calculation device, of:
identifying, in the images acquired by said at least one vision sensor, characteristic elements of the images representing characteristic elements of the environment;
calculating at least one condensed measurement as a function of the characteristic elements of at least two images acquired at different times, said at least one condensed measurement being representative of characteristics of the motion of the carrier during acquisition of said at least two images;
estimating the motion of the carrier by a navigation filter performed as a function of navigation measurements performed by said at least one navigation sensor and as a function of said at least one condensed measurement;
wherein said at least one condensed measurement is calculated as a function furthermore of an a priori estimation of the motion of the carrier provided by the navigation filter; and
estimating an error made in the a priori estimation of the motion of the carrier; and calculating said at least one condensed measurement as a function furthermore of the error made in the a priori estimation of the motion.
5. The method as claimed in claim 4 , wherein the navigation filter estimating the motion of the carrier is a Kalman filter.
6. The method as claimed in claim 4 , wherein the calculation device determines, during the calculation step, a condensed measurement representative of a ratio of distances traveled by the carrier between times of acquisition of two pairs of images of a triplet of images, as a function of characteristic elements of the images of the triplet representing the characteristic elements of the environment which are visible in each of the images of the triplet.
7. A method for estimating a motion of a carrier with respect to an environment in relation to which the carrier is moving, the carrier bearing on board at least one navigation sensor and at least one vision sensor producing images of the environment, the method comprising the steps, performed by a calculation device, of:
identifying, in the images acquired by said at least one vision sensor, characteristic elements of the images representing characteristic elements of the environment;
calculating at least one condensed measurement as a function of the characteristic elements of at least two images acquired at different times, said at least one condensed measurement being representative of characteristics of the motion of the carrier during acquisition of said at least two images;
estimating the motion of the carrier by a navigation filter performed as a function of navigation measurements performed by said at least one navigation sensor and as a function of said at least one condensed measurement;
wherein said at least one condensed measurement is calculated as a function furthermore of an a priori estimation of the motion of the carrier provided by the navigation filter; and
wherein the a priori estimation of the motion of the carrier comprises estimating a rotation of the carrier.
8. The method as claimed in claim 7 , wherein the navigation filter estimating the motion of the carrier is a Kalman filter.
9. The method as claimed in claim 7 , wherein the calculation device determines, during the calculation step, a condensed measurement representative of a ratio of distances traveled by the carrier between times of acquisition of two pairs of images of a triplet of images, as a function of characteristic elements of the images of the triplet representing the characteristic elements of the environment which are visible in each of the images of the triplet.
10. A method for estimating a motion of a carrier with respect to an environment in relation to which the carrier is moving, the carrier bearing on board at least one navigation sensor and at least one vision sensor producing images of the environment, the method comprising the steps, performed by a calculation device, of:
identifying, in the images acquired by said at least one vision sensor, characteristic elements of the images representing characteristic elements of the environment;
calculating at least one condensed measurement as a function of the characteristic elements of at least two images acquired at different times, said at least one condensed measurement being representative of characteristics of the motion of the carrier during acquisition of said at least two images;
estimating the motion of the carrier by a navigation filter performed as a function of navigation measurements performed by said at least one navigation sensor and as a function of said at least one condensed measurement;
wherein said at least one condensed measurement is calculated as a function furthermore of an a priori estimation of the motion of the carrier provided by the navigation filter; and
wherein the a priori estimation of the motion of the carrier comprises estimating a translation of the carrier between times of acquisition of the images.
11. The method as claimed in claim 10 , wherein the navigation filter estimating the motion of the carrier is a Kalman filter.
12. The method as claimed in claim 10 , wherein the calculation device determines, during the calculation step, a condensed measurement representative of a ratio of distances traveled by the carrier between times of acquisition of two pairs of images of a triplet of images, as a function of characteristic elements of the images of the triplet representing the characteristic elements of the environment which are visible in each of the images of the triplet.
13. A computer program product recorded on a non-transitory computer readable media, comprising a set of program code instructions, when executed by a processor, configure the processor to perform the steps of the method as claimed in claim 1 to estimate the motion of the carrier.
14. A calculation device for a navigation system of a carrier bearing on board at least one navigation sensor and at least one vision sensor, and comprising at least one processor and at least one memory to perform the steps of the method as claimed in claim 1 to estimate the motion of the carrier.
15. A computer program product recorded on a non-transitory computer readable media, comprising a set of program code instructions, when executed by a processor, configure the processor to perform the steps of the method as claimed in claim 4 to estimate the motion of the carrier.
16. A calculation device for a navigation system of a carrier bearing on board at least one navigation sensor and at least one vision sensor, and comprising at least one processor and at least one memory to perform the steps of the method as claimed in claim 4 to estimate the motion of the carrier.
17. A computer program product recorded on a non-transitory computer readable media, comprising a set of program code instructions, when executed by a processor, configure the processor to perform the steps of the method as claimed in claim 7 to estimate the motion of the carrier.
18. A calculation device for a navigation system of a carrier bearing on board at least one navigation sensor and at least one vision sensor, and comprising at least one processor and at least one memory to perform the steps of the method as claimed in claim 7 to estimate the motion of the carrier.
19. A computer program product recorded on a non-transitory computer readable media, comprising a set of program code instructions, when executed by a processor, configure the processor to perform the steps of the method as claimed in claim 10 to estimate the motion of the carrier.
20. A calculation device for a navigation system of a carrier bearing on board at least one navigation sensor and at least one vision sensor, and comprising at least one processor and at least one memory to perform the steps of the method as claimed in claim 10 to estimate the motion of the carrier.