Detecting sensor orientation characteristics using marker-based localization

Patent metadata

Field	Value
Publication number	US-10162058-B2
Application number	US-201615389888-A
Country	US
Kind code	B2
Filing date	Dec 23, 2016
Priority date	Dec 23, 2016
Publication date	Dec 25, 2018
Grant date	Dec 25, 2018

Abstract

Methods and systems for detecting sensor orientation characteristics using marker-based localization are disclosed herein. In one aspect, a robotic device can: receive a map of a horizontal marker plane that includes mapped positions of a first marker and a second marker arranged in the horizontal marker plane; receive, from a sensor configured to scan a two-dimensional sensor plane, sensor data indicative of positions of the first and second markers relative to the sensor; determine measured positions of the first and second markers based on the sensor data and a current position of the sensor; determine a difference vector between a first vector that connects the mapped positions of the first and second markers and a second vector that connects the measured positions of the first and second markers; and determine, based on the difference vector, an orientation of the two-dimensional sensor plane relative to the horizontal marker plane.

First claim

What is claimed is:

1. A method comprising:
receiving a map of a horizontal marker plane that includes mapped positions of a first marker and a second marker arranged in the horizontal marker plane;
receiving, from a sensor configured to scan a two-dimensional sensor plane, sensor data indicative of positions of the first and second markers relative to the sensor, wherein the sensor is mounted to a sensor mast on a robotic device;
determining measured positions of the first and second markers relative to the map based on the sensor data and a current position of the sensor relative to the map;
determining a difference vector between a first vector that connects the mapped positions of the first and second markers and a second vector that connects the measured positions of the first and second markers;
determining, based on the determined difference vector, an orientation of the two-dimensional sensor plane relative to the horizontal marker plane;
determining, based on the determined orientation of the two-dimensional sensor plane relative to the horizontal marker plane, that the sensor mast on the robotic device has deviated from a substantially vertical orientation; and
navigating the robotic device based on determining that the sensor mast on the robotic device has deviated from the substantially vertical orientation.

2. The method of claim 1 , wherein the map of the horizontal marker plane further includes mapped positions of at least a third marker arranged in the horizontal marker plane, the method further comprising:
receiving, from the sensor, sensor data indicative of a position of the third marker relative to the sensor; and
determining the current position of the sensor relative to the map based on the sensor data indicative of the positions of the first, second, and third markers.

3. The method of claim 1 , further comprising determining, based on a non-zero magnitude of the determined difference vector, that the sensor is vertically tilted relative to the horizontal marker plane.

4. The method of claim 1 , further comprising determining, based on the determined difference vector, a pitch angle of the sensor relative to the horizontal marker plane and a roll angle of the sensor relative to the horizontal marker plane.

5. The method of claim 1 , further comprising:
after receiving the sensor data from the sensor at a first time, receiving second sensor data indicative of positions of the first and second markers relative to the sensor at a second time; and
determining, based on the second sensor data, a second orientation of the two-dimensional sensor plane relative to the horizontal marker plane.

6. The method of claim 5 , further comprising determining, based on a similarity between the determined orientation of the two-dimensional sensor plane relative to the horizontal marker plane and the determined second orientation of the two-dimensional sensor plane relative to the horizontal marker plane, that the sensor is improperly mounted to the robotic device.

7. The method of claim 5 , further comprising determining, based on at least one of the determined orientation and the determined second orientation, a mounting angle of the sensor relative to the horizontal marker plane.

8. The method of claim 5 , further comprising determining, based on a difference between the determined orientation of the two-dimensional sensor plane relative to the horizontal marker plane and the determined second orientation of the two-dimensional sensor plane relative to the horizontal marker plane, that the sensor is moving relative to the horizontal marker plane.

9. The method of claim 5 , further comprising:
after receiving the second sensor data from the sensor at the second time, receiving third sensor data indicative of positions of the first and second markers relative to the sensor at a third time;
determining, based on the third sensor data, a third orientation of the two-dimensional sensor plane relative to the horizontal marker plane; and
determining, based on a second difference between the determined second orientation of the two-dimensional sensor plane relative to the horizontal marker plane and the determined third orientation of the two-dimensional sensor plane relative to the horizontal marker plane, that the sensor is oscillating relative to the horizontal marker plane.

10. The method of claim 1 , wherein the robotic device is a first robotic device, and wherein the sensor data is received when the first robotic device is at a particular location relative to the map, the method further comprising:
receiving, from a second sensor configured to scan a second two-dimensional sensor plane, second sensor data indicative of positions of the first and second markers relative to the second sensor, wherein the second sensor is coupled to a second robotic device, and wherein the second sensor data is received when the second robotic device is at the particular location relative to the map; and
determining, based on the second sensor data, an orientation of the second two-dimensional sensor plane relative to the horizontal marker plane.

11. The method of claim 10 , further comprising determining, based on a similarity between the determined orientations of the two-dimensional sensor plane and the second two-dimensional sensor plane relative to the horizontal marker plane, that a ground surface at the particular location is uneven.

12. The method of claim 10 , further comprising determining, based on at least one of the determined orientations of the two-dimensional sensor plane and the second two-dimensional sensor plane relative to the horizontal marker plane, a slope of a ground surface at the particular location.

13. A robotic device comprising:
a sensor configured to scan a two-dimensional sensor plane, wherein the sensor is mounted to a sensor mast on the robotic device; and
a control system configured to:
receive a map of a horizontal marker plane that includes mapped positions of a first marker and a second marker arranged in the horizontal marker plane;
receive, from the sensor, sensor data indicative of positions of the first and second markers relative to the sensor;
determine measured positions of the first and second markers relative to the map based on the sensor data and a current position of the sensor relative to the map;
determine a difference vector between a first vector that connects the mapped positions of the first and second markers and a second vector that connects the measured positions of the first and second markers;
determine, based on the determined difference vector, an orientation of the two-dimensional sensor plane relative to the horizontal marker plane;
determine, based on the determined orientation of the two-dimensional sensor plane relative to the horizontal marker plane, that the sensor mast on the robotic device has deviated from a substantially vertical orientation; and
navigate the robotic device based on determining that the sensor mast on the robotic device has deviated from the substantially vertical orientation.

14. The robotic device of claim 13 , wherein the control system is further configured to determine, based on the determined difference vector, a pitch angle of the sensor relative to the horizontal marker plane and a roll angle of the sensor relative to the horizontal marker plane.

15. The robotic device of claim 13 , wherein the control system is further configured to:
after receiving the sensor data from the sensor at a first time, receive second sensor data indicative of positions of the first and second markers relative to the sensor at a

Assignees

• X Dev Llc

Inventors

• Shaffer Daniel
• Holz Dirk

Classifications

• G01B11/002

  for measuring two or more coordinates · CPC title

• G01S17/06 Primary

  Systems determining position data of a target · CPC title

• G01S17/04

  Systems determining the presence of a target · CPC title

• G05D1/0244

  using reflecting strips · CPC title

• G05D1/0236

  in combination with a laser (lasers per se H01S) · CPC title