Constrained key frame localization and mapping for vision-aided inertial navigation
First Claim
1. A device comprising:
- an image source configured to produce image data for a first keyframe, one or more nonkeyframes, and a second keyframe along a trajectory of the device, the one or more non-keyframes located between the first keyframe and second keyframe along the trajectory;
an inertial measurement unit (IMU) configured to produce IMU data indicative of a motion of the device along the trajectory; and
a processor configured to;
process the IMU data and the image data to compute respective state estimates for a position and orientation of the device for the first keyframe and for the second keyframe;
process the image data associated with the non-keyframes to compute one or more constraints to the position and the orientation of the device for the second keyframe relative to the position and the orientation of the device for the first keyframe, wherein when computing the one or more constraints the processor is configured to treat a landmark observed within the image data for the first keyframe or the second keyframe as different from the same landmark observed within the image data for the non-keyframes; and
apply the one or more constraints when computing the state estimates of the device for the second keyframe.
1 Assignment
0 Petitions
Accused Products
Abstract
Estimation techniques for vision-aided inertial navigation are described. In one example, a vision-aided inertial navigation system (VINS) comprises an image source to produce image data for a keyframe and one or more non-keyframes along a trajectory, the one or more non-keyframes preceding the keyframe along the trajectory. The VINS comprises an inertial measurement unit (IMU) to produce IMU data indicative of a motion of the VINS along the trajectory for the keyframe and the one or more non-keyframes, and a processing unit comprising an estimator that processes the IMU data and the image data to compute state estimates of the VINS. The estimator computes the state estimates of the VINS for the keyframe by constraining the state estimates based on the IMU data and the image data for the one or more non-keyframes of the VINS without computing state estimates of the VINS for the one or more non-keyframes.
38 Citations
30 Claims
-
1. A device comprising:
-
an image source configured to produce image data for a first keyframe, one or more nonkeyframes, and a second keyframe along a trajectory of the device, the one or more non-keyframes located between the first keyframe and second keyframe along the trajectory; an inertial measurement unit (IMU) configured to produce IMU data indicative of a motion of the device along the trajectory; and a processor configured to; process the IMU data and the image data to compute respective state estimates for a position and orientation of the device for the first keyframe and for the second keyframe; process the image data associated with the non-keyframes to compute one or more constraints to the position and the orientation of the device for the second keyframe relative to the position and the orientation of the device for the first keyframe, wherein when computing the one or more constraints the processor is configured to treat a landmark observed within the image data for the first keyframe or the second keyframe as different from the same landmark observed within the image data for the non-keyframes; and apply the one or more constraints when computing the state estimates of the device for the second keyframe. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14)
-
-
15. A system comprising:
-
an image source to produce image data for a first keyframe, one or more non-keyframes, and a second keyframe along a trajectory of a vision-aided inertial navigation system (VINS), the one or more non-keyframes located between the first keyframe and second keyframe along the trajectory; an inertial measurement unit (IMU) to produce IMU data indicative of a motion of the VINS along the trajectory; and a processing unit comprising an estimator that processes the IMU data and the image data to compute respective state estimates for a position and orientation of the VINS for the first keyframe and for the second keyframe, wherein the estimator processes the image data associated with the non-keyframes to compute one or more constraints to the position and the orientation of the VINS for the second keyframe relative to the position and the orientation of the VINS for the first keyframe, wherein, when computing the one or more constraints, the processor is configured to treat a landmark observed within the image data for the first keyframe or the second keyframe as different from the same landmark observed within the image data for the non-keyframes, and wherein the estimator applies the one or more constraints when computing the state estimates of the VINS for the second keyframe. - View Dependent Claims (16, 17)
-
-
18. A method comprising:
-
producing, by an image source, image data for a first keyframe, one or more nonkeyframes, and a second keyframe along a trajectory of a vision-aided inertial navigation system (VINS), the one or more non-keyframes located between the first keyframe and second keyframe along the trajectory; producing, by an inertial measurement unit (IMU), IMU data indicative of a motion of the VINS along the trajectory; processing, by one or more processors, the IMU data and the image data to compute respective state estimates for a position and orientation of the VINS for the first keyframe and for the second keyframe; processing, by the one or more processors, the image data associated with the non-keyframes to compute one or more constraints to the position and the orientation of the VINS for the second keyframe relative to the position and the orientation of the VINS for the first keyframe, wherein, when computing the one or more constraints the processor is configured to treat a landmark observed within the image data for the first keyframe or the second keyframe as different from the same landmark observed within the image data for the non-keyframes; and applying, by one or more processors, the one or more constraints when computing the state estimates of the VINS for the second keyframe. - View Dependent Claims (19, 20)
-
-
21. A device comprising:
-
an image source configured to produce image data for a first keyframe, one or more nonkeyframes, and a second keyframe along a trajectory of the device, the one or more non-keyframes located between the first keyframe and second keyframe along the trajectory; an inertial measurement unit (IMU) configured to produce IMU data indicative of a motion of the device along the trajectory; and a processor configured to; process the image data associated with the non-keyframes to compute one or more constraints to a position of the device for the second keyframe relative to the position of the device for the first keyframe, wherein, when computing the one or more constraints, the processor is configured to treat a landmark observed within the image data for the first keyframe or the second keyframe as different from the same landmark observed within the image data for the non-keyframes; and determine, based on the IMU data, the image data, and the one or more constraints, the position of the device for one or more of the first keyframe and the second keyframe. - View Dependent Claims (22, 23, 24)
-
-
25. A device comprising:
-
an image source configured to produce image data for a first keyframe, one or more nonkeyframes, and a second keyframe along a trajectory of the device, wherein the one or more nonkeyframes are located between the first keyframe and second keyframe along the trajectory; and a processor configured to; compute, based on the image data associated with the nonkeyframes, one or more constraints to an estimate of a position of the device for the second keyframe relative to a position of the device for the first keyframe without computing estimates for positions of one or more landmarks that were observed only from the nonkeyframes; and compute, based on the image data associated with the first keyframe and the second keyframe and the one or more constraints, the estimate of the position of the device for the second keyframe relative to the position of the device for the first keyframe. - View Dependent Claims (26, 27, 28, 29, 30)
-
Specification