Time of flight sensor arrangement for robot navigation and methods of localization using same
11525921 · 2022-12-13
Assignee
Inventors
Cpc classification
G01S17/87
PHYSICS
G01S7/4865
PHYSICS
International classification
G01S17/00
PHYSICS
Abstract
In general, the present disclosure is directed to a time of flight (ToF) sensor arrangement that may be utilized by a robot (e.g., a robot vacuum) to identify and detect objects in a surrounding environment for mapping and localization purposes. In an embodiment, a robot is disclosed that includes a plurality of ToF sensors disposed about a housing of the robot. Two or more ToF sensors may be angled/aligned to establish overlapping field of views to form redundant detection regions around the robot. Objects that appear therein may then be detected by the robot and utilized to positively identify, e.g., with a high degree of confidence, the presence of the object. The identified objects may then be utilized as data points by the robot to build/update a map. The identified objects may also be utilized during pose routines that allow the robot to orient itself within the map.
Claims
1. A robotic surface cleaning device comprising: a housing; a motor coupled to at least one wheel to drive the robotic surface cleaning device; a first plurality of Time of Flight (ToF) sensors comprising at least a first ToF sensor and a third ToF sensor coupled to the housing; a second plurality of ToF sensors comprising at least a second ToF sensor and a fourth ToF sensor coupled to the housing, the first and second ToF sensors being vertically offset relative to each other and having a first and a second field of view (FOV), respectively, the first and second FOV vertically overlapping each other to form a first redundant detection region; and the third and fourth ToF sensors being vertically offset relative to each other and having a third and fourth FOV, respectively, the third and fourth FOV vertically overlapping each other to form a second redundant detection region; and a navigation controller disposed in the housing, the navigation controller to: receive a first and second measurement signal from the first and second ToF sensors, respectively; detect an object based, at least in part, on the first and second measurement signals indicating a presence of the object within the first redundant detection region; cause the robotic surface cleaning device to rotate in place according to a rotation direction for a predetermined rotation angle; receive a third and fourth measurement signal from the third and fourth ToF sensors, respectively; detect the object based, at least in part, on the third and fourth measurement signals indicating a presence of the object within the second redundant detection region; track movement of the object between the first redundant detection region and the second redundant detection region based, at least in part, on the first, second, third, and fourth measurement signals; determine an actual rotation angle through which the robotic surface cleaning device rotated based, at least in part, on the tracked movement of the object; and compare the actual rotation angle to the predetermined rotation angle to determine a difference between the actual rotation angle and the predetermined rotation angle.
2. The robotic surface cleaning device of claim 1, wherein the first and second ToF sensors are infrared-type ToF sensors.
3. The robotic surface cleaning device of claim 1, wherein each ToF sensor of the first plurality of ToF sensors is vertically offset relative to a corresponding ToF sensor of the second plurality of ToF sensors.
4. The robotic surface cleaning device of claim 1, wherein the first and second ToF sensors are arranged in a first staggered configuration such that a first imaginary line drawn substantially transverse from a surface to be cleaned intersects with the first ToF sensor does not intersect with the second ToF sensor.
5. The robotic surface cleaning device of claim 1, wherein navigation controller is further to calculate a height of the object relative to the robotic cleaning device based, at least in part, on the geometry of the first redundant detection region and the relative distance between the robotic cleaning device and the object.
6. The robotic surface cleaning device of claim 1, wherein navigation controller uses the first and second ToF sensors during a pose routine to determine an orientation of the robotic surface cleaning device in a map stored in a memory of the robotic surface cleaning device.
7. A robotic surface cleaning device to navigate in a surrounding environment to perform cleaning operations, the robotic surface cleaning device comprising: a housing having: a first plurality of Time of Flight (ToF) sensors to identify and/or track an object in an environment surrounding the housing, the first plurality of ToF sensors having at least a first and a second ToF sensor being vertically offset relative to each other, the first and second ToF sensors having detection regions that at least partially vertically overlap each other to form a first redundant detection region; and a second plurality of ToF sensors to identify and/or track objects in the environment, the second plurality of ToF sensors having a third and a fourth ToF sensor being vertically offset relative to each other, the third and fourth ToF sensors having detection regions that at least partially vertically overlap each other to form a second redundant detection region; and a controller disposed in the housing to: determine a location of the object in the surrounding environment relative to the housing based, at least in part, on the first redundant detection region; cause the robotic surface cleaning device to rotate in place according to a rotation direction for a predetermined rotation angle; track movement of the object between the first redundant detection region and the second redundant detection region; determine an actual rotation angle through which the robotic surface cleaning device rotated based, at least in part, on the tracked movement of the object; and compare the actual rotation angle to the predetermined rotation angle to determine a difference between the actual rotation angle and the predetermined rotation angle.
8. The robotic surface cleaning device of claim 7, wherein at least one ToF sensor of the second plurality of ToF sensors has a detection region that at least partially overlaps with the detection region of the first and/or second ToF sensor to provide a third redundant detection region, and wherein the controller is further to calculate a height of the object based on the object being detected in the third redundant detection region.
9. A computer-implemented method for navigation of a robotic surface cleaning device, the method comprising: establishing at least a first redundant detection region based, at least in part, on a first plurality of Time of Flight (ToF) sensors comprising a first ToF sensor and a second ToF sensor, the first and second ToF sensors being vertically offset relative to each other and having associated detection regions that at least partially overlap each other; establishing at least a second redundant detection region based, at least in part, on a second plurality of ToF sensors comprising at least a third ToF sensor and a fourth ToF sensor, the third and fourth ToF sensors being vertically offset relative to each other and having associated detection regions that at least partially overlap each other; receiving, by a controller, first and second measurement signals from the first and second ToF sensors, respectively; detecting, by the controller, a location of an object relative to the robotic surface cleaning device based on the first and second measurement signals indicating a presence of the object within the first redundant detection region; causing the robotic surface cleaning device to rotate in place according to a rotation direction for a predetermined rotation angle; receiving a third and fourth measurement signal from the third and fourth ToF sensors, respectively; detecting the object based, at least in part, on the third and fourth measurement signals indicating a presence of the object within the second redundant detection region; tracking movement of the object between the first redundant detection region and the second redundant detection region based, at least in part, on the first, second, third, and fourth measurement signals determining an actual rotation angle through which the robotic surface cleaning device rotated based, at least in part, on the tracked movement of the object; and comparing the actual rotation angle to the predetermined rotation angle to determine a difference between the actual rotation angle and the predetermined rotation angle.
10. The computer-implemented method of claim 9, further comprising calculating, by the controller, a height of an object detected within the second redundant detection region.
11. The computer-implemented method of claim 9, further comprising executing, by the controller, a pose routine that orients the robotic surface cleaning device within a map stored in a memory.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) These and other features and advantages will be better understood by reading the following detailed description, taken together with the drawings wherein:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
DETAILED DESCRIPTION
(10) In general, the present disclosure is directed to a time of flight (ToF) sensor arrangement that may be utilized by a robot device, e.g., a robotic surface cleaning device (or vacuum) or other robotic device, to identify and detect objects in a surrounding environment for mapping and localization purposes. In an embodiment, a robot is disclosed that includes a plurality of ToF sensors disposed about a housing of the robot. Two or more ToF sensors may be angled/aligned to establish at least partially overlapping field of views to form redundant detection regions around the robot. Objects that appear simultaneously, or nearly simultaneously, may then be detected by the robot and utilized to positively identify, e.g., with a high degree of confidence, the presence of an object. The identified objects may then be utilized as data points by the robot to build/update a map. The identified objects may also be utilized during pose routines that allow the robot to orient itself within the map with a high degree of confidence.
(11) Although the following aspects and embodiments specifically reference robotic vacuums, this disclosure is not limited in this regard. The following disclosure is equally applicable to any type of robot that seeks to intelligently understand and traverse an environment by identifying objects/features, e.g., furniture, walls, toys, people, pets, and so on, and their position in the environment. In addition, the ToF sensor arrangement disclosed variously herein may be utilized in a robot without an image sensor system for object identification/tracking, or alternatively, may be used in combination with an image sensor system.
(12) The ToF sensor arrangement disclosed herein allows for environmental information to be collected in a relatively simple manner that can be used alone or in combination with other sensory such as image sensors. When used as a replacement for image sensors, the ToF sensor arrangement advantageously significantly reduces cost, complexity and computational load on hardware resources of the robotic device.
(13) As generally referred to herein, a ToF sensor refers to any sensor device capable of measuring the relative distance between the sensor and an object in an environment. Preferably, infrared-type ToF sensors may be utilized, wherein each infrared ToF sensor includes an IR transmitter and receiver. However, other sensor types may be utilized such as acoustic ToF sensors that emit and receive sound waves, e.g., ultrasound, for measurement purposes.
(14) Referring now to
(15) The housing 102 may have any shape and is not necessarily limited to the shape shown in the figures (e.g., circular). For example, the housing 102 may have a square shape, a D-shape, a triangular shape, a circular shape, a hexagonal shape, a pentagonal shape, and/or any other suitable shape. In some instances, the positioning of the ToF sensors 104, relative to the housing 102, may be based, at least in part, on the shape of the housing 102.
(16) Each of the plurality of time of flight sensors 104-1 to 104-n may comprise any sensor capable of measuring relative distance between the sensor and an object in a surrounding environment and converting the same into a representational electrical signal. For example, the time of flight sensors 104-1 to 104-n may comprise infrared laser-type sensors that utilize infrared wavelengths to output a measurement distance signal, which may be referred to herein as simply a measurement signal. In other examples, the time of flight sensors 104-1 to 104-n may comprise sensors capable of measuring distance acoustically via soundwaves, e.g., ultrasound. In any event, the time of flight sensors 104-1 to 104-n may comprise short-range sensors capable of measurements from a few centimeters to a meter, or long-range sensors capable of measurements from 1 meter to hundreds of meters, or a combination of both short and long-range ToF sensors.
(17) As discussed in further detail below, the navigation controller 103 may receive measurement signals from the ToF sensors 104-1 to 104-n to identify objects the environment of the robot. In an embodiment, the location of the identified objects relative to a known position of the robot may be utilized to update/build a map from a point cloud, e.g., a plurality of points that may utilized to generate a map. The identified objects may also be utilized to calculate robot odometry and pose in order to localize the robot within the map. The ToF sensors 104-1 to 104-n may be used exclusively to identify objects in an environment, e.g., without the aid of image sensors or other like device, or may be used in combination with image sensor(s).
(18)
(19) The ToF 104-1 includes a field of view (FOV) 108 which can have a generally conical shape. Each FOV may also be referred to herein as detection regions. When observed from the top, e.g., as shown in
(20) Turning to
(21) This configuration shown in
(22) Thus, in response to the object appearing in the overlapping region 210, a height determination for the object 212 may then be calculated. The calculated height for the object 212 may then be used by the robot navigation system 100 during localization and navigation. For example, height determinations by the robot navigation system 100 using the vertically-stacked ToF arrangement may be advantageously utilized to distinguish between objects/obstructions in an environment that can be navigated around, e.g., furniture, toys, and so on, by the robot 109 versus objects/obstructions that cannot be navigated around such as walls and windows.
(23) Each of the first and second ToF sensors 104-1, 104-2 may optionally be part of first and second ToF arrays 202-1, 202-2. Each of the ToF sensors in the second ToF arrays 202-1, 202-2 can include ToF sensors disposed in a uniform manner relative to each other about the body 102 of the robot, such as shown, or may be disposed at varying distances relative to each other. As further shown in
(24)
(25) In addition, each of the first and second ToF sensors 104-1, 104-2 may optionally be part of first and second ToF arrays 202-1, 202-2, respectively. In this embodiment, the first and second ToF arrays 202-1, 202-2 may be disposed in a staggered manner. To this end, the robot navigation system 100 may utilize overlapping FoVs from the first and second ToF sensors 104-1, 104-2, or from first and third ToF sensors 104-1, 104-3. Accordingly, this staggered configuration provides the robot navigation system 100 with flexibility as to which combinations of sensors, and by extension, which overlapping FOVs to utilize when calculating heights of objects/instructions within the same. Note while the embodiments of
(26) As is known, light-based ToF sensors measure relative distances to objects by reflecting light off of an object and measuring the duration of time for the light to be reflected back to the sensor. These calculations operate, in part, based on the speed of light remaining constant. As a robot travels forward, the change of a reported distance combined with the time interval between the reported changes in distance may be used to calculate the real-time speed of the robot, for instance. Therefore, the speed of a robot may be given by the following equation:
(27)
(28)
(29) In an embodiment, the angles of the FOV may allow for overlap of regions between the FOV for two or more ToF sensors. These overlapped regions may also be referred to as redundant detection regions. For example, the embodiment of
(30) In one specific example embodiment, the ToF 104-1 may be initially relied upon to track odometry. If the ToF 104-1 is not registering any objects, e.g., measurements are at or below a threshold floor value for distance, or tracking an object that has yet to enter the FOV of the other ToF sensors 104-2 to 104-7, the navigation controller 103 may utilize the other sensors that have overlapping FOVs to positively identify objects through multi-sensor detection, e.g., by sensors 104-3 and 104-6. In response to the detection of an object, the navigation controller 103 may “hand off” tracking to the ToF sensor with the FOV that is more likely to continue to have the object in view.
(31) For example, consider a scenario where the navigation controller 103 detects object 112 simultaneously, or nearly simultaneously, entering the FOV 111-3 of ToF sensor 104-3 and the FOV 111-6 of ToF sensor 104-6. The robot 109 may then “hand off” tracking to the sensor 104-6 as the associated FOV 111-6 can continue to detect the object 112 over the entire distance D as the robot 109 moves along direction 110. On the other hand, the sensor 104-3 only remains capable of detecting object 112 for distance d before the same is outside the detection range of FOV 111-3. Accordingly, distance d represents the extent of the redundant region by which both ToF sensors 104-3 and 104-6 can track object 112 while distance D represents the extent of the entire region by which ToF sensor 104-6 can detect presence/distance of the object 112 (assuming forward movement along direction 110). In a general sense, this “handing off” allows for objects to be tracked by a single sensor with a relatively high degree of confidence that the object is present, and the relative distance of the robot 109 to the objects. This can be particularly advantageous when attempting to maintain a particular distance from an object such as a wall, furniture or other obstruction, or to otherwise adjust operation of the robot 109 based on the presence and distance of the object 112.
(32) Alternatively, or in addition to the “hand off” scenario discussed above, the navigation controller 103 may continue to track objects via two or more ToF sensors. For example, in the embodiment of
(33) In any such cases, and in accordance with an embodiment, objects may be detected by the navigation controller 103 when two or more ToF sensors with overlapping FOVs output a measurement signal that indicates the presence of an object and its relative distance from the robot 109. In some cases, multiple measurements from each of the ToF sensors may be utilized by the navigation controller 103 to minimize or otherwise reduce instances of false positives. Thus, upon successive data points from each FOV (e.g., derived from the respective measurement signals), the navigation controller 103, and by extension the robot 109, can detect an object in the environment, optionally continue to track that object via one or more ToF sensors, and use those data points to increase the confidence of the robot odometry processes.
(34)
(35)
(36) In an embodiment, ToF redundant detection regions (labeled Regions 1 to 3) can be utilized during pose calculations. Consider a scenario where the robot 109 of
(37) In accordance with an aspect of the present disclosure a robotic surface cleaning device is disclosed. The robotic surface cleaning device comprising a housing, a motor coupled to at least one wheel to drive the robot, at least a first Time of Flight (ToF) sensor and a second ToF sensor coupled to the housing, the first and second ToF sensors having a first and a second field of view (FOV), respectively, the first and second FOV at least partially overlapping each other to form a first redundant detection region, a navigation controller disposed in the housing, the navigation controller to receive a first and second measurement signal from the first and second ToF sensors, respectively, and detect an object based, at least in part, on the first and second measurement signals indicating a presence of an object within the first redundant detection region.
(38) In accordance with another aspect of the present disclosure a robotic surface cleaning device to navigate in a surrounding environment to perform cleaning operations is disclosed. The robotic surface cleaning device comprising a housing with a first plurality of Time of Flight (ToF) sensors to identify and/or track objects in an environment surrounding the housing, wherein at least a first and a second ToF sensor of the first plurality of ToF sensors have detection regions at least partially overlapping each other to form a first redundant detection region, and a controller disposed in the housing to determine a location of an object in the surrounding environment relative to the housing based at least in part on the first redundant detection region.
(39) In accordance with another aspect of the present disclosure a computer-implemented method for navigation of a robotic surface cleaning device is disclosed. The method comprising establishing at least a first redundant detection region based at least in part on first and second Time of Flight (ToF) sensors having associated detection regions that at least partially overlap each other, receiving, by a controller, first and second measurement signals from the first and second ToF sensors, respectively, and detecting, by the controller, a location of an object relative to the robotic surface cleaning device based on the first and second measurement signals indicating presence of the object within the first redundant detection region.
(40) While the principles of the disclosure have been described herein, it is to be understood by those skilled in the art that this description is made only by way of example and not as a limitation as to the scope of the disclosure. Other embodiments are contemplated within the scope of the present disclosure in addition to the exemplary embodiments shown and described herein. Modifications and substitutions by one of ordinary skill in the art are considered to be within the scope of the present disclosure, which is not to be limited except by the following claims.