Exemplary embodiments pertain to the art of sensor processing and, more particularly to a system and method for processing captured images.
Moving platforms such as robots, drones, and the like, includes sensors that provide environmental feedback. Sensors may include visual sensors, such as cameras, and range sensors that may detect an object or a distance to an object. The moving platform may include autonomous control that relies on the sensors for navigation. When under autonomous control, the moving platform often times includes a map that facilitates various capabilities such as obstacle avoidance, path planning, place, and object recognition.
Disclosed is an image processing system configured to process perceived images of an environment including a central processing unit (CPU) including a memory storage device having stored thereon a computer model of the environment, at least one sensor configured and disposed to capture a perceived environment including at least one of visual images of the environment and range data to objects in the environment, and a rendering unit (RU) configured and disposed to render the computer model of the environment forming a rendered model of the environment. The image processing system compares the rendered model of the environment to the perceived environment to update the computer model of the environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the at least one sensor comprises a red, green, blue, and distance (RGBD) device.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the at least one sensor comprises a first sensor configured to capture visual images of the environment, and a second sensor configured to determine range to objects in the environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the first sensor comprises a camera.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the second sensor comprises a LiDAR sensor.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the RU comprises a graphics processing unit (GPU).
Also disclosed is a system for processing images captured by a moving platform. The system includes a central processing unit (CPU), said CPU being interconnected functionally via a system bus to at least one sensor configured and disposed to capture a perceived environment including at least one of visual images of the environment and a range data to objects in the environment, a rendering unit (RU), and at least one memory device thereupon stored a computer model of the environment and a set of instructions which, when executed by said CPU, causes the image processing system to capture a perceived environment through the at least one sensor, the perceived environment including visual images and range data, render the computer model of the environment in the RU forming a rendered model of the environment, compare the rendered model of the environment with the perceived environment, and selectively update the computer model of the environment based on the perceived environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the set of instructions which, when executed by said CPU, causes the image processing system to employ an iterative process to compute a position and orientation of the moving platform by performing as Z-buffer optimization of the perceived environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include the set of instructions which, when executed by said CPU, causes the image processing system to perform a direct numerical optimization on a per-point error metric of the Z-buffer optimization.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the set of instructions which, when executed by said CPU, causes the image processing system to employ an iterative process to compute a position and orientation of the moving platform by performing an iterative closest point (ICP) optimization against the computer model of the environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the ICP optimization includes a point-to-point optimization of the perceived environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the ICP optimization includes a point-to-plane optimization of the perceived environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein the set of instructions which, when executed by said CPU, causes the image processing system to form at least one of a plurality of points, voxels, and textured polygon meshes that embody the perceived environment.
In addition to one or more of the features described above or below, or as an alternative, further embodiments could include wherein each of the at least one of the plurality of points, voxels, and textured polygon meshes includes geographical positioning system (GPS) coordinates.
The following descriptions should not be considered limiting in any way. With reference to the accompanying drawings, like elements are numbered alike:
A detailed description of one or more embodiments of the disclosed apparatus and method are presented herein by way of exemplification and not limitation with reference to the Figures.
A moving platform system, in accordance with an exemplary embodiment, is illustrated generally at 2, in
In accordance with an exemplary embodiment, moving platform system 2 includes an image processing system 20 which, as will be discussed more fully below, processes images of the environment perceived by sensors mounted to platform 4. Image processing system 20 includes a central processing unit (CPU) 24 that may include a memory storage device 26 having stored thereon a computer model of the environment and/or hypothetical model of the environment. The computer model of the environment may comprise voxels, points, and/or a textured polygon mesh. Image processing system 20 may be operatively connected to a first sensor 30 and a second sensor 32. First sensor 30 captures visual images of the environment and may take the form of a digital video camera, a red, green, blue, and distance (RGBD) device or other similar device that may produce, simultaneously, a depth image superimposed on a colored visual image, as indicated at 34. At this point, it should be understood that the term “visual images” should be understood to include multi-dimensional images that include a depth component. Second sensor 32 may be a range sensor, such as a LiDAR sensor 36 that determines distances between platform 4 and various objects in the environment.
In further accordance with an exemplary embodiment, image processing system 20 includes a rendering unit (RU) 40 that may include a modeling module 44 and an update module 46. As will be detailed more fully below, RU 40 may take the form of a Graphics Processing Unit (GPU) 48. Image processing system 20 leverages higher speeds and increased computing power of GPU in addition to embedded graphics processing algorithms over that typically available through a general purpose GPU (GPGPU) technique or methodology to create an occupancy map or a rendered model of environment. More specifically, RU 40 receives, as input, the computer model of the environment and outputs a rendered model of the environment. The rendered model of the environment may include a plurality of grids that may include code indicating one of a presence and an absence of objects, as well as additional data such as color and/or depth. The rendered model of the environment is then compared with sensor data embodying the perceived environment.
For example, modeling module 44 of GPU 48 may employ iterative closest point (ICP) techniques to align visual images with depth or distance data captured by one or more of sensors 30 and 32. The increased computing power and flexibility of GPU 48 may substantially instantly compare incoming data with the computer rendering including polygon surfaces, colored by surface normal to corresponding points and their normals. Update module 46 compares the rendered model of the environment with the data from sensors 30 and/or 32 to determine whether differences exist. If differences do exist, GPU 48 may output an updated computer model of the environment 49 that may be passed to navigation system 10 and/or stored for later use. Update module 46 may also update a position and orientation of platform 4 within the model of the perceived environment. Of course, it should be understood, that image processing system 20 may be arranged remote from platform 4 and may be provided with captured data in order to model the perceived environment.
Reference will now follow to
In accordance with an aspect of an exemplary embodiment, a position and orientation or pose of platform 4 may be computed by an iterative process, in which starting with a hypothesis of the position and orientation of the platform, the rendered model of the environment may be created at the hypothetical pose, to be compared with the actual perceived environment captured through sensor data including images and/or range. Any differences between the rendered model of the environment and the actual view of the environment may be employed to gauge accuracy of the hypothesis, and to compute a correction with respect to the current hypothesis to update the computer model of the environment. This process may be repeated until any differences between the rendered model of the environment and the actual view of the environment is sufficiently small, at which point the hypothetical pose is considered to be accurate to the current position and orientation of platform 4.
In accordance with another aspect of an exemplary embodiment, RU 40 may perform a Z-buffer optimization of the perceived environment. Further, modeling module 44 may perform a direct numerical optimization on a per-point error metric of the Z-buffer optimization. In accordance with another aspect of an exemplary embodiment, modeling module 44 may perform an iterative closest point (ICP) optimization of the perceived environment. The ICP optimization may include a point-to-point optimization of the perceived environment and/or a point-to-plane optimization of the perceived environment. Further, modeling module 44 may embed global positioning (GPS) coordinates or Inertial Navigation Unit (INU) measurement, and depth coordinated in each point of the perceived environment.
In block 108, the perceived environment is compared with the rendered model of the environment. In block 120, a determination is made whether the perceived environment matches the rendered model of the environment. If discrepancies are found, the rendered computer model of the environment is updated to reflect actual perceived conditions of the environment in block 122. In this manner, the computer model of the environment may be updated to account for any changes that are found by image processing system 20. In block 124, a determination is made whether additional scanning of the environment takes place. If not, image processing system 20 ends in block 130. If additional scanning takes place, and/or the rendered model of the environment matches the perceived environment, a determination is made in block 140 whether the mission is complete. If not, sensors 30 and/or 32 continue capturing the perceived environment in block 104. If the mission is deemed to be completed, image processing ends in block 130.
At this point, it should be understood that the exemplary embodiments leverage increased computing technology with enhanced speed of a GPU to process images and normals to surfaces in the images to form a model of a perceived environment. The model of the perceived environment may be used to update existing computer renderings of the environment to enhance navigation and/or route planning for autonomous moving platforms. Further, it should be understood that modern GPUs may be used to render an environment at a very high rate. As such, the use of GPUs in connection with the exemplary embodiments may enhance speed and/or efficiency of updating the rendered model of the environment. Still further, it should be understood that the iterative process could be formally modeled as an optimization procedure in which differences between the model of the rendered environment and the actual view of the environment may be set as a cost function, and an unconstrained optimization method can be used to iteratively compute the position and orientation that would result in reducing this cost function.
In accordance with another aspect of an exemplary embodiment, RU 40 may not update the computer model of the environment by adding information from the perceived environment, but instead may construct an environment from idealized information. For example, RU 40 may render the color surfaces according to a direction of a surface normal. In this manner, surface normals may be determined from their color, which could result in faster determinations from rendered images. It should be understood that although in such an instance, where surfaces were colored to indicate the direction of surface normal, surface shape in the internal model would still match the perceived environment even though the color may be different.
In accordance with other aspects of an exemplary embodiment the internal model would not necessarily match the perceived environment; rather the rendered model may be generated to an environment that does not have a corresponding physical 3D meaning but would support a render based computation in the rendered environment. For example, the model may be generated in such a way so as to provide collision detection for grasping, audio wave form analysis, or path planning in two dimensions. Thus, the rendered 3D model may be rendered by RU 40 to solve a specific spatial problem rather than to match an actual perceived environment.
The terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the disclosure. As used herein, the singular forms “a”, “an” and “the” are intended to include the plural forms as well, unless the context clearly indicates otherwise. It will be further understood that the terms “comprises” and/or “comprising,” when used in this specification, specify the presence of stated features, integers, steps, operations, elements, and/or components, but do not preclude the presence or addition of one or more other features, integers, steps, operations, element components, and/or groups thereof.
While the disclosure is provided in detail in connection with only a limited number of embodiments, it should be readily understood that the disclosure is not limited to such disclosed embodiments. Rather, the disclosure can be modified to incorporate any number of variations, alterations, substitutions or equivalent arrangements not heretofore described, but which are commensurate with the spirit and scope of the disclosure. Additionally, while various embodiments of the disclosure have been described, it is to be understood that the exemplary embodiment(s) may include only some of the described exemplary aspects. Accordingly, the disclosure is not to be seen as limited by the foregoing description, but is only limited by the scope of the appended claims.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/US15/36145 | 6/17/2015 | WO | 00 |