Event driven sensor (EDS) tracking of light emitting diode (LED) array
An event driven sensor (EDS) is used for simultaneous localization and mapping (SLAM) and in particular is used in conjunction with a constellation of light emitting diodes (LED) to simultaneously localize all LEDs and track EDS pose in space. The EDS may be stationary or moveable and can track moveable LED constellations as rigid bodies. Each individual LED is distinguished at a high rate using minimal computational resources (no image processing). Thus, instead of a camera and image processing, rapidly pulsing LEDs detected by the EDS are used for feature points such that EDS events are related to only one LED at a time.
1. A system comprising:
at least one light emitting diode (LED) assembly configured to cause individual LEDs in the assembly to emit light one LED at a time;
at least one event driven sensor (EDS) configured to output signals representing changes in illumination intensity responsive to LED emissions; and
at least one processor configured with instructions to:
determine initial triangulation and pose estimation at least in part by:
receive at least first and second frames from the EDS generated using plural events from different LEDs;
determine, from the first and second frames, a fundamental matrix;
compute an essential matrix from the fundamental matrix;
decompose the essential matrix into four motion hypotheses;
select a first one of the four motion hypotheses based on the first motion hypothesis having no outliers; and
use the first motion hypothesis execute simultaneous localization and mapping (SLAM) by triangulating new LED positions using the first motion hypothesis as a reference.
2. The system of claim 1 , wherein the EDS is moveable, and the LED assembly is stationary.
3. The system of claim 1 , wherein the EDS is not moveable, and the LED assembly is moveable.
4. The system of claim 1 , wherein the EDS and LED assembly are both moveable.
5. The system of claim 1 , wherein the EDS is a first EDS and the system comprises a second EDS to facilitate the processor determining stereo simultaneous localization and mapping (SLAM).
6. The system of claim 1 , wherein the EDS is a first EDS and the processor receives information only from the first EDS and no other EDS to determine monocular simultaneous localization and mapping (SLAM).