Three-dimensional triangulation and time-of-flight based tracking systems and methods

• US 9,377,533 B2
• Filed: 08/11/2015
• Issued: 06/28/2016
• Est. Priority Date: 08/11/2014
• Status: Active Grant

• Current Assignee: Gerard Dirk Smits
• Original Assignee: Samsung Electronics Co. Ltd.
• Inventors: Smits, Gerard Dirk
• Primary Examiner(s): Ratcliffe, Luke
• Assistant Examiner(s): Abraham, Samantha K
• Application Number:
  US14/823,668
• Publication Number:
  US 20160041266A1
• Time in Patent Office: 322 Days
• US Class Current: 1/1
• CPC Class Codes: G01S 17/10 using transmission of interrupted, pulse-modulated waves determination of distance by phase measurements G01S17/32
• CPC Class Codes: G01S 17/42 Simultaneous measurement of distance and other co-ordinates indirect measurement G01S17/46
• CPC Class Codes: G01S 17/48 Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than radio waves
• CPC Class Codes: G01S 17/66 Tracking systems using electromagnetic waves other than radio waves
• CPC Class Codes: G01S 7/4815 using multiple transmitters
• CPC Class Codes: G01S 7/4817 relating to scanning
• CPC Class Codes: G01S 7/4863 Detector arrays, e.g. charge-transfer gates
• CPC Class Codes: G01S 7/497 Means for monitoring or calibrating

Abstract

A three-dimension position tracking system is presented. The system includes transmitters and receivers. A transmitter scans continuous or pulsed coherent light beams across a target. The receiver detects the reflected beams. The system recursively determines the location of the target, as a function of time, via triangulation and observation of the time-of-flight of the incoming and outgoing beams. The transmitter includes ultra-fast scanning optics to scan the receiver'"'"'s field-of-view. The receiver includes arrays of ultra-fast photosensitive pixels. The system determines the angles of the incoming beams based on the line-of-sight of the triggered pixels. By observing the incoming angles and correlating timestamps associated with the outgoing and incoming beams, the system accurately, and in near real-time, determines the location of the target. By combining the geometry of the scattered beams, as well as the beams'"'"' time-of-flight, ambiguities inherent to triangulation and ambiguities inherent to time-of-flight location methods are resolved.

Claims

1. A system for tracking a target, comprising:

one or more transmitters that transmit one or more outgoing light beams at one or more outgoing angles towards the target;

one or more receivers that detect one or more incoming light beams at one or more incoming angles, wherein the one or more incoming light beams correspond to the one or more outgoing light beams that are reflected at the target;

a memory device for storing instructions; and

a processor device that executes the instructions to enable actions, comprising;

transmitting, by the one or more transmitters, the one or more outgoing light beams at the one or more outgoing angles towards the target;

detecting, by the one or more receivers, the one or more incoming light beams at the one or more incoming angles;

determining a proximate location of the target based on one or more of a location or a velocity of the target;

modifying the one or more outgoing angles based on the proximate location of the target; and

determining a precision location of the target based on iteratively determining one or more of a triangulation value for the one or more incoming light beams that correspond to the one or more outgoing light beams transmitting at the one or more modified outgoing angles, a time interval corresponding to a time-of-flight (ToF) of the one or more outgoing light beams transmitting at the one or more modified outgoing angles, or a combination of the triangulation value and the time interval.

2. The system of claim 1, wherein

the one or more transmitters include one or more transmitting optical components that scan the one or more outgoing light beams across a range of outgoing azimuth angles and a range of outgoing elevation angles of the one or more outgoing angles;

the one or more receivers include one or more receiving optical components that receive the one or more incoming light beams within a range of incoming elevation angles of the one or more incoming angles and focus the one or more incoming light beams to within a range of focused elevation angles that is less than the range of incoming elevation angles; and

a phase difference between the one or more receiving optical components and the one or more transmitting optical components is based on the time interval.

