Lost vehicle recovery utilizing associated feature pairs
First Claim
1. A materials handling vehicle comprising a camera, one or more vehicular processors, a drive mechanism configured to move the materials handling vehicle along an inventory transit surface, a materials handling mechanism configured to store and retrieve goods in a storage bay of an industrial facility, and vehicle control architecture in communication with the drive and materials handling mechanisms, wherein:
- the camera is communicatively coupled to the vehicular processor(s) and captures an input image of overhead features;
an industrial facility map comprises a plurality of three-dimensional global feature points associated with a mapping of the overhead features; and
the vehicular processor(s) of the materials handling vehicle executes vehicle functions to;
(i) determine a localized position of the materials handling vehicle with respect to an inventory transit surface of the industrial facility based on a seed position of the materials handling vehicle in the industrial facility and a dead reckoning associated with the materials handling vehicle;
(ii) use an initial set of camera data from the camera comprising two-dimensional UV space information to provide corrective feedback for the localized position;
(iii) use the localized position to track navigation of the materials handling vehicle along the inventory transit surface, navigate the materials handling vehicle along the inventory transit surface in at least a partially automated manner, or both;
(iv) determine if the materials handling vehicle is lost based on whether the industrial facility seed position comprises incorrect data, whether the camera data is insufficient to correct for an error associated with the dead reckoning, or both;
(v) if lost, create a plurality of associated feature pairs by retrieving a subsequent set of camera data from the camera comprising two-dimensional UV space information, forming pairs from the UV space information, and associating pairs from the UV space information with pairs from the plurality of three-dimensional global feature points of the industrial facility map;
(vi) calculate respective vehicle poses for associated feature pairs within a visual range of the camera;
(vii) calculate a best estimate pose of the materials handling vehicle from the calculated vehicle poses based on a highest-rated pair of the plurality of associated feature pairs;
(viii) use accumulated odometry to update the best estimate pose to a current localized position;
(ix) update the seed position as the current localized position; and
(x) operate the materials handling vehicle utilizing the updated seed position.
2 Assignments
0 Petitions
Accused Products
Abstract
According to the embodiments described herein, a method for lost vehicle recovery utilizing associated feature pairs may include, for a materials handling vehicle determined to be lost, creating a plurality of associated feature pairs by retrieving a subsequent set of camera data from a camera comprising two-dimensional UV space information, forming pairs from the UV space information, and associating each formed pair with pairs from each of a plurality of three-dimensional global feature points of an industrial facility map. The method may further include calculating a best estimate pose from calculated vehicle poses of the associated feature pairs based on a highest-rated pair of the plurality of associated feature pairs, using an accumulated odometry to update the best estimate pose to a current localized position, updating the seed position as the current localized position, and operating the materials handling vehicle utilizing the updated seed position.
43 Citations
25 Claims
-
1. A materials handling vehicle comprising a camera, one or more vehicular processors, a drive mechanism configured to move the materials handling vehicle along an inventory transit surface, a materials handling mechanism configured to store and retrieve goods in a storage bay of an industrial facility, and vehicle control architecture in communication with the drive and materials handling mechanisms, wherein:
-
the camera is communicatively coupled to the vehicular processor(s) and captures an input image of overhead features; an industrial facility map comprises a plurality of three-dimensional global feature points associated with a mapping of the overhead features; and the vehicular processor(s) of the materials handling vehicle executes vehicle functions to; (i) determine a localized position of the materials handling vehicle with respect to an inventory transit surface of the industrial facility based on a seed position of the materials handling vehicle in the industrial facility and a dead reckoning associated with the materials handling vehicle; (ii) use an initial set of camera data from the camera comprising two-dimensional UV space information to provide corrective feedback for the localized position; (iii) use the localized position to track navigation of the materials handling vehicle along the inventory transit surface, navigate the materials handling vehicle along the inventory transit surface in at least a partially automated manner, or both; (iv) determine if the materials handling vehicle is lost based on whether the industrial facility seed position comprises incorrect data, whether the camera data is insufficient to correct for an error associated with the dead reckoning, or both; (v) if lost, create a plurality of associated feature pairs by retrieving a subsequent set of camera data from the camera comprising two-dimensional UV space information, forming pairs from the UV space information, and associating pairs from the UV space information with pairs from the plurality of three-dimensional global feature points of the industrial facility map; (vi) calculate respective vehicle poses for associated feature pairs within a visual range of the camera; (vii) calculate a best estimate pose of the materials handling vehicle from the calculated vehicle poses based on a highest-rated pair of the plurality of associated feature pairs; (viii) use accumulated odometry to update the best estimate pose to a current localized position; (ix) update the seed position as the current localized position; and (x) operate the materials handling vehicle utilizing the updated seed position. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A system comprising a materials handling vehicle and a management server, wherein:
-
the materials handling vehicle comprises a camera, one or more vehicular processors, a drive mechanism configured to move the materials handling vehicle along an inventory transit surface, a materials handling mechanism configured to store and retrieve goods in a storage bay of an industrial facility, and vehicle control architecture in communication with the drive and materials handling mechanisms; the camera is communicatively coupled to the vehicular processor(s) and the management server and captures an input image of overhead features; the vehicular processor(s) is communicatively coupled to the management server; an industrial facility map stored in the management server is communicatively coupled to the vehicular processor(s), wherein the industrial facility map comprises a plurality of three-dimensional global feature points associated with a mapping of the overhead features; and the vehicular processor(s) of the materials handling vehicle executes vehicle functions to; (i) determine a localized position of the materials handling vehicle with respect to an inventory transit surface of the industrial facility based on a seed position of the materials handling vehicle in the industrial facility and a dead reckoning associated with the materials handling vehicle; (ii) use an initial set of camera data from the camera comprising two-dimensional UV space information to provide corrective feedback for the localized position; (iii) use the localized position to track the navigation of the materials handling vehicle along the inventory transit surface, navigate the materials handling vehicle along the inventory transit surface in at least a partially automated manner, or both; (iv) determine if the materials handling vehicle is lost; (v) if lost, create a plurality of associated feature pairs by retrieving a subsequent set of camera data from the camera comprising two-dimensional UV space information, form pairs from the UV space information, and associate pairs from the UV space information with pairs from the plurality of three-dimensional global feature points of the industrial facility map; (vi) calculate a vehicle pose for associated feature pairs within a visual range of the camera; (vii) calculate a best estimate pose of the materials handling vehicle based on a highest-rated pair of the plurality of associated feature pairs; (viii) use an accumulated odometry to update the best estimate pose to a current localized position; (ix) update the seed position as the current localized position; and (x) operate the materials handling vehicle utilizing the updated seed position. - View Dependent Claims (9, 10, 11, 12, 13, 14, 15, 16)
-
-
17. A method of navigating or tracking the navigation of a materials handling vehicle along an inventory transit surface, the method comprising:
-
disposing a materials handling vehicle on an inventory transit surface of an industrial facility, wherein the materials handling vehicle is in communication with a management server and comprises a camera, one or more vehicular processors, a drive mechanism configured to move the materials handling vehicle along the inventory transit surface, a materials handling mechanism configured to store and retrieve goods in a storage bay of the industrial facility, and vehicle control architecture in communication with the drive and materials handling mechanisms; utilizing the drive mechanism to move the materials handling vehicle along the inventory transit surface; capturing an input image of overhead features of the industrial facility via the camera as the materials handling vehicle moves along the inventory transit surface; providing an industrial facility map comprising a plurality of three-dimensional global feature points associated with a mapping of the ceiling lights; determining via the vehicular processor(s) a localized position of the materials handling vehicle with respect to an inventory transit surface of the industrial facility based on a seed position of the materials handling vehicle in the industrial facility and a dead reckoning associated with the materials handling vehicle; using an initial set of camera data from the camera comprising two-dimensional UV space information to provide corrective feedback for the localized position; via the vehicular processor(s) and using the localized position, tracking the navigation of the materials handling vehicle along the inventory transit surface, navigating the materials handling vehicle along the inventory transit surface in at least a partially automated manner, or both; determining if the materials handling vehicle is lost; if lost, creating a plurality of associated feature pairs by retrieving a subsequent set of camera data from the camera comprising two-dimensional UV space information, forming pairs from the UV space information, and associating pairs from the UV space information with pairs from the plurality of three-dimensional global feature points of the industrial facility map; via the vehicular processor(s), calculating a vehicle pose for associated feature pairs within a visual range of the camera; via the vehicular processor(s), calculating a best estimate pose of the materials handling vehicle based on a highest-rated pair of the plurality of associated feature pairs; using an accumulated odometry to update the best estimate pose to a current localized position via the vehicular processor(s); updating the seed position as the current localized position; and operating the materials handling vehicle utilizing the updated seed position. - View Dependent Claims (18, 19, 20, 21, 22, 23, 24, 25)
-
Specification