SYSTEM AND METHOD FOR SIMULTANEOUS LOCALIZATION AND MAP BUILDING
First Claim
1. An autonomous vehicle comprising:
- at least one image sensor to provide measurements of landmark position for a plurality of landmarks; and
processing functionality to estimate the position of the plurality of landmarks in a global frame and in the autonomous vehicle'"'"'s frame, and to estimate the kinematic state of the autonomous vehicle in a global frame based, at least in part, on the measurements of landmark position from the at least one image sensor;
wherein the processing functionality is further operable to calculate errors in the estimated positions of the plurality of landmarks in the global frame and in the estimate of the kinematic state of the autonomous vehicle in the global frame by using a plurality of unit projection vectors between the estimated positions of the plurality landmarks in the autonomous vehicle'"'"'s frame and a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the global frame.
1 Assignment
0 Petitions
Accused Products
Abstract
An autonomous vehicle comprises at least one image sensor to provide measurements of landmark position for a plurality of landmarks; and processing functionality to estimate the position of the plurality of landmarks in a global frame and in the autonomous vehicle'"'"'s frame, and to estimate the kinematic state of the autonomous vehicle in a global frame based, at least in part, on the measurements of landmark position from the at least one image sensor. The processing functionality is further operable to calculate errors in the estimated positions of the plurality of landmarks in the global frame and in the estimate of the kinematic state of the autonomous vehicle in the global frame by using a plurality of unit projection vectors between the estimated positions of the plurality landmarks in the autonomous vehicle'"'"'s frame and a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the global frame.
-
Citations
20 Claims
-
1. An autonomous vehicle comprising:
-
at least one image sensor to provide measurements of landmark position for a plurality of landmarks; and processing functionality to estimate the position of the plurality of landmarks in a global frame and in the autonomous vehicle'"'"'s frame, and to estimate the kinematic state of the autonomous vehicle in a global frame based, at least in part, on the measurements of landmark position from the at least one image sensor; wherein the processing functionality is further operable to calculate errors in the estimated positions of the plurality of landmarks in the global frame and in the estimate of the kinematic state of the autonomous vehicle in the global frame by using a plurality of unit projection vectors between the estimated positions of the plurality landmarks in the autonomous vehicle'"'"'s frame and a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the global frame. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A method of operating an autonomous vehicle, the method comprising:
-
receiving a measurement of landmark position for each of a plurality of landmarks from at least one image sensor; estimating the kinematic state of the autonomous vehicle in a global frame based, at least in part, on the received measurements from the at least one image sensor; estimating a position of the plurality of landmarks in a frame of the autonomous vehicle and in the global frame based on the received measurements from the at least one image sensor; forming a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the global frame; forming a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the frame of the autonomous vehicle; and calculating heading angle drift errors based on the plurality of unit projection vectors in the global frame and the plurality of unit projection vectors in the frame of the autonomous vehicle; and updating the estimate of the kinematic state of the autonomous vehicle in the global frame based on the calculated heading angle drift errors. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. A program product comprising a processor-readable medium on which program instructions are embodied, wherein the program instructions are operable, when executed by at least one programmable processor included in a device in an autonomous vehicle, to cause the device to:
-
calculate a position estimate of a plurality of landmarks in a frame of the autonomous vehicle based on measurements received from at least one image sensor; calculate a position estimate of the plurality of landmarks in a global frame based on measurements received from the at least one image sensor; form a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the global frame; form a plurality of unit projection vectors between the estimated positions of the plurality of landmarks in the frame of the autonomous vehicle; and calculate heading angle drift errors based on the plurality of unit projection vectors in the global frame and the plurality of unit projection vectors in the frame of the autonomous vehicle. - View Dependent Claims (16, 17, 18, 19, 20)
-
Specification