3. The system of claim 1, wherein transmitting the one or more outgoing light beams includes:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein wavelengths included in the first outgoing light beam are outside of a visible portion of an electromagnetic (EM) spectrum;

determining one or more first incoming angles based on detecting a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam corresponds to the first outgoing light beam that is reflected at the target; and

in response to detecting the first incoming light beam, transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at one or more second outgoing angles based on the one or more first incoming angles.

4. The system of claim 1, wherein the one or more transmitters include one or more transmitting optical components that collimate and scan the one or more outgoing light beams in a first direction and fan-out the one or more outgoing light beams in a second direction that is substantially orthogonal to the first direction.

5. The system of claim 1, wherein the actions further comprise:

determining one or more physical dimensions of the target, relative to one or more physical dimensions of a beam spot of the one or more outgoing light beams at the target, based on at least an intensity-temporal profile of the one or more incoming light beams.

6. The system of claim 1, wherein the actions further comprise:

determining a first incoming angle of a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a first detection location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at a second detection location and both the first and the second incoming light beams correspond to a first outgoing light beam of the one or more outgoing light beams that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first detection location and the second detection location.

7. The system of claim 1, wherein the actions further comprise:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein the first outgoing light beam is transmitted at a first location;

determining a first incoming angle based on a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a second location and corresponds to the first outgoing light beam that is reflected at the target;

transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at the first incoming angle and the second location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at the first location and corresponds to the second outgoing light beam that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first and the second locations.

8. The system of claim 1, wherein the one or more outgoing light beams are scanned in a Lissajous scanning pattern based on at least one of a proximate distance or a proximate physical dimension of the target.

9. A method for tracking a target, comprising:

transmitting, by one or more transmitters, one or more outgoing light beams at one or more outgoing angles towards the target;

detecting, by one or more receivers, one or more incoming light beams at one or more incoming angles;

determining a proximate location of the target based on one or more of a location or a velocity of the target;

modifying the one or more outgoing angles based on the proximate location of the target; and

determining a precision location of the target based on iteratively determining one or more of another triangulation value for the one or more incoming light beams that correspond to the one or more outgoing light beams transmitting at the one or more modified outgoing angles, a time interval corresponding to a time-of-flight (ToF) of the one or more outgoing light beams transmitting at the one or more modified outgoing angles, or a combination of the other triangulation value and the time interval.

10. The method of claim 9, wherein

the one or more transmitters include one or more transmitting optical components that scan the one or more outgoing light beams across a range of outgoing azimuth angles and a range of outgoing elevation angles of the one or more outgoing angles;

the one or more receivers include one or more receiving optical components that receive the one or more incoming light beams within a range of incoming elevation angles of the one or more incoming angles and focus the one or more incoming light beams to within a range of focused elevation angles that is less than the range of incoming elevation angles; and

a phase difference between the one or more receiving optical components and the one or more transmitting optical components is based on the time interval.

11. The method of claim 9, wherein transmitting the one or more outgoing light beams includes:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein wavelengths included in the first outgoing light beam are outside of a visible portion of an electromagnetic (EM) spectrum;

determining one or more first incoming angles based on detecting a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam corresponds to the first outgoing light beam that is reflected at the target; and

in response to detecting the first incoming light beam, transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at one or more second outgoing angles based on the one or more first incoming angles.

12. The method of claim 9, wherein the one or more transmitters include one or more transmitting optical components that collimate and scan the one or more outgoing light beams in a first direction and fan-out the one or more outgoing light beams in a second direction that is substantially orthogonal to the first direction.

13. The method of claim 9, further comprising:

determining one or more physical dimensions of the target, relative to one or more physical dimensions of a beam spot of the one or more outgoing light beams at the target, based on at least an intensity-temporal profile of the one or more incoming light beams.

14. The method of claim 9, further comprising:

determining a first incoming angle of a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a first detection location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at a second detection location and both the first and the second incoming light beams correspond to a first outgoing light beam of the one or more outgoing light beams that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first detection location and the second detection location.

15. The method of claim 9, further comprising:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein the first outgoing light beam is transmitted at a first location;

determining a first incoming angle based on a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a second location and corresponds to the first outgoing light beam that is reflected at the target;

transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at the first incoming angle and the second location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at the first location and corresponds to the second outgoing light beam that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first and the second locations.

16. The method of claim 9, wherein the one or more outgoing light beams are scanned in a Lissajous scanning pattern based on at least one of a proximate distance or a proximate physical dimension of the target.

17. A computer readable non-transitory storage medium that includes instructions for tracking a target, wherein the execution of the instructions by a processor enables actions, comprising:

transmitting, by one or more transmitters, the one or more outgoing light beams at the one or more outgoing angles towards the target;

detecting, by one or more receivers, the one or more incoming light beams at the one or more incoming angles;

determining a proximate location of the target based on one or more of a location or a velocity of the target;

modifying the one or more outgoing angles based on the proximate location of the target; and

determining a precision location of the target based on iteratively determining one or more of another triangulation value for the one or more incoming light beams that correspond to the one or more outgoing light beams transmitting at the one or more modified outgoing angles, a time interval corresponding to a time-of-flight (ToF) of the one or more outgoing light beams transmitting at the one or more modified outgoing angles, or a combination of the other triangulation value and the time interval.

18. The medium of claim 17, wherein

the one or more transmitters include one or more transmitting optical components that scan the one or more outgoing light beams across a range of outgoing azimuth angles and a range of outgoing elevation angles of the one or more outgoing angles;

the one or more receivers include one or more receiving optical components that receive the one or more incoming light beams within a range of incoming elevation angles of the one or more incoming angles and focus the one or more incoming light beams to within a range of focused elevation angles that is less than the range of incoming elevation angles; and

a phase difference between the one or more receiving optical components and the one or more transmitting optical components is based on the time interval.

19. The medium of claim 17, wherein transmitting the one or more outgoing light beams includes:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein wavelengths included in the first outgoing light beam are outside of a visible portion of an electromagnetic (EM) spectrum;

determining one or more first incoming angles based on detecting a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam corresponds to the first outgoing light beam that is reflected at the target; and

in response to detecting the first incoming light beam, transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at one or more second outgoing angles based on the one or more first incoming angles.

20. The medium of claim 17, wherein the one or more transmitters include one or more transmitting optical components that collimate and scan the one or more outgoing light beams in a first direction and fan-out the one or more outgoing light beams in a second direction that is substantially orthogonal to the first direction.

21. The medium of claim 17, the actions further comprising:

determining one or more physical dimensions of the target, relative to one or more physical dimensions of a beam spot of the one or more outgoing light beams at the target, based on at least an intensity-temporal profile of the one or more incoming light beams.

22. The medium of claim 17, the actions further comprising:

determining a first incoming angle of a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a first detection location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at a second detection location and both the first and the second incoming light beams correspond to a first outgoing light beam of the one or more outgoing light beams that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first detection location and the second detection location.

23. The medium of claim 17, the actions further comprising:

transmitting a first outgoing light beam of the one or more outgoing light beams, wherein the first outgoing light beam is transmitted at a first location;

determining a first incoming angle based on a first incoming light beam of the one or more incoming light beams, wherein the first incoming light beam is detected at a second location and corresponds to the first outgoing light beam that is reflected at the target;

transmitting a second outgoing light beam of the one or more outgoing light beams, wherein the second outgoing light beam is transmitted at the first incoming angle and the second location;

determining a second incoming angle of a second incoming light beam of the one or more incoming light beams, wherein the second incoming light beam is detected at the first location and corresponds to the second outgoing light beam that is reflected at the target; and

determining the triangulation value based on the first incoming angle, the second incoming angle, and a distance between the first and the second locations.

24. The medium of claim 17, wherein the one or more outgoing light beams are scanned in a Lissajous scanning pattern based on at least one of a proximate distance or a proximate physical dimension of the target.