Multi-Agent Autonomy: Advancements and Challenges in Subterranean Exploration

10/08/2021 ∙ by Michael T. Ohradzansky, et al. ∙ University of Colorado Boulder University of California Santa Cruz 0

Artificial intelligence has undergone immense growth and maturation in recent years, though autonomous systems have traditionally struggled when fielded in diverse and previously unknown environments. DARPA is seeking to change that with the Subterranean Challenge, by providing roboticists the opportunity to support civilian and military first responders in complex and high-risk underground scenarios. The subterranean domain presents a handful of challenges, such as limited communication, diverse topology and terrain, and degraded sensing. Team MARBLE proposes a solution for autonomous exploration of unknown subterranean environments in which coordinated agents search for artifacts of interest. The team presents two navigation algorithms in the form of a metric-topological graph-based planner and a continuous frontier-based planner. To facilitate multi-agent coordination, agents share and merge new map information and candidate goal-points. Agents deploy communication beacons at different points in the environment, extending the range at which maps and other information can be shared. Onboard autonomy reduces the load on human supervisors, allowing agents to detect and localize artifacts and explore autonomously outside established communication networks. Given the scale, complexity, and tempo of this challenge, a range of lessons were learned, most importantly, that frequent and comprehensive field testing in representative environments is key to rapidly refining system performance.



There are no comments yet.


page 5

page 7

page 16

page 17

page 22

page 25

page 29

page 31

This week in AI

Get the week's most popular data science and artificial intelligence research sent straight to your inbox every Saturday.

1 Introduction

Subterranean environments pose a significant challenge for autonomous robotic exploration. Maintaining consistent and accurate state estimates across long distances is critical to mapping and planning, and is difficult without the aid of GPS. Varied lighting and other environmental conditions such as heavy dust, smoke, or fog can degrade sensor measurements, and a range of sensing modalities may be needed to maintain accurate state estimates and maps. Diverse and sometimes hazardous terrain present mobility challenges to ground platforms, and can require more complex path planning and guidance algorithms or even specialized robots to navigate. Additionally, underground environments generally make wireless communication difficult by limiting the range and bandwidth that information can be transmitted. Depending on mission requirements, additional sensors may be needed such as cameras for detecting visual artifacts or Bluetooth modules for detecting cellular devices. Developing robots that are capable of overcoming all of the aforementioned challenges requires rigorous testing in representative environments.

The DARPA Subterranean Challenge [19] was created to spur the advancement of novel approaches to autonomous mapping and exploration of underground environments, and is motivated by mission-critical scenarios such as disaster response and time-sensitive combat operations. Teams are challenged with deploying robotic systems capable of navigating diverse subterranean environments in search of artifacts. The challenge is split into three circuit events (Tunnel, Urban, and Cave) and a final event that combines the challenges of all the subterranean domains. To score points during a timed run, teams must detect and localize various types of artifacts placed throughout the course within the time limit and report it to the DARPA scoring server. Searching for artifacts efficiently requires intelligent exploration strategies accompanied with able navigation and guidance. Terrain in the challenge includes flat concrete, soft dirt with rocks and boulders of varying size and shape, aggressive slopes and stairs, and even areas of thick mud, all of which provide unique planning and mobility challenges for different robot platforms. Varied lighting conditions and severely limited communication makes artifact detection, localization, and reporting a significant challenge. Competitors in the challenges are allowed one Human Supervisor who can interact directly with the robots.

Team MARBLE has competed in the Tunnel, Urban, and virtual Cave circuit events to date. At these events, the team deployed a heterogeneous fleet of ground and aerial robots with autonomy stacks consisting of perception, localization, mapping, exploration, artifact detection, communication, and multi-agent coordination algorithms. Our solution focuses on multi-agent autonomy, where agents are able to explore unknown environments efficiently by sharing information like maps and goal points. Generating consistent pose estimates is critical to coordination across platforms, and our team uses the open-source LiDAR-Inertial SLAM package Google Cartographer for localization

[34]. In our approach, each agent localizes independently. Other teams have demonstrated distributed SLAM methods where incorporating localization information from multiple robots can improve pose estimates [25], [44]. For the purposes of planning and situational awareness, a volumetric occupancy grid of the environment is created in real time using the open-source OctoMap package [36]. Sharing entire maps over limited communications networks is undesirable, and so additional features like map difference segmenting and map merging were added to the OctoMap package. To facilitate autonomous exploration, our team has developed graph and frontier-based path planning algorithms. For the circuit events, our team’s focus has been on autonomy while other teams have relied heavily on the Human Supervisor to coordinate the movements and actions of their systems [69] [63]. To traverse the subterranean environments, our team has pursued development of four-wheeled and tracked ground robots complimented with multi-rotor platforms. Other teams have deployed four-legged quadrupedal robots [55], [10] and blimps [38].

In the following work, we present MARBLE, which is a multi-agent solution for autonomous subterranean exploration and artifact detection. First, an overview of our platforms and autonomy solution is presented in Section 2. In Section 3, a deeper dive into the mapping solution is provided where the implementation and benefits of map-merging is discussed. Our team has developed several planning strategies and solutions for the different subterranean environments, which are presented in Section 4 and Section 5. A vision-based method for detecting and avoiding obstacles onboard aerial vehicles is discussed in Section 6. Section 7 contains a brief discussion on a UDP-based mesh communication network for message passing between robots. A core capability developed by the team is a multi-agent coordination algorithm, which is presented in greater detail in Section 8. Finally, lessons the team has learned as a result of developing and deploying autonomous robot fleets for the DARPA SubT Challenge are presented in Section 9.

2 System Overview

In the following subsections, an overview of the hardware and software solutions is presented. The following terms are used interchangeably to refer to the different systems: agent, robot, platform, and vehicle. MARBLE robotic platforms are shown in Figure 1, and a general overview of the multi-agent autonomy solution is shown in Figure 3.

Figure 1: The robot fleet is composed of three classes of robotic agents: (a) Clearpath Husky, (b) Lumenier QAV500, and (c) Superdroid HD2.

2.1 Platforms and Hardware

Ground Vehicles - The Clearpath Husky operates as a general all-purpose platform with sufficient payload, endurance, and customizability to support the team’s higher-level needs. The Husky has proven to be a capable motion base, however several aspects of the rugged underground environments, such as the introduction of stairs and increasingly rough terrain, have led to greater fleet diversification and specialization. The Superdroid HD2, a large tracked ground vehicle, was incorporated into the fleet to address the Husky’s limitations. The ground vehicle platforms are equipped with a range of sensors needed to support critical processes like localization, artifact detection, and obstacle avoidance. The main sensor onboard is the Ouster OS1-64 LiDAR (Light Detection and Ranging), which generates 3D pointclouds that are used for localization, mapping, and obstacle avoidance. A LORD Microstrain 3DM-GX5-15 VRU provides inertial measurements for state estimation. RealSense D435 cameras are used to generate color and depth images for artifact detection, and are also used for object avoidance. An RPLIDAR S1 is placed at the front of the vehicle for navigation and obstacle avoidance. Special-purpose sensors, such as a carbon dioxide sensor and a Bluetooth module, have enabled agents to detect gas and cellphone artifacts during past Circuit Events. All onboard processing is handled by a 32-core AMD Ryzen CPU equipped with 128GB of RAM and 4TB of SSD storage. Artifact detection is performed on a NVIDIA GTX 1650 using 4 Gig-E cameras. To communicate with the mesh network, the ground vehicle’s have their own router and high-power antenna. Each vehicle is equipped with approximately 940Wh of usable battery storage in the form of four 7S lithium-ion packs. With all motors at stall torque and the compute element fully loaded, the estimated runtime is one hour; in normal operations, the platforms can run for approximately three hours. The fully outfitted ground vehicles are shown in Figures (a)a and (c)c.

Aerial Vehicles - The UAV assembly, which was deployed at the Urban circuit event, is based on the Lumenier QAV500 airframe, and the frame shape is elongated to provide more space for onboard sensing and compute. To achieve a suitable thrust-weight ratio, form factor, and endurance, each UAV is outfitted with Tiger MN3510 700kV motors with 124 propellers, and is powered by a 8000mAh 4S LiPo battery. This design is rated to carry a maximum of 1600 grams per rotor. Pixracer R15, a PX4 based flight controller, is used for attitude stabilization and velocity control. To maximize UAV mission endurance, lightweight sensing and compute hardware has been selected. Similar to the ground vehicles, the aerial vehicle has an Ouster and Lord Microstrain IMU for localization. However, the aerial vehicles are configured with upward and downward-facing Camboard pico flexx cameras instead of the heavier left-facing and right-facing RealSense D435 cameras. The Intel NUC 7i7DNBE operates as the onboard computer, and is accompanied by a NVIDIA Jetson Nano for visual artifact detection purposes. Similar to the ground vehicles, the UAV is also equipped with a router for communicating with the mesh network. The UAV design is shown in Figure 1b.

Beacons - The ground vehicles are outfitted with communications beacons that relay information between robots and the Base Station, as well a mechanism to deploy them. Beacons are deployed by the multi-agent robot node described in Section 8 based on several different conditions including distance, loss of communication, junction, turn, and Human Supervisor-commanded. In addition to acting as a simple communications relay, a multi-agent node running on the beacons allow them to act as a stationary agent. As agents enter communications range of a beacon, information is collected, stored, and shared with other agents on the network. This allows the network to be more resilient to intermittent communications and facilitates the sharing of information critical to coordination. Examples of different communication beacon designs are shown in Figure 21 and examples of the latest iteration can be seen on the back of the Husky in Figure (a)a.

Human - Robot Interface - The MARBLE Base Station and Graphical User Interface (GUI) provides rapid situational awareness to the Human Supervisor and acts as a direct interface to the DARPA scoring server. Through the GUI, the Human Supervisor is able to view received maps and artifact reports from agents on the network. Similar to the beacons, the Base Station runs a special version of the ROS multi-agent node to facilitate information transfer in both directions. The GUI allows high-level interactions with each robot and manages artifact reporting. A screen capture of the GUI and RViz can be seen in Figure 2. High-level commands, including emergency stop, manual goal points, return home, and beacon deployment, can be sent to agents across the network. Additional features include the ability to reset the map each agent uses for planning and a view of each robot’s position, intended goal, and current planned path within the map.

Figure 2: View of the MARBLE Base Station GUI during a competition run.

2.2 Architecture

To succeed in the DARPA Subterranean Challenge, the agents must have a number of different capabilities. In order to score points, they must be able to detect and distinguish a variety of artifacts, localize them in the environment relative to a fixed world frame, and report this information back to the base station for final submission to DARPA. The RGB image is processed by YOLO [67], which produces a bounding box around the object with an estimated confidence score. A local projection for the artifact is obtained by fusing the center of the bounding box with the corresponding aligned depth measurement. The projection is then transformed into the fixed world frame using the robot’s current state estimate. Over the different phases we have learned a great deal about developing a flexible object detection system which we discuss in Section 9.1.

Figure 3: General overview of the software pipeline on the ground platforms, aerial platforms, and base station. Data sources are shown in green, Artifact Detection processes in purple, Localization and Mapping processes in orange, Navigation processes in red, and Operational processes in blue.

Artifact fusion is performed on each robot to aggregate individual detections from that robot. The Base Station merges incoming artifact reports from all robots into a single report. Artifacts with similar positions and types are merged prior to manual submission. The Human Supervisor is able to view artifact report images, as well as the robot’s map and odometry, which enables manual corrections to the artifact location or classification before submitting the final report. Artifact reports are transmitted over a deployable WiFi mesh-network, as well as map segments, global robot positions, and other useful information for multi-agent coordination. The Base Station does not act as a central agent, however, it can relay information between robots as any other agent can.

Critical autonomy processes like mapping, navigation, and artifact localization rely on accurate and reliable state estimation. The fleet has relied on Google’s Cartographer [34], which uses LiDAR scan matching for local odometry, and scan-to-submap optimization to correct for drift via global loop closures. Despite other LiDAR-inertial SLAM algorithms having greater accuracy such as LOAM [89], Cartographer was selected for its real-time loop closure drift correction, ease of use, and thorough documentation.

Optimizing goal point selections and the paths to reach them is critical to exploration efficiency. Custom solutions have been developed by our team for selecting new goal points and navigating to them based on the expected topology of each circuit environment. A graph-based navigation and exploration strategy was employed for the Tunnel circuit event. The environments for Urban and Cave circuit events are more spatially complex than the tunnel environments, and so a more comprehensive frontier-based exploration algorithm was developed. These solutions are discussed in greater detail in Sections 4 and 5. To map the environment, the ground robots use the open source package OctoMap [36] to generate a probabilistic occupancy grid representation of the world. To support the needs of our multi-agent solution, several additions like map-merging were made to the OctoMap package and are discussed in Section 3.

Some of the processes, such as localization, global planning, and artifact detection are common to both aerial and ground platforms with minor adjustments. However, the lower level subsystems are designed separately. The aerial vehicles use Voxblox [60], to generate a Euclidean signed distance field representation of the environment, which is useful for generating paths with sufficient clearance from obstacles. The UAVs also use upward and downward facing depth sensors in addition to the horizontal Ouster LiDAR for mapping. This setup increases the volumetric information gain in the vertical direction, which is essential in traversing shafts and stairs. The UAVs also have a different local planning solution developed exclusively for 3D navigation, and is based around planning within the depth image space. Detecting obstacles directly in the sensor frame provides immunity to mapping and localization uncertainties to a large extent, serving as an additional layer of safety while following the path. This is discussed in greater detail in Section 6.

3 Map Merging

Three-dimensional maps were required for our planning solution in Section 5, human supervisor situational awareness, and for use by DARPA. The MARBLE mapping solution uses OctoMap to generate 3D occupancy grid representations of the environment, which is a direct input to global planning and provides situational awareness for the Human Supervisor. The octree structure of OctoMap’s occupancy grids makes storing and transmitting maps more efficient than other representations such as point clouds; this efficiency is highly desirable when trying to transmit maps over wireless communication networks. While octrees are efficient data structures, transmitting entire large-volume OctoMaps through bandwidth-limited communication networks can lead to network congestion. For this reason, incremental map transmission can assist in efficient information transfer [75]. A more complete view of the environment can be generated using map data from multiple agents and merging maps from multiple robots can also reduce redundant coverage [41], [77], [94]. In addition to obtaining map data from a direct neighbor, map data from other agents that the immediate neighbor has come into contact with can also be added to the agent’s map [37].

Figure 4: Example of a multi-agent merged map, from a field deployment at Edgar Experimental Mine in Idaho Springs, CO. This map was generated from a collection of diff maps from two robots.

Merging maps across robots is critical to our multi-agent coordination strategy, detailed in Section 8, but merging is not a capability in the standard OctoMap package. Following lessons learned discussed in Section 9.3, we developed our own mapping package [68], which is a fork of OctoMap Server for real-time mapping with map merging built-in. Instead of merging in maps from other robots after an agent’s self map has been generated, which would require an additional iteration over an agent’s “self” map, new map sections are merged in at the same time as new sensor data. By adding the merging functionality directly to the map creation process inside of OctoMap, valuable computing resources can be conserved. Figure 4 illustrates a merged map during a test deployment at Edgar Experimental Mine in Idaho Springs, CO. The lighter gray image represents the Cartographer map generated by one of the agents who explored the left side of the mine. Another robot traveled to the right, and transmitted its map over the communications network, creating the complete map shown.

Another desirable feature that is not provided with the stock OctoMap package is the ability to generate differences between different map sections, or “diff maps”. OctoMap generates the full Octree map structure, which can become prohibitively large to transmit for map sharing purposes. While incremental point cloud transmission is a common technique, we are not aware of another technique of breaking up OctoMaps for incremental transmission. In our modified OctoMap package, diff maps can be created at a predetermined rate, and contains all the mapping data for that time interval. The sum of an agent’s diff maps make up its “self” map. Having access to smaller sections of an agent’s map allow the multi-agent node to transmit just the new diff maps over the communications network, instead of the entire map. This also benefits the map merging process, as smaller sections of the map are received for merging instead of the entire neighbor map, as seen in Figure 5. Another example of the benefits of transmitting map diffs is demonstrated in Figure 19, where one agent has started to explore and is sharing map differences back to the base station. This allows the next agent to plan a path directly to a candidate goal point over sections of the map it has received from another agent.

The majority of the mapping processes occur on both the robots and the Base Station. Both types of agents receive and transmit all diff maps for every robot, as communication allows. Robots generate diff maps and merge map segments received from other robots and the Base Station. The Base Station does not generate new map segments, but is able to re-transmit segments to robots that need them, and also merges the maps for use by the Human Supervisor. The multi-agent framework discussed in Section 8 uses a request/response method to retrieve any missing diffs. The diffs are allowed to arrive out of order, and in the case where nodes have differing values, the latest sequence number, which is embedded in the diff, is used to ensure the data is current.

Implementing differences maps resulted in a massive bandwidth savings over repeatedly transmitting the entire map at the same intervals. For a typical one hour mission, a robot may produce a two megabyte OctoMap, which when transmitted at 10 second intervals totals approximately 360 megabytes over the entire hour. The same map when transmitted as a differences map typically requires more data due to the overlap that occurs when nodes change values across transmissions, and is not a fixed rate; however observation showed differences maps average approximately 10 kilobytes in size per transmission. Therefore a one hour mission totals approximately 3.6 megabytes, or about 1/100 of the repeatedly transmitted map.

Figure 5: Sequential diff maps from left to right, with the final map on the far right constructed in real time for comparison. The diff maps can be merged to fully reconstruct the original map.

The diff map implementation also enables the removal of “bad” map sections that have been shared to other agents. This is useful in cases when another agent shares sections of a map that are misaligned or corrupted, which can occur for a number of reasons including localization drift and sensor failures. In the case of narrow hallways, merging in bad map sections from another agent can result in an inability to plan paths effectively. Through the Base Station GUI and the multi-agent node, the Human Supervisor is able to reset a particular agent’s map on every other agent, effectively clearing bad map sections that have been shared to other agents. Using diff maps, the Human Supervisor can be relied upon to resolve mapping inconsistencies and potentially resolve otherwise mission-ending conflicts.

4 Metric-Topological Planning and Reactive Control

Subterranean environments are a challenging communications environment. It was determined that our systems would need to be able to travel outside the communication range of the base station, explore the environment, identify artifacts, and return to communications with the base station to relay artifact information back. For these reasons, a heavy focus was placed on developing robust exploration and navigation strategies that are entirely autonomous and can operate outside of communications range of the Base Station. Some exploration approaches represent the environment through topological graphs [24]. It has been shown that graph-based exploration is useful in tunnels [82], indoor rooms [9], and maze-like indoor environments [61]. After a graph is built, it can be used to efficiently navigate from one node to another [12]. The centering algorithm used to traverse edges of the graph is bio-inspired. Insects rely on patterns of optic flow to generate a centering flight response [81], which was tested in [71] and [32], whereas our systems rely on LiDAR depth measurements. Insects also rely on optic flow for small-obstacle detection and avoidance [6], and which has been demonstrated as a viable obstacle detection method onboard multi-rotor platforms [58].

For the Tunnel circuit event, our team deployed a fleet of ground vehicles in a largely 2D environment. The planning strategy assumed a 2D environment that could be approximated accurately with a graph (vertices and edges), and that the graph could be traversed using the reactive centering controller on edges. Tunnel environments fit reasonably well within this assumption with a few exceptions in larger open areas. The approach relied on a binary image thinning algorithm which we performed over a Gaussian-blurred occupancy grid image [90]. Then, an image convolution is performed on the skeletonized map to detect vertices and edges. The results of the approach can be seen in Figure 6 which shows sample graphs from Edgar Experimental and NIOSH mines. Vertices are labeled differently if they contain 1 or 3 or more edges or if they are an unexplored edge. Estimating a graph using simple image processing proved quite effective at the Tunnel circuit event.

To traverse the graph, the vehicles relied on a reactive centering controller operating on depth scans from the front mounted RPLIDAR. Estimates of environment relative states, such as the lateral and angular displacement of the vehicle from the centerline of a hallway, are extracted from the depth scans using bio-inspired wide-field sensor integration methods. The estimates are used as feedback to generate steering commands that drive the vehicle to the center of corridor like structures. An additional steering controller is integrated with the centering controller for reactive small obstacle avoidance. At vertices, a simple proportional steering controller was used to travel to the center of each vertex, turn to face the desired new edge, and resume centering to the next vertex.

Figure 6: Examples of the graph conversion from a blurred occupancy grid image. The two images on the left are from the Edgar Experimental Mine in Idaho Springs, CO, and the two images on the right are from NIOSH mine during the Tunnel circuit event. In both sets, the left image is the raw binary occupancy grid generated by the robot’s perception system and the right image is the resultant graph estimate. Edges are shown in white and vertices are labeled with circles. Red circles are multi-edged vertices, blue circles are single-edged vertices, and green circles are the ends of unexplored edges.

An overview of the reactive centering controller is presented in Figure 7. On the left side of the figure, a top down view of a ground robot in a hallway environment is shown. The robot has both a lateral displacement and an angular displacement relative to the center-line of the hallway. These are the states we are interested in regulating for the purpose of centering. The robot is equipped with a 2D depth scan sensor that measures depth as a function of the viewing angle and robot state . Measured depth is hypothetically unbounded, and so the depth scans are converted to nearness , which is a bounded signal. Examples of nearness scans are shown in the plot in the middle of Figure 7, where the red signal represents the measured nearness of a robot with both lateral and angular displacements and the blue signal represents the measured nearness of a robot that is perfectly centered in a hallway (). Nearness scans are useful in the case of centering because they encode the hallway relative states and . Equation 1 represents analytic nearness in an infinite hallway as a function of the hallway relative vehicle states and and the hallway half-width .


By projecting the measured nearness signal onto different predetermined shapes, estimates of the hallway relative vehicle states and can be generated and used to produce the desired steering response. This process is shown in the right side of Figure 7 where the measured nearness signal is projected onto different shapes . The scalar outputs of the projections, which represent the environment relative states, are pooled through the gain matrix to generate the different control signals. The generation of the steering command using the spacial inner product is detailed in Equation 2, and the weighting shape that achieves a centering response is given in Equation 3. In Equations 2 and 3, scalar gains and are used to adjust the responsiveness of the steering controller to lateral and angular displacement respectively.

Figure 7: Overview of the centering controller algorithm. On the left is a top-down view of a ground vehicle in a hallway. The plots in the middle show examples of different nearness signals. A data flow for the controller is shown on the right side of the figure.
Figure 8: Example trajectories from testing in Edgar Experimental Mine (left) and a small section of Tunnel circuit event at NIOSH Mine (right). The centering controller guides the vehicle to nodes on the graph.

This centering algorithm is well suited for environments that resemble hallways, but it is also able to achieve a centering response in non-uniform environments as seen in Figure 8. Due to integrating hundreds or thousands of sensor measurements, the generated control commands are robust to noise in the measured nearness signal. The algorithm is also robust to small-obstacles in the measured environment; small-obstacles, which produce perturbations in the measured nearness signal, do not cause large deviations from the center of the environment. As a result, a separate small-obstacle detection and avoidance algorithm is used in combination with the centering controller to ensure the system avoids obstacles of all sizes while navigating the graph. The relative distance and angular position of small obstacles in the environment are extracted from the depth scan through inhibition of the measured depth scan with a blurred, low-frequency reconstruction of the scan. The small-obstacle detection and avoidance process is presented in greater detail in [58], and the complete navigation solution for the Tunnel circuit event is detailed in [59].

For determining the next best edge to explore, the team developed different exploration strategies. Initially, a Silent Explore strategy was developed in which the different systems were completely independent and did not share information. This exploration strategy was designed to keep the vehicle moving quickly through the environment while it searches for artifacts. Once an artifact is detected, it switches its current mission mode from “Explore” to “Report”, and a path is planned back to the base station to relay the artifact information back. The second strategy was Greedy Explore, which requires a more robust communications network. This allowed the robots to explore deeper into the environment without returning all the way to the base station to report artifacts and maps. This was implemented primarily through the communications beacons detailed in Section 7, to increase the range of network, but they were not required to partially implement this strategy, as the robots themselves could also act as a relay. In this strategy, like the previous, when an artifact was detected, the robot entered Report mode and began a path toward the base station. However, once a robot received acknowledgement from the base station that an artifact had been reported, the robot returned to Explore mode and continued to explore the environment until the next artifact was found. The Greedy Explore method was used through all phases of the competition, although communications beacons were not deployed during the initial tunnel event.

Run Course H01 H02 H03
1 SR - - -
2 EX 150 840 450
3 EX - 1595 953
4 SR - 420 445
Table 1: Linear distance traveled in meters, of MARBLE’s three-Husky fleet, during the NIOSH Experimental Mine (EX) and Safety Research Mine (SR) deployments at Tunnel circuit event.

Experimental results from the Safety Research (SR) and Experimental (EX) section of NIOSH Mine are presented in Table 1. We had difficulty getting our systems localized against DARPA’s gate during the first run, and we were unable to deploy any vehicles in the time limit. During runs where we were able to get our systems out of the gate, we averaged just under of linear distance traveled per vehicle. Figure 9 shows a run in the Experimental section where the system covered 1.6 linear kilometers in under an hour. Figure 6 shows the graph structure generated from a single agent during another Tunnel competition run, as well as a deployment at Edgar Experimental Mine in Idaho Springs, CO. We had not developed a multi-agent coordination strategy fully at the time, and so our agents often cover the same areas. A similar graph-based exploration approach was used by Team CERBERUS, and the results from larger scale experiments inside different subterranean environments, including Tunnel circuit, are presented in [18]. In their ground vehicle tests, their systems are able to cover hundreds of meters in one hour deployments. Team EXPLORER deployed a graph-based exploration strategy at Tunnel circuit, the results of which are summarized in [55]. While Team CoSTAR used a frontier-based exploration strategy at Tunnel circuit, they were able to cover an impressive amount of the course in the time limit [63]. For our graph-based approach to perform robustly in more complex 3D environments, a more generic graph-building process could be adopted as a part of the team’s future work.

Figure 9: UGV agent trajectory (yellow) and OctoMap (rainbow) during autonomous exploration mission at NIOSH Experimental Mine in Bruceton, PA.

5 Continuous Frontier View Planning

The graph-based planning approach presented in Section 4 assumes that the environment is readily approximated by a graph. For more general 3D environments, previous works have looked at representing the environment using occupancy grids [36] and signed distance fields [60]. Given a continuous map representation, a robot can explore an unknown environment by consistently navigating towards the frontier, or the threshold between the observed and unobserved [87]. Although this can be effective in 2D, the frontier is often sparse in 3D environments because of gaps in depth sensor fields of view and noise in the observed map. As a result, modern exploration approaches focus on exploring the environment by selecting trajectories or goal poses that maximize information added to the map [64] [15]. This is often accomplished by considering an outward expanding network of motion primitives [21] or trajectories generated through an RRT* [8] [72]. These approaches generate efficient exploring behaviors when the edge of the map is in close proximity to the robot, but they can struggle to break out of local planning minima when reaching dead-ends in larger environments.

The MARBLE 3D exploration solution is an integrated planning approach that considers the map information of frontier-facing goal poses with a rapid cost-to-go calculation using fast marching methods that works on both air and ground vehicles. By limiting the sampling domain to frontier-relative goal poses, the robot’s attention is constantly focused on the edge of the environment resulting in navigation away from dead-ends and local information minima. Although frontiers can be sparse in 3D, we utilize a two filtering methods to focus on frontiers that are connected to other frontiers. The frontier view planning strategy takes as input a map, , of the environment and the current vehicle pose, x, and outputs a utility table. The map,

, is a 3D voxel representation of the environment where each voxel contains an occupancy probability and Euclidean signed distance to the closest obstacle. This utility table is a list of goal poses, their utilities, and paths from the current robot pose to each goal pose. Global planning is split into two phases: (1) frontier view sampling, where frontiers are filtered and goal poses are sampled relative to the frontier and (2) utility optimization, where the utility of each sampled goal pose is calculated by dividing the information gain of each goal pose by a multi-goal cost-to-go calculation.

5.1 Planning Preliminaries

To understand the approach taken in this section, it’s important to establish some preliminary definitions. The map is a set of voxelized grid cells , defined as


where is the set of all integers and is an upper bound on the map dimensions. The map, , can be separated into two subsets, the seen space, , and the unseen space, . Within the seen space, voxels are either free, , or occupied, . More formally, these subsets are defined below


where is the probability that the voxel cell is occupied, and and are the thresholds for considering a voxel free or occupied respectively. In addition to occupancy probability, the distance to the closest occupied voxel is defined at each map voxel. Occupancy probability at each map voxel is stored in the merged octomap data structure maintained by our mapping solution and the distance transform of the occupancy grid is stored and updated incrementally by running an efficient Euclidean distance transform function at regular map update intervals [92].

The set of traversable voxels, , are the set of voxels containing valid robot poses. For a quadrotor this is defined as


where is some safety radius. The safety radius should be a bit larger than the radius of a sphere containing the quadrotor. For a ground vehicle, free voxels with a bottom neighbor voxel, , that is a member of the ground voxel set,

, are considered traversable. A ground voxel is an occupied voxel whose local surface normal vector’s z-component,

, is greater than or equal to some threshold, . A formal definition is shown below.


This restricts the ground vehicle’s planned motion to surfaces below a certain inclination. When computing the Euclidean distance transform for ground vehicle planning, we ignore voxels in the ground voxel set so that is the distance from the nearest occupied voxel that is not in the ground voxel set, .

5.2 Goal Pose Sampling

The first phase of the global planning algorithm is goal pose sampling. Goal poses are sampled relative to the frontier, which are free map voxels adjacent to an unseen voxel. This is defined below as


where is the set of map voxels that are seen and free, is the set of unseen map voxels, are the neighbors of voxel , and is the indicator function for membership in the unseen voxel set. Frontier voxels are labeled by the FindFrontierVoxels method on line 2 of Algorithm 1. In 2D this is often sufficient for finding potential robot goal points, however in 3D the raw frontier voxels are often spurious and can lead to observing little unseen map volume. For this reason, our approach filters the frontier voxels before sampling goal poses in a two step process. Due to the way our 3D LiDAR sensors are mounted on our platforms, it can be difficult to observe frontier voxels along the ceiling or negative space near the ground plane. Frontiers whose local plane fits have a large normal z-component can often be difficult to view with a sensor field of view aligned with the x-y plane and lead to sampling goal poses with small information gains, and so they are filtered out. Similarly, frontier points that are not part of a larger contiguous cluster often produce goal poses with little map information, and so voxels are filtered to eliminate spurious frontier voxels that are not part of a larger cluster. Frontiers are filtered by the FilterFrontierNormals and FilterFrontierContiguous methods on lines 3 and 4 of Algorithm 1. is the frontier plane fitting radius, is the range of acceptable z-components for the local frontier plane normal vector, and is the minimum number of contiguous frontier voxels to form a cluster.

1:  path
2:  FindFrontierVoxels
3:  FilterFrontierNormals
4:  FilterFrontierContiguous
5:  SampleGoalPoses
6:  ComputeCostToGo
8:  pathFollowGradient
Algorithm 1 Frontier View Planner
Figure 10: A 2D drawing of the frontier view pose sampling and planning approach. 1) The robot builds an occupancy grid of the environment. White cells are free, black cells are occupied and gray are unseen. 2) Frontiers are labeled in green as free cells adjacent to unseen. 3) Frontiers are clustered based on contiguity (orange, red, and purple) and filtered if the clusters don’t contain a minimum number of cells (2 cells in this example). Clusters are further divided into groups, denoted by the colored lines, using a greedy sample-based grouping algorithm. 4) Groups are used to sample informative goal poses (purple circles) relative to the each group’s centroid. Information gains are calculated based on cells in the sensor field of view at each goal pose. 5) A Fast Marching Method is used to calculate the cost-to-go to each goal pose and the gradient of the wavefront is used to generate a path to each pose that the front reaches. 6) A list of the best n goal poses is published where n is the number of robots within comms. The green path is selected in this n=1 example.

After filtering the frontier voxels in the map, the planner samples candidate goal poses relative to those frontier voxels. This procedure is detailed in Algorithm 2. The goal sampling algorithm starts with a greedy grouping procedure where frontier voxels are randomly sampled from the ungrouped set, \Groups, and grouped with their frontier neighbors within a radius of that have not yet been added to the grouped set. Once every frontier voxel is grouped, candidate goal poses are sampled relative to each group centroid, , until an admissible and non-occluded goal pose, , is found for each group. Admissible poses have a position within a traversable voxel. Poses are sampled uniformly in polar coordinates relative to the corresponding group centroid. The sampling radius, azimuth, and elevation ranges are bounded such that the group centroid is within the sensor field of view of the robot at the sampled pose. A 2D example is shown in steps 3) and 4) of Figure 10. The colored rectangles in step 3 are grouped frontiers and the purple circles in step 4) are the sampled poses relative to those groups. This grouping and pose-sampling procedure was derived and adapted from an approach used by underwater surface inspection robots [26].

1:  , Groups
2:  while  \Groups do
3:      Sample \Groups
5:     for  GetFrontierNeighbors do
6:        if  Groups then
8:        end if
9:     end for
10:     Groups
11:  end while
12:  for  Groups do
13:     while True do
14:         SamplePose
15:        if CheckAdmissible then
16:           if !CheckOcclusion then
18:              Break
19:           end if
20:        end if
21:     end while
22:  end for
Algorithm 2 SampleGoalPoses

5.3 Utility Optimization and Cost Evaluation

After candidate goal pose destinations are sampled, the planner evaluates the poses using a simple mapping rate utility function defined below


where is a candidate goal pose, is the current robot pose, FrontierInFoV is the number of frontier voxels visible from the candidate goal pose, and Cost is the approximate travel time to get from the current goal pose to the candidate goal pose. This is required to select the best utility among the candidate goal poses (line 7 in Algorithm 1). Other approaches have looked at information-theoretic utility functions that consider the entropy reduction of a particular path or pose. These approaches consider the value in obtaining more accurate occupancy estimates of the seen voxels in the map. However, for the purpose of exploring the environment as quickly as possible we assume the only valuable voxels to see within the map are those adjacent to unseen portions of the environment.

Figure 11: RViz views of a single agent exploring the Edgar Experimental Mine in Idaho Springs, CO. a) Example of the Euclidean distance transform () map generated during the planning phase. The color of the voxel encodes distance to the nearest occupied cell with red being next to an occupied cell and green / blue voxels as far away from occupied cells. b) Example of a path planned over the speed map to a cluster of frontier. Colored voxels represent occupied cells in the occupancy grid, opaque white voxels represent frontier, and the red line the is planned trajectory to the next goal point.

In order to evaluate the utility function at each candidate goal pose, we first need the cost to get there. Line 6 in Algorithm 1, ComputeCostToGo evaluates the cost for each candidate goal pose according to the equation below.


The first term, , is an approximation of the travel time from the robot’s current position to the voxel position of the candidate goal pose, , using a multi-stencil fast marching method. The second term is the time required for the robot to turn in place from its current heading, , to align with the initial path heading , added to the time required to turn from the final path heading, , to the final goal pose heading. Fast marching is a level set method that calculates the arrival time, , of a wave front starting at the robot’s current voxel location ), to each voxel in the set of traversable voxels, . This is calculated using a fast approximation of the solution to the Eikonal Equation


where is the wave propagation speed at voxel [73] [42]. A constant speed map yields a fast approximation of the cost-to-go to each voxel in the map equivalent to Dijkstra’s Algorithm. The safety of the resultant path produced by the planner can be augmented by computing a speed map at each voxel, , according to the following equation


where is the distance to the closest occupied cell. This function maps the distance to the closest occupied voxel to a speed in the range , resulting in paths that are obstacle-aware. This means that the planned paths will tend towards the medial axis of the environment, which is analogous to the middle of a hallway, whenever possible [45]. Algorithm 1 finishes by computing paths to the best candidate goal pose(s) by following the gradient of the wave front arrival time, , from each pose back to the robot’s current voxel. This is quickly done by evaluating the 3D Sobel operator on the 26-voxel neighborhood of each voxel from the candidate goal pose back to the robot.

Figure 12: RViz views of a single agent exploring the GeoTech warehouse in Denver, CO., where (a) is a top-down view of the final map after a 25-minute deployment, and (b) show the agent actively planning a path. Colored voxels represent occupied cells in the occupancy grid, opaque white voxels represent frontier, and the red line the is planned trajectory to the next goal point. Planned paths tend towards the medial axis of the obstacle environment, but here we see the path hug the left side of the corridor due to a false obstacle in the underlying distance transform.

Although this guarantees that the planner will find the candidate goal pose that minimizes the proposed utility function, calculating the fast marching cost-to-go to every goal pose can become prohibitively expensive if some of the candidates are far away from the robot’s current position. For this reason, there is a stopping criterion based upon the best possible utility of any candidate goal pose that has not been evaluated, , is bounded according to the equation below.


This bound exists because the current fast marching voxel wavefront arrival time, , is an increasing function with algorithm run time. If we consider the worst possible heading penalty term, , the best utility of any remaining candidate goal pose must be below this bound. The fast marching algorithm stops if the current best goal pose utility among those evaluated is better than any remaining goal pose utility. This extends naturally to the case of multiple robots. Fast marching evaluates until the best candidate goal poses that are some minimum distance apart are evaluated, where is the number of neighboring robots. Then the global planner returns the best poses, utilities, and paths for the coordination scheme. Paths are followed using a simple steering controller driven by the vehicle’s heading error with respect to a look-ahead point a fixed distance down the path.

Figure 13: RViz views of a single agent exploring the Beta Course at SATSOP nuclear facility in Elma, WA, during the Urban circuit event where (a) is a top down view of the map with the red dot indicating the location of (b) a third person perspective.

5.4 Experimental Performance

Examples of planned paths on the UGV in the Edgar Experimental mine and GeoTech warehouse environments are shown in Figures (b)b and (b)b. As shown in these two map images, the robot successfully plans over the mapped obstacle environment to a candidate goal point s of meters away. Figure (a)a shows the full route taken by an agent when exploring the GeoTech warehouse, which is an extremely cluttered environment. Examples of deployments at SATSOP nuclear facility for the Urban circuit are shown in Figures 13 and 14. Figure 4 shows a map of sections of the Edgar Experimental Mine that was generated by two separate robots who were planning over a shared, merged map using this exploration method. This global planning method was also tested on our aerial vehicle in the GeoTech warehouse. The results of this test are shown in Figure 17 where the aerial vehicle was able to explore about a fifth of the entire warehouse during a single 10 minute flight. As can be seen in these figures, both air and ground vehicles successfully map a reasonably large portion of these cluttered environments with a minimal amount of overlap of previously explored locations.

Figure 14: UGV trajectory (yellow) and OctoMap (rainbow) during autonomous exploration mission, shown both at an (a) top-down view, and (b) angled view. This field deployment took place in Alpha Course at SATSOP nuclear facility facility in Elma, WA, during the Urban circuit event.

A similar approach to exploration is used in [15], where 2D exploration is demonstrated in an office like environment with a ground vehicle and 3D exploration is demonstrated in an indoor stairwell with an aerial vehicle. In [72], a comparison of the performance of different exploration algorithms in a maze environment is presented. Team CoSTAR presented their results from Tunnel circuit in [63] where they use a frontier-based exploration algorithm when navigating outside of communication range and cover an impressive amount of ground during their runs. One area of opportunity for our frontier-based planner lies in determining what terrain is actually traversable for each of our platforms and incorporating this information into path generation. Due to the size of our map voxels () and the relatively low ground clearance of our UGVs, it can be difficult to discern precisely which sections of terrain will cause the vehicle to get physically stuck. Team CoSTAR has presented their results from Urban circuit in [10] where they use a quadrupedal robot and a traversability focused local planner to avoid hazardous terrain and navigate stairs.

6 Aerial Vehicle Vision-Based Local Control

Typical motion planners in the literature rely on an environment map to plan a guidance path followed by trajectory optimization to obtain a feasible smooth motion plan for the robot [29, 20, 50]. In an extreme environment where reliability is of major concern, this approach alone poses several safety challenges. During field testing, we found that uncertainty around the locations of obstacles can lead to collisions, especially in confined and extremely cluttered spaces. Sources of uncertainty include localization and mapping errors during agile maneuvers, as well as small and thin obstacles that may go undetected by the map. Moreover, if the environment becomes too complex, the continuous optimization runs into a risk of not being able to converge to a feasible solution within the limits of imposed constraints. Tuning constraints on such a problem is often non-trivial and highly dependent on the environment. The concept of planning, based on direct high resolution depth information, has been explored in past in the context of bio-inspired obstacle avoidance [58, 6, 59] and lookahead planning within a depth image [53, 23, 2]. These methods, however, are either only suitable for 2D navigation or are based on lookahead planning. On the contrary, our vision-based obstacle avoidance method is well-suited for 3D and senses and avoids obstacles actively, making it more resilient to a changing environment, localization uncertainty and imperfect path following due to model uncertainty.

We proposed and implemented a potential-based solution that directly utilizes high resolution depth information for actively sensing and avoiding local obstacles while following a global path. The controller ensures that the vehicle kinematics are respected during path-following and the heterogeneous perception scheme (map-based and direct vision-based) improves the perception reliability. Each MARBLE UAV utilizes a two-tier planning strategy: direct vision-based local control and map-based global path planning. The frontier view planner from Section 5 is leveraged to generate a global path for a UAV. A lookahead point is calculated along the path such that the point keeps a fixed distance from the robot at all times until the end of path. The lookahead point serves as the goal point for the local controller. The two-tier planning strategy is depicted in Figure 15.

We assume that the UAV follows the unicycle nonholonomic kinematics where the system inputs are the forward, vertical and steering velocity commands in the robot’s body frame. The goal of the MARBLE UAV local planner is to complement the global planner by avoiding small obstacles that do not appear in the map, and obstacles that become close in proximity due to mapping and localization uncertainty. It is also important to note that the path generated by the frontier view planner is geometric. The local controller is responsible to generate the velocity control commands to respect the vehicle kinematics during path following.

The depth images come from all of the onboard depth cameras for the vision-based reactive control. The depth cameras are assumed to follow the pinhole model. For a small 3D object projecting to depth image pixels, the repulsive vector is calculated as

Figure 15: A depiction of the UAV motion planning strategy. The map-based frontier view planner generates a global path at each replan time instant. A lookahead point is chosen along the path that is a constant distance away from the robot at all times. The reactive controller relies on direct depth sensor information to avoid obstacles that are not captured by the map due to localization and mapping uncertainties. The lookahead point moves along the path as the UAV follows and serves as the goal for the reactive controller.

where is the user-defined gain to tune the aggressiveness of the repulsive potential, is the maximum range of the depth camera and is the depth of the th pixel. In this two-tier planning setup, the goal point, or lookahead point, for the reactive controller is continually updated to be a fixed distance away from the robot, and resides along the global path. The resultant vector is calculated as


where is the direction of the lookahead point in the vehicle’s body frame and is the maximum magnitude of the repulsive vector. The term regulates the speed of the robot depending upon the proximity of the obstacles. As the vehicle enters an increasing level of clutter, the effect of the repulsive vector becomes more dominant. The resulting velocity commands for the UAV are calculated as


where , and are the forward, vertical and steering velocity commands respectively. The maximum velocities for each axis are defined by , and .

Figure 16: Results from a single obstacle local planner flight tests. The black circles represent the UAV physical bounds. The black lines show the path followed by the UAV during each of the maneuvers with red arrows representing the repulsive vectors. The UAV starts from the respective start locations for each of the runs and maneuvers towards the goal points that are (a) 2 m behind the obstacle, (b) 5 m behind the obstacle, and (c) 4 m behind the obstacle. The approximate obstacle location is overlaid on the plots.

In order to evaluate the effectiveness of the reactive controller in an isolated manner, we first carried out several flight tests in the presence of a single obstacle. These tests were carried out in a simpler lab space with MARBLE UAV completely relying on the onboard sensor stack. A small obstacle was placed in the middle of the lab and the start and goal points were set on the opposite sides of the obstacle. Results from three of the tests are shown in Figure 16.

Existing long-range UAV planning methods in the literature such as [8, 17, 18, 21] have been demonstrated in underground tunnels over distances around 150 m or small confined nearly-empty rooms. These environments exhibit general predictable structures, for instance, underground mines typically consist of long corridors connected through junctions with most of the obstacles appearing close to the walls. We carried out flight tests using both global and local planners integrated to explore the GeoTech warehouse facility in Denver, Colorado. Unlike corridor-like environments which are primarily composed of 2D structures, the complex 3D nature of the warehouse environments makes them challenging for autonomous exploration. This particular environment is highly cluttered and heterogeneous since it houses manufacturing activities. Looking up, steel-truss ceilings support the roof, featuring exposed sprinkler, ductwork, and conduit networks, as well as light fixtures and ceiling-to-floor electrical cabling. In case of a UAV navigating in such an environment, even a single close contact of the robot with an obstacle, for instance an electric cable, can prove detrimental to the exploration mission safety. Our two-tier planning setup demonstrated safe and reliable exploration through the environment [3]. One of the runs is highlighted in Figure 17 in which the UAV navigated around 300 m with a full battery pack which amounted for 11 minutes of flight time.

Figure 17: The OctoMap and flight path of a ten-minute autonomous exploration mission for the GeoTech warehouse in Denver, CO are presented from both a (a) rotated and (b) top-down perspective. The UAV travelled approximately 300 m within 30 m 60 m 5 m volume. The ceiling from the original map is removed for better visibility.

While this solution significantly improved the safety of the UAVs, it had difficulty navigating narrow corridors, discerning thin obstacle from erroneous noisy returns in the depth image, and assessing the quantity and size of local obstacles. In order to overcome these limitations in the Urban circuit event, the UAV local planning method was overhauled with a probabilistic technique that explicitly tracks individual obstacles within the depth image. Each input depth image is first discretized in a 2.5D fashion. This implies pixel discretization along the and axes and depth discretization along the axis of the depth image. Each voxel inside the 2.5D voxel grid is considered a potentially occupied region. We based our probabilistic observation and state transition models on the number of depth image points inside each voxel and the ability of an occupied voxel, hence an obstacle, to move inside the depth image respectively. The latter is modelled as a Gaussian governing the expected speed of an obstacle inside the voxel grid. We then used the Sequential Importance Sampling (SIR) technique [79, 22]

which follows a two-step process, prediction and update, to find the posterior of the occupied voxels given a history of depth images. By formulating the problem as a Partially Observable Markov Decision Process (POMDP), we utilized the occupancy probability distribution (SIR posterior) over the voxel grid to generate robot velocity actions. In order to achieve real-time execution of the method onboard the MAV, we used the QMDP approximation to solve the POMDP problem

[48, 78, 49]. The reward function is chosen to be the sum of potentials along the path if a given control input is followed for a fixed horizon. The action space is discretized and the action that best reduces the potential over the fixed horizon is the preferred solution to the POMDP. This technique provides us a robust and more flexible framework to generate robot actions directly from a depth image stream, rectifying major issues with the local planner faced at the Urban circuit. Deeper insights into this motion planner are provided in [4, 5]. Using this approach, we could actively localize obstacles as thin as 8 mm in diameter relative to the robot.

7 UDP-Mesh Based Communications

Implementing effective communication systems in subterranean environments is challenging for a number of reasons, including sudden lost-comm situations and potentially fleeting windows of connectivity. Within the structure of the competition, artifact reports are high-value data, whereas mapping and coordination data are relatively low-valued. This disparity in data importance suggests an operational requirement for quality-of-service prioritization and message delivery guarantees. Meanwhile, using ROS (version 1 unless otherwise specified) for system message passing presents practical challenges to implementing these operational requirements due to inherent architectural limitations. Alternative message transport mechanisms exist; in particular, the transport-agnostic design of ROS2111 has the potential to provide a quality-of-service guarantee at the transport layer in addition to other desirable services such as discovery and name resolution. However, ROS2 was insufficiently developed to meet our needs without major porting efforts; instead, a replacement system was designed to leverage the advantages of ROS2 in a ROS1 environment.

Per design, ROS connections between nodes are not aware of one another. Initial system development utilized the multimaster_fkie package222 to bridge topics between ROS masters in a master-per-robot configuration. Under the multimaster_fkie architecture, standard TCPROS transport is still used for inter-node communication; nodes subscribing across robot boundaries are not aware of the potential for network saturation. For low-bandwidth topics such as telemetry, where message size and update rate (1Hz) require less than 1kB/s, this behavior is acceptable. However, as the total bandwidth required increases, there is no method for prioritizing topics among one another. In practice, this lack of prioritization manifested as message latency spikes, in which large map data transmissions (several megabytes in size) prevented reception of artifact reports and telemetry (under 1 kB each, exclusive of artifact images) due to channel saturation. While the map data was in transit, other higher-priority data was delayed. Traditional methods of implementing quality-of-service are not possible in the ROS environment; for example, methods utilizing specific ports are not implementable due to ROS’ usage of independent links between every publisher and subscriber. Limitations of existing ROS infrastructure necessitate the use of some other transport to provide prioritization services.

The core innovation in our networking stack is the implementation of a custom ROS transport solution based on UDP, called udp_mesh. Udp_mesh provides discovery services and reliable delivery using UDP datagrams compatible with any underlying layer 2 mesh networking solution without requiring any changes to ROS nodes or inspection tools. As an example of a customization for our particular network environment, udp_mesh was implemented without utilizing multicast traffic to recognize the limitations of multicasting over wireless meshes. Udp_mesh implements standard services such as discovery, address resolution, ROS message encapsulation, point-to-point transport, point-to-multipoint transport, and quality-of-service prioritization. Fundamentally, udp_mesh creates a single node on each ROS master through which all nodes attached to that master transmit and receive arbitrary ROS messages through the mesh. Udp_mesh handles fragmentation, transport, and reassembly of ROS messages ranging from single-byte messages up to approximately 2TB per single message. Since all messages are now routed through a single node, traffic shaping can be readily implemented. While independently conceived and implemented, udp_mesh improves upon the Pound [33] 333 package by adding additional quality-of-life services such as name resolution and removing a requirement that topics and priorities need to be declared at compile time. Other competitors faced similar limitations with bandwidth and the ROS networking stack. In [52] both low frequency radios for high priority topics, and high frequency radios for low priority topics were used in conjunction with open source nimbro_network 444 package to solve the ROS transport and prioritization problems. Udp_mesh allows us to control the prioritization of our data at a software level.

8 Multi-Agent Coordination

Figure 18: MARBLE Multi-Agent Framework.

Rapid situational awareness of subterranean environments can be difficult to achieve depending on the size of the environment in question. Having multiple agents can increase the amount of area covered, but they must share information in order to reduce overlap in exploration. Our overall strategy relies on multi-agent coordination through data sharing and goal deconfliction, in order to take advantage of the use of multiple robots with different capabilities and reduce redundant coverage. The primary challenge was designing a multi-agent system that could handle robots frequently leaving communications, due to the difficult communications coverage in the environments. Multi-agent coordination can be effectively divided into implicit methods, where information such as map data is shared and reasoned over [87], and explicit methods, where shared data is used to direct individual agents [14]. Centralized coordination requires a robust communications network, so limited communications environments such as those in the Subterranean Challenge can benefit from a decentralized approach. Although auctions, or market-based coordination [30], are typically thought of using a centralized auctioneer, decentralized systems may also use a market-based approach, such as through an internal single-item auction [80] or Broadcast of Local Eligibility [86].

The multi-agent framework in Figure 18 evolved throughout the competition from simply handling message transmission between agents to providing the full mission management solution for each agent, including both implicit (through map sharing) and explicit coordination (through goal deconfliction)[68]. The framework provides efficient and reliable sharing of information between robots as well as with the Human Supervisor.

Each robot’s multi-agent node compiles local information such as odometry, artifacts, current goal, and number of map diffs available. It packages this data, along with the most current data for any neighbor it is aware of, into a small message that is broadcast to every other agent (robots, beacons and base station) every second. Remote agents compare their own stored data for this agent and if necessary request missing map diffs and artifact images. This ensures any robot has the potential to eventually transmit all data for another robot back to the base station and Human Supervisor.

The multi-agent agent node is responsible for the task management of the robot. Potential tasks include explore, report artifacts, deploy beacon, and process commands from the Human Supervisor. Furthermore, the explore task includes goal selection among several potential goals provided by the global planning node described in Section 5. The selected goal’s path is relayed to low-level control, as well as whether to transition to trajectory following mode to return home. The multi-agent node also monitors when the robot is not able to reach a goal, and marks the area to prevent global planning from continuing to attempt to plan there.

1:  if  or  then
3:  else
4:      true
5:      0
6:     while  and Length do
7:        for  in  do
8:           if GetDistance and  then
9:               true
10:              break
11:           end if
12:            false
13:        end for
15:     end while
16:     if  then
18:     else
20:     end if
21:  end if
22:  return  
Algorithm 3 GoalSelect

Explicit Coordination - The goal selection algorithm also includes a deconfliction process with other robots’ goals through an internal market-based auction [68]. The frontier-based exploration algorithm described in Section 5 produces an array of goal points ordered by . The number of goal points is based on the total number of robots in the system, and each goal point is separated by a minimum distance. These goals are used in Algorithm 3 to select the best goal . Initially, each agent chooses its lowest cost goal point, where cost is a function of path distance, and broadcasts it to other agents. Each agent compares any received goals to each potential goal. If the received goal is within the minimum distance , and the received cost is lower than its own cost, the agent moves down the list until it finds a goal that does not conflict with another agent. If all goals conflict, it continues to its own lowest cost goal. If a received goal is within the minimum distance, but its own cost is lower, it similarly broadcasts its intention. The other agent who broadcast that conflicting goal either receives that goal and performs an identical calculation, causing it to move down its own list; or if communication is broken, it continues to its best goal as if there were no coordination, and in this case both agents navigate to the same area until new goals are found. This selection method does not require a central coordinator or require the agents to wait for responses from others; however, it does not guarantee an optimal solution.

Figure 19: Example of multi-agent coordination in the SATSOP nuclear facility. a) One agent has already been deployed and has reached the purple dot. It has shared its map, frontier, and candidate goal points to the second agent, who is able to plan a path from the start point (blue) to an unexplored room (red). b) Close up of the generated path and a first person view of the environment in the top-left corner.

Our algorithm allows coordination without relying on back-and-forth communication. If messages are lost due to communications errors or no communications, then the agents just act as if there were no coordination and proceed to their lowest cost goals. During simulation this method was highly effective in preventing agents from duplicating exploration. However, during competition this was not well-observed due to limited deployment of robots. The largest multi-agent gains were seen due to implicit coordination through map merging, discussed in Section 3, which allowed the robots to plan over maps received from other agents. This was most evident at the starting gate, where the first robot would pass its map back to the next robot in line, and instead of planning a goal point a few meters in front of it, the next robot could create a plan along the entire length of the hallway right from the start. This scenario is shown in Figure 19.

9 Lessons Learned

9.1 Artifact Detection

Initial Evaluation

- Object detection is a well researched problem in computer vision and we evaluated state of the art methods for both 2D and 3D detectors. Common 2D detectors such as region proposal based networks like Fast R-CNN


require multiple passes over an image to classify an object and then detect where the object is in the image. In contrast, YOLO

[67] performs both classification and detection in a single regression making it a significantly faster detection (0.5 FPS for Fast R-CNN and 45 FPS for YOLO). Various methods exist for classifying objects from 3D point clouds [54] [65]. While methods such as Pointnet have been shown to run efficiently on powerful GPUs, they are still limited to classification and not full detection. Extensions such as Voxelnet [93] and PointRCNN [76] have been made to perform object detection however, they require powerful GPUs which are impractical for mobile robots. As a result, we chose to perform 2D detection using the latest YOLO model [27]. Since the challenge requires a singular point estimate within a 5m radius of ground truth, for each artifact we are able to perform depth estimation using external depth data after the initial detection in a 2D image. We shifted our classification hardware from a NVIDIA Jetson TX2 to an NVIDIA GTX 1650 with TensorRT acceleration [83], allowing for classification at 60FPS using the YOLO V3 model [27] at a resolution of . As a result of increased inference rate and resolution, artifact filtering/fusing can conclude faster before the robot moves out of view, and do so with a lower false-positive rate.

Over four runs at the Tunnel Circuit Event, in which our team took 4th place, we successfully scored 17 artifacts and falsely reported 7 artifacts which did not correspond to a true artifact. Of the 17 successful reports, 8 were originally reported at an incorrect location as a result of orientation error in the initial robot to DARPA artifact frame transform computed at the gate, and required the Human Supervisor to adjust the location in order to score the points. Our ability to score points at the Urban circuit was limited due to mobility issues, which prevented us from reaching many artifacts.

Artifact Fusion - Despite training the network in the presence of various conditions (motion blur, dim/intermittent lighting, camera angle, robot platform, etc), the classifier network cannot completely capture these effects, and so the confidence of a single classification can vary. Therefore, during this filtering/fusing step, we require a sequence of consistent positive classifications in order to file a single artifact report. This approach enables us to train the network using typical metrics and then independently tune the filtering/fusing such that the false-positive rate is within an acceptable range for a given robot in a given scenario (rather than requiring us to re-train the network several times). For example, during the Tunnel and Urban circuit events, our Human Supervisor filters incoming artifact reports before submission, and so a higher false-positive rate reduces the chances of missing an artifact; however, during virtual circuit events, the limited number of artifact reports are autonomously submitted, and so a low false-positive rate is necessary. Nevertheless, in the spirit of the competition, we tune our algorithm such that only highly confident artifact detections are forwarded to the base station for reporting.

Camera Configurations and Algorithm Modularity - As we progressed through the challenges, we learned that each new subterranean environment presented new challenges for detecting artifacts. Originally, our artifact detection solution was completely coupled with the use of a Realsense D435, which the team found to be unreliable. The team decided to pursue an artifact detection and localization solution that was agnostic to camera and depth sensor selections. We obtain an artifact depth estimate by projecting the located artifact in 2D image space into the generated 3D OctoMap. Depth computation is done by casting a ray towards the direction of the center of a bounding box produced by the YOLO V3 model and returning the first intersecting voxel. By using an OctoMap, the framework is agnostic to the type of depth sensor used. However, our depth accuracy is then limited by the resolution of the OctoMap. Based on the competition accuracy requirement of 5m, the resolution limitation was accepted. By using our projection framework, the system operates with any calibrated RGB camera that has a known transformation to the robot’s map frame. This flexibility enables us to test our artifact detection pipeline on any RGB camera setup without any significant software changes and more readily adapt to changing subterranean environments.

9.2 Localization

Robustness in Austere Environments - One of the major challenges in the DARPA Subterranean Challenge is achieving reliable localization performance in austere environments. Vision-based solutions have traditionally dominated this space [47, 57, 66]

due to the maturity of computer vision feature extraction

[16, 7, 88]. It was expected that the maturity of visual-inertial SLAM packages [57, 66] would translate to greater algorithm stability. However, we learned that performance in the lab did not transfer to the field. At the SubT Integration Exercise (STIX), visual-inertial SLAM was unstable at times, losing tracking and entering unrecoverable states. Specular highlights caused by reflective surfaces and inadequate lighting, as well as feature-poor scenes, were chiefly responsible for tracking failures. Because the robot fleet needs to be able to localize in a wide variety of previously-unknown austere environments, reliance on visual sensing modality was deemed too large a mission risk. While research in overcoming these issues is ongoing [39], agents were transitioned to LiDAR-inertial localization strategies. Field testing has shown that relying on visual or LiDAR sensing modalities alone may not be sufficient to localize a robot through fog, dust, or smoke. Recent work focusing on multi-modal sensor fusion [40] and robust state estimation [70] are inspiring for future research directions.

Computational Efficiency - During the Tunnel and Urban circuit events, the team leveraged a 2D version of Cartographer, constraining the vehicle to a plane, and making it computationally faster. However, during hour-long missions in more complex environments, Cartographer 3D faced computational limitations with its loop-closure scan-to-map global optimization routine. Minute-scale latency during field tests was not compatible with the rapid mission tempo, and sometimes a lack of convergence led to large uncorrected heading errors. More recently, LIO-SAM [74] pushes toward higher real-time performance by reducing raw scans to planar and edge features similar to LOAM [89], and simplifying loop closure optimization via scan-to-scan matching. Since real-time localization is the backbone of our autonomy stack, agents may be transitioned to LIO-SAM if proven reliable in a diverse array of underground environments.

Multi-Robot Alignment and Localization - When deploying multiple robots, there are several advantages to having them coordinate and share information, as discussed in Section 8. Sharing information is often more beneficial if the information shares a common reference frame. DARPA provides several options for localizing against a global reference frame including Apriltags [51, 13, 85]

, generic retro-reflectors, and survey reflectors. Transforms from the targets to the origin are provided by DARPA. The individual teams are responsible for sensing the various targets and using them to align their robots to the global reference frame. Of the provided options, the survey reflectors gave the most accurate and consistent transforms for our systems. Separate analyses concluded that the position variance of Leica prisms is on the order of millimeters

[43], consistent with the centering accuracy specified by Leica [46], whereas Apriltag variance is on the order of centimeters [1]. Each system is equipped with a set of three survey prisms, and both the robot and gate transforms are estimated in the survey station’s frame using Horn’s absolute orientation method [35]. This information is used to create an estimate of the robot’s pose in the global reference frame.

Multi-robot alignment requires highly accurate orientations; as the distance increases from the origin, minor orientation errors in initial map to world transformation can lead to increasing position errors relative to the world frame across robots. Across ten tests surveying a transform estimate from the same three prisms our chosen method showed a standard deviation between the transforms of

of roll, of pitch, and of yaw and an average roll and pitch estimate of and respectively relative to a gravity aligned global frame. Horn’s method outperformed numerical methods used during the Urban circuit event, which varied significantly despite relatively small differences in the robot’s initial orientations. This was due to local minimum inherent to the non-convexity of rotation estimates. The survey prism-based alignment also outperformed estimates of alignment using Apriltags locations derived from the robot’s forward-facing camera. Pose estimates generate from Apriltags had high variance since the robots’ front facing camera could only localize all three Apriltags far from any tag and the camera viewed the left and right Apriltags with yaw from the tags center. Both a sensor’s distance [85] and yaw angle [1] are known to decrease estimated pose accuracy, and even these relatively minor effects led to significant pose estimate errors. For the first Tunnel Circuit deployment ICP alignment conducted after the fact estimated the difference between the first robot’s map and the third robot’s map in the world frame was of roll, of pitch, and of yaw in the worst case.

9.3 Mapping

Map Merging Efficiency - As discussed in Section 3, the ability to merge maps is critical to our multi-agent strategy. Originally, we used a custom merging node that accepted OctoMaps from the multi-agent node as well as the standard OctoMap Server running locally on the robot. A full merge of each map was performed every second. This proved to be computationally intensive as the map size increased, and so a method of comparing the growth of the maps was added to eliminate unnecessary map merges. If the map of a neighboring robot stopped growing, because the robot stopped moving or it lost connection with the communications network, that map was no longer merged, as it was already part of the local merged map. This drastically reduced the computational requirements. We later developed the diff map solution because this solution still had high computational requirements and more importantly, high communications requirements. Our original design transmitted the entire map for each robot every second, while our diff map aware node only transmitted small differences maps every 10 seconds. Compared to transmitting the full map at 10 second intervals, diff maps used an average of 1/100 the bandwidth of our full-map solution.

Figure 20: Example of merged maps: (a) without prioritization (b) with self-prioritization.

Self-Prioritization - Maps were not re-aligned prior to merging, as it was assumed the robots were already in a common reference frame with small error. We were using a voxel size of for the maps, and so it was necessary for each robot to have an initial world to map transform with under of translation error to ensure map data is merged properly. However, during testing prior to competition, it was found that small alignment errors could cause obstacles from a neighboring map to block open space for the robot that performed the merge, and thus preventing the robot from planning any further. A self-prioritization feature was added to combat this failure mode. Instead of a full merge, only an append of new information would be performed. In essence, the robot would generate two maps, one using its own sensor data as a truth source, and another merged map where it only appended cells from other maps in “unknown” areas, and never overwrote its own “seen” data. This would prevent misalignment, most frequently caused by poor gate localization, from creating obstacles over free space.

During the Urban circuit event, an error in gate detection resulted in almost exactly the exact scenario used in simulation during development. In Figure (a)a, the two maps are fully merged, and it can be seen that the first robot (the left corridor) creates a wall in the middle of the second robot’s map. This would have prevented the robot from being able to plan a path through the hallway. Figure (b)b shows the self-prioritized map where the robot is trusting its own representation of free space more than merged map data. The first map still can be seen outside of the walls, but it does not hinder the robot from navigating down the hallway. A future opportunity is to leverage iterative closest point (ICP) techniques to align the map of a neighboring agent prior to merging.

9.4 Navigation

Graph-Based Navigation - The most common failure mode leading to a stuck robot was when the graph-based planner generated an edge that the local centering controller could not navigate over. Often, this was a result of rough terrain or an inconsistency in the map. If the vehicle attempted to traverse the edge and failed, but the edge is left as unexplored, the system could enter a loop of attempting to explore an edge that is not traversable. This exact situation occurred a few times during the Tunnel Circuit event, and resulted in the agents wasting valuable exploration time. Although the fleet moved on from this approach in the Urban circuit event, this fault could be remedied by maintaining a list of recently visited vertices and the edges left and arrived on. Then, if an edge could not be traversed by the centering controller, the planner would ignore it as a possible destination. Overall, this approach is very successful in the NIOSH competition environment and in the Edgar Experimental Mine due to their graph-like structures.

Planner and Controller Disagreements - We have learned that one of the most challenging aspects of path planning for ground vehicles in cluttered, subterranean environments is generating safe paths. We noticed during initial testing of the global planner describer in Section 5 that the generated global paths to the goal points were sensible and avoided large obstacles in the map. However, they did not take into account different aspects of the terrain like small to medium size rocks or raised sections of concrete. As a result, the robot could wind up physically stuck if it followed a path over terrain it actually could not navigate. To solve this problem, our team developed a reactive controller based around high density depth sensor data of the ground immediately in front of the robot. This helped the robot avoid obstacles not accounted for by the global planner, or stop the vehicle if it was too close to a hazardous obstacle. Similarly, our aerial platforms required the development of additional obstacle avoidance capabilities in order to effectively follow planned paths safely through cluttered environments. The vision-based local controller presented in Section 6 has proved to be an adequate solution for detecting and avoiding small obstacles along planned paths. The team is working on improving the current planning algorithm to produce more terrain aware paths for ground vehicle navigation. The main lesson here is that path planning algorithms developed for cluttered subterranean environments needs to consider the inherent limitations in mobility and sensing of the platform in order to ensure safe and traversable paths.

Path Stitching When planning over a large horizon, the robot may travel a significant distance in the time it takes our fast-marching based planning algorithm to generate a feasible path. We learned that this can cause undesirable motion when the system transitions from following the old path to the new path, depending on how far the robot has deviated from the new path in the time it has taken to plan it. As a result, it’s necessary to plan from where the robot is expected to be as opposed to where it is when the planning process begins. To this end, a receding horizon path stitching algorithm has been added to plan from where the robot will be if it continues to follow the previous path over a short time horizon, . This process is detailed in Algorithm 4. Here the stitching algorithm takes as input the current map, , robot pose, , robot speed, , and stitching horizon and outputs a path at regular planning intervals that contains a segment of the previous path, path, connected to the new path segment planned from a stitch point, close to where to robot will be in .

1:  path
2:  FrontierViewPlanner
3:  pathpath
4:  while True do
5:     FindLookahead
6:     FrontierViewPlanner
7:     pathpathpath
8:  end while
Algorithm 4 RecedingHorizonStitching

9.5 Communications

An initial review of the difficulties in underground communication [91, 11] led us to a strategy of “backbone”, where the goal was to create a basic communication network stemming out from the base station. Agents needed to be completely self-sufficient in a lost-comm condition. In general, each mobile vehicle would explore until certain criteria are met (artifact discovered, etc), returning to communications range when needed. This strategy allowed us to accept an incomplete coverage map and provides a natural progression of capability through the use of deployable relay beacons to extend the communications backbone back to the human operator. Our communications solution has undergone three versions to date, corresponding to Circuit Events.

Figure 21: Custom communications beacons designed and built for the (left) Tunnel, (middle) Urban, and (right) Cave circuit events.

Version 1: Tunnel - The initial beacon design for the Tunnel circuit was designed to be small and disposable. Small housings with minimal elevation (Figure 21, left) were used to house a low-power radio. Meshing functions were provided by the open-source B.A.T.M.A.N stack in a custom OpenWRT-based firmware. While other radios with superior properties from Silvus, Rajant, and others were considered, cost considerations necessitated a commodity solution. To function effectively within the backbone strategy, reconnect times were required to be as quick as possible in response to a topology change, which occurs when a robot returns to communication range. B.A.T.M.A.N is not optimized for this use case, necessitating a replacement mesh solution. Further, the low-power radios paired with quarter-wave antennas resulted in poor network performance, leading to observed behavior of robots returning to the Base Station frequently to report artifacts.

Version 2: Urban - Version 2 beacons shown in the center of Figure 21 consisted of an extensible power mast with half-wave antennas, a battery, a high-power rugged radio, a single-board computer and support electronics all enclosed in an acrylic case. Meshing was provided by a custom mesh networking system called meshmerize that prioritizes reconnection times instead of optimal routing. Beyond online coordination with the base station, an offline command and data relay system drawn from UAV studies [28] was implemented onboard the beacons’ single-board computer. Version 2 beacons are more capable than Version 1, however several operational problems became apparent in testing and competition. The extensible antenna necessitated a minimum vertical size of the beacon, which had several negative consequences downstream; in particular, the size of the beacon had a negative impact on maximum traversable pitch of the carrier robot. The new meshing solution performed extremely well, transferring well over a gigabyte of data over the course of one particular one-hour run and allowing ground vehicles to act as relays for one another with reconnection times on the order of milliseconds.

Version 3: Cave / Final - The Version 3 beacons were designed to be more compact and still retain high-level functions, resulting in the beacon in the far-right of Figure 21. Instead of acrylic, a NEMA-rated aluminum enclosure was used to provide durability and ‘puddle-proof’ water intrusion protection. The radio is cooled through a thermally conductive bonding to the metal lid of the case. The extensible mast and support electronics were removed and replaced with a PCB to facilitate faster assembly of new beacons; existing radios, battery, and single-board computer components were re-used.

Initial testing with the udp_mesh transport layer, described in Section 7, and meshmerize mesh layer have yielded performance improvements compared to our original solutions. In one lab test to determine maximum performance, we observed that our ROS message throughput is limited by the underlying meshmerize mesh layer at approximately 20 Mbit/s. Operational testing with high and low priority data streams reveals that udp_mesh has eliminated the previously observed latency issues, an improvement over our previous implementation. As a robot explores an environment, the telemetry and artifact reports are nearly instantaneous, while map portions fill in as bandwidth allows; these tests validate both the efficacy and usefulness of our prioritization method. Moreover, when robots returned to within communications range, we observed reconnection times on the order of one second, in stark contrast to the tens of seconds that B.A.T.M.A.N. required. Mechanically, by reducing the beacon size, previous issues with vehicle pitch handling have been eliminated.

9.6 Multi-Agent Coordination

Multi-agent Communications Hopping - The ability to store messages and relay communications through other robots greatly improved information sharing across the network, and demonstrated one of the benefits of multiple robots even without coordination. On multiple occasions, robots were able to transmit artifact reports back to the base station through a “hop”, and then continue exploring deeper into the environment.

Data Prioritization - Field deployments provided meaningful feedback regarding communication bottlenecks within the fleet. The original multi-agent system consisted of low-bandwidth messages similar to those described in Section 8 as well as high-bandwidth messages, which included merged OctoMaps and artifact image data. This technique works well in short-range, high-bandwidth environments, but when bandwidth is highly constricted, the larger data messages prevented priority data such as artifact reports from being delivered. As a consequence, the multi-agent framework was streamlined to use the map diffs described in Section 3 and use a combination of broadcast, for low-bandwidth data, and point-to-point messages, for map diffs and artifact images. These changes led to reduced traffic and more reliable transmission, with success rate for artifact image transmission increasing from 30% to 100%. In most situations this hybrid approach is a good compromise and still allows the robots to tolerate intermittent communications connectivity.

9.7 Human - Robot Interface

Human Interactions -

As stated in the Introduction, teams are allowed a single human supervisor that is allowed to interact with the robots after they have been deployed into the environment. As the number of robots and functionality of each robot increases, the potential load on the human supervisor increases as well. Reducing the reliance of the fleet on the human operator is challenging. A solution to this challenge is presented in [62], where a system for controlling a fleet of 14 robots is presented. Interactions between a human supervisor and differing fleets of robots is explored in [84]. Providing an interface that is user friendly is also key to improving the management of a fleet of robots [56].

For our solution, early design decisions focused on very limited human interaction with the robots, as the fleet relied on a fully autonomous solution. However, during field deployments, it became clear that certain scenarios can benefit swift Human Supervisor intervention. The information transfer from the robot fleet to the DARPA command post was originally designed as a rigid process. However, during the first field deployment at the Tunnel circuit event, the Human Supervisor detected that robots were sometimes reporting erroneous artifact locations and types. Adding flexibility into the reporting system provided the Human Supervisor the opportunity to discern reliable information from unreliable information, and ultimately modify that information before sending it up the chain of command. Additionally, functionality was added to allow the Human Supervisor control over the robots via a joystick as well as manual goal point in the GUI. While manual control is not desired for normal operation, there have been unexpected events in which it was the only method of recovering an agent and resuming exploration. Manual goal points can be useful when the Human Supervisor identifies an area of interest for the robot to inspect further.

Remote Oversight - As the fleet grew in size and complexity, the workload of the Human Supervisor increased substantially. The GUI and RViz were modified to provide dedicated information on each agent, as well as a main window with all agents in the merged map. With the introduction of the survey operator during robot startup, it became valuable for the Human Supervisor to have a visualization, in order to verify accurate gate localization. These seemingly small improvements worked to drastically reduce the Human Supervisor workload while providing greater oversight of the robot fleet and the overall mission.

10 Conclusion

This paper has presented our continued work to address many open areas of robotics research including platforms design, object detection and classification, path planning and navigation, multi-agent coordination, communications, and human-robot interaction. Specifically, we have presented several novel extensions of state-of-the-art research and a complete field robotics solution for multi-agent autonomous subterranean exploration and rapid situational awareness.

The graph-based exploration strategy detailed in Section 4 performed well in the narrow, tunnel-like environments found in Edgar Experimental Mine and NIOSH Safety Mine. The frontier-based exploration strategy from Section 5 also performed well in the Edgar Experimental Mine, and allowed agents to explore larger environments like the GeoTech warehouse and the SATSOP nuclear power facility. The team has learned that we need to improve our terrain awareness when planning paths through cluttered environments. The circuit events have presented challenging communication environments and our team has learned to overcome network saturation and reliability problems through the implementation of a UDP-Mesh communication solution presented in Section 7. Sharing information across agents is critical to improving exploration efficiency and providing situational awareness, and generating and transmitting map differences versus entire maps decreases the risk of network saturation as demonstrated in Section 3. Artifacts in the competition are generally spaced far apart, making it difficult for a single agent to find them all in the time limit. By sharing map differences and candidate goal points through our multi-agent coordination scheme from Section 8, agents are now able to coordinate their exploration, ultimately increasing the amount of space seen and the potential to find artifacts.

One of the most significant lessons from this research effort is that developing robust autonomous platforms for rapid situational awareness in subterranean environments requires significant and frequent field testing. In isolated lab testing, it is nearly impossible to recreate all conditions inherent to underground environments that make multi-agent autonomy so challenging. An integrative approach involving frequent submodule and full-system evaluations in subterranean environments of representative topology, complexity, and scale is invaluable to the development of robust multi-agent autonomy.


This work was supported through the DARPA Subterranean Challenge, cooperative agreement number HR0011-18-2-0043. A special thanks to Daniel Torres, Cesar Galant, Zoe Turin, for assisting with the design, testing, and deployments of our platforms and algorithms. Thank you to the Colorado School of Mines and the Edgar Experimental Mine for allowing us to conduct mock deployments in the mine. Special thanks also to Simon Wunderlich and his team at Meshmerize GmbH for their mesh networking support. Finally, thank you to all of the DARPA staff who have planned and executed absolutely incredible Subterranean Challenge system track circuit events.


  • [1] S. M. Abbas, S. Aslam, K. Berns, and A. Muhammad (2019) Analysis and improvements in apriltag based state estimation. Sensors 19 (24). External Links: Link, ISSN 1424-8220, Document Cited by: §9.2, §9.2.
  • [2] S. Ahmad and R. Fierro (2019) Real-time quadrotor navigation through planning in depth space in unstructured environments. In 2019 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 1467–1476. Cited by: §6.
  • [3] S. Ahmad, A. B. Mills, E. R. Rush, E. W. Frew, and J. S. Humbert (2021) 3D reactive control and frontier-based exploration for unstructured environments. In 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Cited by: §6.
  • [4] S. Ahmad, Z. N. Sunberg, and J. S. Humbert (2021) Apf-pf: probabilistic depth perception for 3d reactive obstacle avoidance. In 2021 American Control Conference (ACC), pp. 32–39. Cited by: §6.
  • [5] S. Ahmad, Z. N. Sunberg, and J. S. Humbert (2021) End-to-end probabilistic depth perception and 3d obstacle avoidance using pomdp. Journal of Intelligent & Robotic Systems 103 (2), pp. 1–18. Cited by: §6.
  • [6] H. E. Alvarez, M. Ohradzansky, J. Keshavan, B. Ranganathan, and J. S. Humbert (2019) Bio-inspired approaches for small-object detection and avoidance. IEEE Transactions on Robotics. Cited by: §4, §6.
  • [7] H. Bay, A. Ess, T. Tuytelaars, and L. Van Gool (2008-06) Speeded-up robust features (SURF). Comput. Vis. Image Underst. 110 (3), pp. 346–359. External Links: ISSN 1077-3142 Cited by: §9.2.
  • [8] A. Bircher, M. Kamel, K. Alexis, H. Oleynikova, and R. Siegwart (2016) Receding horizon” next-best-view” planner for 3d exploration. In 2016 IEEE international conference on robotics and automation (ICRA), pp. 1462–1468. Cited by: §5, §6.
  • [9] R. Bormann, F. Jordan, W. Li, J. Hampp, and M. Hägele (2016) Room segmentation: Survey, implementation, and analysis. In Proceedings of the IEEE International Conference on Robotics and Automation, Stockholm, Sweden, pp. 1019–1026. External Links: Document, ISBN 9781467380263, ISSN 10504729 Cited by: §4.
  • [10] A. Bouman, M. F. Ginting, N. Alatur, M. Palieri, D. D. Fan, T. Touma, T. Pailevanian, S. Kim, K. Otsu, J. Burdick, and A. Agha-mohammadi (2020) Autonomous spot: long-range autonomous exploration of extreme environments with legged locomotion. External Links: 2010.09259 Cited by: §1, §5.4.
  • [11] M. Boutin, A. Benzakour, C. L. Despins, and S. Affes (2008) Radio wave characterization and modeling in underground mine tunnels. IEEE Transactions on Antennas and Propagation 56 (2), pp. 540–549. Cited by: §9.5.
  • [12] P. Brass, F. Cabrera-Mora, A. Gasparri, and J. Xiao (2011) Multirobot tree and graph exploration. IEEE Transactions on Robotics 27 (4), pp. 707–717. External Links: Document, ISSN 15523098 Cited by: §4.
  • [13] C. Brommer, D. Malyuta, D. Hentzen, and R. Brockers (2018-10) Long-duration autonomy for small rotorcraft UAS including recharging. In IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. arXiv:1810.05683. External Links: Document, Link Cited by: §9.2.
  • [14] W. Burgard, M. Moors, and F. Scheider (2002) Collaborative Exploration of Unknown Environments with Teams of Mobile Robots. Lecture Notes in Computer Science, Vol. 2466, Springer Berlin Heidelberg, Berlin, Heidelberg. External Links: Document, ISBN 978-3-540-00168-3, Link Cited by: §8.
  • [15] B. Charrow, S. Liu, V. Kumar, and N. Michael (2015) Information-theoretic mapping using cauchy-schwarz quadratic mutual information. In 2015 IEEE International Conference on Robotics and Automation (ICRA), pp. 4791–4798. Cited by: §5.4, §5.
  • [16] W. Cheung and G. Hamarneh (2009) N0-sift: n -dimensional scale invariant feature transform. IEEE Transactions on Image Processing 18 (9), pp. 2012–2021. Cited by: §9.2.
  • [17] T. Dang, S. Khattak, F. Mascarich, and K. Alexis (2019) Explore locally, plan globally: a path planning framework for autonomous robotic exploration in subterranean environments. In 2019 19th International Conference on Advanced Robotics (ICAR), pp. 9–16. Cited by: §6.
  • [18] T. Dang, M. Tranzatto, S. Khattak, F. Mascarich, K. Alexis, and M. Hutter (2020) Graph-based subterranean exploration path planning using aerial and legged robots. Journal of Field Robotics 37 (8), pp. 1363–1388. Cited by: §4, §6.
  • [19] DARPA (2021) DARPA Subterranean Challenge. Note: External Links: Link Cited by: §1.
  • [20] M. Debord, W. Hönig, and N. Ayanian (2018) Trajectory planning for heterogeneous robot teams. In 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 7924–7931. Cited by: §6.
  • [21] M. Dharmadhikari, T. Dang, L. Solanka, J. Loje, H. Nguyen, N. Khedekar, and K. Alexis (2020) Motion primitives-based path planning for fast and agile exploration using aerial robots. In 2020 IEEE International Conference on Robotics and Automation (ICRA), pp. 179–185. Cited by: §5, §6.
  • [22] A. Doucet, S. Godsill, and C. Andrieu (2000) On sequential monte carlo sampling methods for bayesian filtering. Statistics and computing 10 (3), pp. 197–208. Cited by: §6.
  • [23] G. Dubey, S. Arora, and S. Scherer (2017) Droan—disparity-space representation for obstacle avoidance. In 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1324–1330. Cited by: §6.
  • [24] G. Dudek, M. Jenkin, E. Milios, and D. Wilkes (1991) Robotic Exploration as Graph Construction. IEEE Transactions on Robotics and Automation 7 (6), pp. 859–865. Cited by: §4.
  • [25] K. Ebadi, Y. Chang, M. Palieri, A. Stephens, A. Hatteland, E. Heiden, A. Thakur, N. Funabiki, B. Morrell, S. Wood, L. Carlone, and A. A. Agha-Mohammadi (2020) LAMP: Large-Scale Autonomous Mapping and Positioning for Exploration of Perceptually-Degraded Subterranean Environments. IEEE International Conference on Robotics and Automation, pp. 80–86. External Links: Document, 2003.01744, ISBN 9781728173955, ISSN 10504729 Cited by: §1.
  • [26] B. Englot and F. S. Hover (2013) Three-dimensional coverage planning for an underwater inspection robot. The International Journal of Robotics Research 32 (9-10), pp. 1048–1073. Cited by: §5.2.
  • [27] A. Farhadi and J. Redmon (2018) Yolov3: an incremental improvement.

    Computer Vision and Pattern Recognition, cite as

    Cited by: §9.1.
  • [28] E. W. Frew and T. X. Brown (2009) Networking issues for small unmanned aircraft systems. Journal of Intelligent and Robotic Systems 54 (1-3), pp. 21–37. Cited by: §9.5.
  • [29] F. Gao, W. Wu, Y. Lin, and S. Shen (2018) Online safe trajectory generation for quadrotors using fast marching method and bernstein basis polynomial. In 2018 IEEE International Conference on Robotics and Automation (ICRA), pp. 344–351. Cited by: §6.
  • [30] B.P. Gerkey and M.J. Mataric (2002-10) Sold!: auction methods for multirobot coordination. IEEE Transactions on Robotics and Automation 18 (5), pp. 758–768. External Links: Document, ISSN 1042-296X, Link Cited by: §8.
  • [31] R. Girshick (2015) Fast r-cnn. In Proceedings of the IEEE international conference on computer vision, pp. 1440–1448. Cited by: §9.1.
  • [32] S. Griffiths, J. D. Saunders, A. Curtis, D. B. Barber, T. W. McLain, and R. Beard (2006) Maximizing miniature aerial vehicles obstacle and terrain avoidance for mavs. IEEE Robotics and Automation Letters. Cited by: §4.
  • [33] H. Harms, J. Schmiemann, J. Schattenberg, and L. Frerichs (2017) Development of an adaptable communication layer with QoS capabilities for a multi-robot system. In Iberian Robotics conference, pp. 782–793. Cited by: §7.
  • [34] W. Hess, D. Kohler, H. Rapp, and D. Andor (2016) Real-time loop closure in 2d lidar slam. In 2016 IEEE International Conference on Robotics and Automation (ICRA), pp. 1271–1278. Cited by: §1, §2.2.
  • [35] B. K. Horn (1987) Closed-form solution of absolute orientation using unit quaternions. Josa a 4 (4), pp. 629–642. Cited by: §9.2.
  • [36] A. Hornung, K. M. Wurm, M. Bennewitz, C. Stachniss, and W. Burgard (2013) OctoMap: an efficient probabilistic 3D mapping framework based on octrees. Autonomous Robots. Note: Software available at External Links: Link, Document Cited by: §1, §2.2, §5.
  • [37] A. Howard (2006-12) Multi-robot Simultaneous Localization and Mapping using Particle Filters. The International Journal of Robotics Research 25 (12), pp. 1243–1256. External Links: Document, ISBN 0278364906072, ISSN 0278-3649, Link Cited by: §3.
  • [38] Y. Huang, C. Lu, K. Chen, P. Ser, J. Huang, Y. Shen, P. Chen, P. Chang, S. Lee, and H. Wang (2019) Duckiefloat: a Collision-Tolerant Resource-Constrained Blimp for Long-Term Autonomy in Subterranean Environments. External Links: 1910.14275, Link Cited by: §1.
  • [39] M. Kasper, S. McGuire, and C. Heckman (2019) A benchmark for visual-inertial odometry systems employing onboard illumination. In 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Vol. , pp. 5256–5263. External Links: Document Cited by: §9.2.
  • [40] S. Khattak, H. Nguyen, F. Mascarich, T. Dang, and K. Alexis (2020-09)

    Complementary Multi–Modal Sensor Fusion for Resilient Robot Pose Estimation in Subterranean Environments

    In 2020 International Conference on Unmanned Aircraft Systems (ICUAS), Athens, Greece, pp. 1024–1029 (en). Note: Visual-inertial odometry + thermal-inertial odometry + LiDAR odometry + mapping solution External Links: ISBN 978-1-72814-278-4, Link, Document Cited by: §9.2.
  • [41] J. Ko, B. Stewart, D. Fox, K. Konolige, and B. Limketkai (2003) A Practical, Decision-theoretic Approach to Multi-robot Mapping and Exploration. In 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003), Vol. 4, Las Vegas, NV, pp. 3232–3238. External Links: ISBN 0780378601 Cited by: §3.
  • [42] D. Kroon (2020) Accurate fast marching. External Links: Link Cited by: §5.3.
  • [43] S. Lackner and W. Lienhart (2016-03) Impact of prism type and prism orientation on the accuracy of automated total station measurements. In Joint International Symposium on Deformation MonitoringAt: Vienna, pp. . Cited by: §9.2.
  • [44] P. Y. Lajoie, B. Ramtoula, Y. Chang, L. Carlone, and G. Beltrame (2020)

    DOOR-SLAM: Distributed, Online, and Outlier Resilient SLAM for Robotic Teams

    IEEE Robotics and Automation Letters 5 (2), pp. 1656–1663. External Links: Document, 1909.12198, ISSN 23773766 Cited by: §1.
  • [45] D. Lee (1982) Medial axis transformation of a planar shape. IEEE Transactions on pattern analysis and machine intelligence 4 (4), pp. 363–369. Cited by: §5.3.
  • [46] Leica Geosystems (2020) Leica reflectors datasheet. Note: Rev. 712323-3.0.0en External Links: Link Cited by: §9.2.
  • [47] S. Leutenegger, S. Lynen, M. Bosse, R. Siegwart, and P. Furgale (2015-03) Keyframe-based visual–inertial odometry using nonlinear optimization. The International Journal of Robotics Research 34 (3), pp. 314–334 (en). External Links: ISSN 0278-3649, 1741-3176, Link, Document Cited by: §9.2.
  • [48] M. L. Littman, A. R. Cassandra, and L. P. Kaelbling (1995) Learning policies for partially observable environments: scaling up. In Machine Learning Proceedings 1995, pp. 362–370. Cited by: §6.
  • [49] M. L. Littman (1994) The witness algorithm: solving partially observable markov decision processes. Brown University, Providence, RI. Cited by: §6.
  • [50] S. Liu, K. Mohta, N. Atanasov, and V. Kumar (2018) Search-based motion planning for aggressive flight in se (3). IEEE Robotics and Automation Letters 3 (3), pp. 2439–2446. Cited by: §6.
  • [51] D. Malyuta, C. Brommer, D. Hentzen, T. Stastny, R. Siegwart, and R. Brockers (2019-08) Long-duration fully autonomous operation of rotorcraft unmanned aerial systems for remote-sensing data acquisition. Journal of Field Robotics, pp. arXiv:1908.06381. External Links: Document, Link Cited by: §9.2.
  • [52] F. Mascarich, H. Nguyen, T. Dang, S. Khattak, C. Papachristos, and K. Alexis (2020) A self-deployed multi-channel wireless communications system for subterranean robots. In 2020 IEEE Aerospace Conference, Vol. , pp. 1–8. External Links: Document Cited by: §7.
  • [53] L. Matthies, R. Brockers, Y. Kuwata, and S. Weiss (2014) Stereo vision-based obstacle avoidance for micro air vehicles using disparity space. In 2014 IEEE International Conference on Robotics and Automation (ICRA), pp. 3242–3249. Cited by: §6.
  • [54] D. Maturana and S. Scherer (2015)

    Voxnet: a 3d convolutional neural network for real-time object recognition

    In 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 922–928. Cited by: §9.1.
  • [55] I. D. Miller, A. Cohen, A. Kulkarni, J. Laney, C. J. Taylor, V. Kumar, F. Cladera, A. Cowley, S. S. Shivakumar, E. S. Lee, L. Jarin-Lipschitz, A. Bhat, N. Rodrigues, and A. Zhou (2020) Mine Tunnel Exploration Using Multiple Quadrupedal Robots. IEEE Robotics and Automation Letters 5 (2), pp. 2840–2847. External Links: Document, 1909.09662, ISSN 23773766 Cited by: §1, §4.
  • [56] Y. Nevatia, T. Stoyanov, R. Rathnam, M. Pfingsthorn, S. Markov, R. Ambrus, and A. Birk (2008) Augmented autonomy: improving human-robot team performance in urban search and rescue. In 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems, Vol. , pp. 2103–2108. External Links: Document Cited by: §9.7.
  • [57] F. Nobre, C. R. Heckman, and G. T. Sibley (2017) Multi-sensor slam with online self-calibration and change detection. In 2016 International Symposium on Experimental Robotics, D. Kulić, Y. Nakamura, O. Khatib, and G. Venture (Eds.), Cham, pp. 764–774. External Links: ISBN 978-3-319-50115-4 Cited by: §9.2.
  • [58] M. Ohradzansky, H. E. Alvarez, J. Keshavan, B. Ranganathan, and J. S. Humbert (2018) Autonomous bio-inspired small-object detection and avoidance. In 2018 IEEE International Conference on Robotics and Automation (ICRA), pp. 1–9. Cited by: §4, §4, §6.
  • [59] M. T. Ohradzansky, A. B. Mills, E. R. Rush, D. G. Riley, E. W. Frew, and J. S. Humbert (2020) Reactive control and metric-topological planning for exploration. In 2020 IEEE International Conference on Robotics and Automation (ICRA), pp. 4073–4079. Cited by: §4, §6.
  • [60] H. Oleynikova, Z. Taylor, M. Fehr, R. Siegwart, and J. Nieto (2017) Voxblox: incremental 3d euclidean signed distance fields for on-board mav planning. In 2017 Ieee/rsj International Conference on Intelligent Robots and Systems (iros), pp. 1366–1373. Cited by: §2.2, §5.
  • [61] H. Oleynikova, Z. Taylor, R. Siegwart, and J. Nieto (2018) Sparse 3D Topological Graphs for Micro-Aerial Vehicle Planning. In Proceedings of the IEEE International Conference on Intelligent Robots and Systems, Madrid, Spain, pp. 8478–8485. External Links: Document, ISBN 9781538680940, ISSN 21530866 Cited by: §4.
  • [62] E. Olson, J. Strom, R. Morton, A. Richardson, P. Ranganathan, R. Goeddel, M. Bulic, J. Crossman, and R. Marinier III (2012-09) Progress toward multi-robot reconnaissance and the magic 2010 competition. Journal of Field Robotics 29, pp. 762–792. External Links: Document Cited by: §9.7.
  • [63] K. Otsu, S. Tepsuporn, R. Thakker, T. S. Vaquero, J. A. Edlund, W. Walsh, G. Miles, T. Heywood, M. T. Wolf, and A. A. Agha-Mohammadi (2020) Supervised Autonomy for Communication-degraded Subterranean Exploration by a Robot Team. IEEE Aerospace Conference Proceedings. External Links: Document, ISBN 9781728127347, ISSN 1095323X Cited by: §1, §4, §5.4.
  • [64] E. Palazzolo and C. Stachniss (2017) Information-driven autonomous exploration for a vision-based mav. ISPRS Annals of the Photogrammetry, Remote Sensing and Spatial Information Sciences 4, pp. 59. Cited by: §5.
  • [65] C. R. Qi, H. Su, K. Mo, and L. J. Guibas (2017)

    Pointnet: deep learning on point sets for 3d classification and segmentation

    In Proceedings of the IEEE conference on computer vision and pattern recognition, pp. 652–660. Cited by: §9.1.
  • [66] T. Qin, P. Li, and S. Shen (2018-08) VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator. IEEE Transactions on Robotics 34 (4), pp. 1004–1020 (en). External Links: ISSN 1552-3098, 1941-0468, Link, Document Cited by: §9.2.
  • [67] J. Redmon, S. Divvala, R. Girshick, and A. Farhadi (2016) You only look once: unified, real-time object detection. In Proceedings of the IEEE conference on computer vision and pattern recognition, pp. 779–788. Cited by: §2.2, §9.1.
  • [68] D. G. Riley and E. W. Frew (2021) Assessment of coordinated heterogeneous exploration of complex environments. In 2021 IEEE Conference on Control Technology and Applications (CCTA), Cited by: §3, §8, §8.
  • [69] T. Rouček, M. Pecka, P. Čížek, T. Petříček, J. Bayer, V. Šalanský, D. Heřt, M. Petrlík, T. Báča, V. Spurný, F. Pomerleau, V. Kubelka, J. Faigl, K. Zimmermann, M. Saska, T. Svoboda, and T. Krajník (2020) DARPA Subterranean Challenge: Multi-robotic Exploration of Underground Environments. Lecture Notes in Computer Science (including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics) 11995 LNCS (April), pp. 274–290. External Links: Document, ISBN 9783030438890, ISSN 16113349 Cited by: §1.
  • [70] A. Santamaria-Navarro, R. Thakker, D. D. Fan, B. Morrell, and A. Agha-mohammadi (2020-08) Towards Resilient Autonomous Navigation of Drones. arXiv:2008.09679 [cs] (en). Note: arXiv: 2008.09679Comment: In International Symposium on Robotics Research (ISRR) 2019CoSTAR Heterogeneous Redundant Odometry (HeRO) paper, results from STIX External Links: Link Cited by: §9.2.
  • [71] J. Santos-Victor and G. Sandini (1997) Embedded visual behaviors for navigation. Robotics and Autonomous Systems 19, pp. 299–313. Cited by: §4.
  • [72] L. Schmid, M. Pantic, R. Khanna, L. Ott, R. Siegwart, and J. Nieto (2020) An efficient sampling-based method for online informative path planning in unknown environments. IEEE Robotics and Automation Letters 5 (2), pp. 1500–1507. Cited by: §5.4, §5.
  • [73] J. A. Sethian (1999) Level set methods and fast marching methods: evolving interfaces in computational geometry, fluid mechanics, computer vision, and materials science. Vol. 3, Cambridge university press. Cited by: §5.3.
  • [74] T. Shan, B. Englot, D. Meyers, W. Wang, C. Ratti, and D. Rus (2020-07) LIO-SAM: Tightly-coupled Lidar Inertial Odometry via Smoothing and Mapping. arXiv:2007.00258 [cs] (en). Note: arXiv: 2007.00258Comment: IROS 2020 External Links: Link Cited by: §9.2.
  • [75] W. Sheng, Q. Yang, S. Ci, and N. Xi (2004) Multi-robot area exploration with limited-range communications. In 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Vol. 2, Sendai, Japan, pp. 1414–1419. External Links: ISBN 0780384636 Cited by: §3.
  • [76] S. Shi, X. Wang, and H. Li (2019) Pointrcnn: 3d object proposal generation and detection from point cloud. In Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, pp. 770–779. Cited by: §9.1.
  • [77] R. Simmons, D. Apfelbaum, W. Burgard, and D. Fox (2000) Coordination for multi-robot exploration and mapping. In Proceedings of the AAAI National Conference on Artificial Intelligence, Austin, TX, pp. 852–858. External Links: ISBN 0-262-51112-6, Link Cited by: §3.
  • [78] R. D. Smallwood and E. J. Sondik (1973) The optimal control of partially observable markov processes over a finite horizon. Operations research 21 (5), pp. 1071–1088. Cited by: §6.
  • [79] A. Smith (2013) Sequential monte carlo methods in practice. Springer Science & Business Media. Cited by: §6.
  • [80] A. J. Smith and G. A. Hollinger (2018-12) Distributed inference-based multi-robot exploration. Autonomous Robots 42 (8), pp. 1651–1668. External Links: Document, ISSN 0929-5593, Link Cited by: §8.
  • [81] M. V. Srinivasan, J. S. Chahl, K. Weber, S. Venkatesh, M. G. Nagle, and S. Zhang (1998) Robot navigation inspired by principles of insect vision. Robotics and Autonomous Systems 26, pp. 203–216. Cited by: §4.
  • [82] S. Thrun, S. Thayer, W. Whittaker, C. Baker, W. Burgard, D. Ferguson, D. Hahnel, M. Montemerlo, A. Morris, Z. Omohundro, C. Reverte, and W. Whittaker (2004) Autonomous exploration and mapping of abandoned mines: Software architecture of an autonomous robotic system. IEEE Robotics and Automation Magazine 11 (4), pp. 79–91. External Links: Document, ISSN 10709932 Cited by: §4.
  • [83] H. Vanholder (2016) Efficient inference with tensorrt. ed. Cited by: §9.1.
  • [84] J. Wang and M. Lewis (2007-01) Human control for cooperating robot teams. pp. 9–16. External Links: Document Cited by: §9.7.
  • [85] J. Wang and E. Olson (2016-10) AprilTag 2: Efficient and robust fiducial detection. In 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4193–4198. External Links: Document, ISBN 978-1-5090-3762-9 Cited by: §9.2, §9.2.
  • [86] B. B. Werger and M. J. Mataric (2000) Broadcast of local eligibility. In Proceedings of the fourth international conference on Autonomous agents - AGENTS ’00, New York, New York, USA, pp. 21–22. External Links: Document, ISBN 1581132301, Link Cited by: §8.
  • [87] B. Yamauchi (1999-11) Decentralized coordination for multirobot exploration. Robotics and Autonomous Systems 29 (2-3), pp. 111–118. External Links: Document, ISSN 09218890, Link Cited by: §5, §8.
  • [88] H. Zhan, R. Garg, C. Saroj Weerasekera, K. Li, H. Agarwal, and I. Reid (2018-06) Unsupervised learning of monocular depth estimation and visual odometry with deep feature reconstruction. In The IEEE Conference on Computer Vision and Pattern Recognition (CVPR), Cited by: §9.2.
  • [89] J. Zhang and S. Singh (2017-02) Low-drift and real-time lidar odometry and mapping. Autonomous Robots 41 (2), pp. 401–416 (en). External Links: ISSN 0929-5593, 1573-7527, Link, Document Cited by: §2.2, §9.2.
  • [90] T. Zhang and C. Y. Suen (1984) A fast parallel algorithm for thinning digital patterns. Communications of the ACM 27 (3), pp. 236–239. Cited by: §4.
  • [91] Y. P. Zhang, G. X. Zheng, and J. Sheng (2001) Radio propagation at 900 MHz in underground coal mines. IEEE Transactions on Antennas and Propagation 49 (5), pp. 757–762. Cited by: §9.5.
  • [92] H. Zhao (2007) Parallel implementations of the fast sweeping method. Journal of Computational Mathematics, pp. 421–429. Cited by: §5.1.
  • [93] Y. Zhou and O. Tuzel (2018) Voxelnet: end-to-end learning for point cloud based 3d object detection. In Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, pp. 4490–4499. Cited by: §9.1.
  • [94] R. Zlot, A. T. Stentz, M. B. Dias, and S. Thayer (2002) Multi-robot exploration controlled by a market economy. In Proceedings of the IEEE International Conference on Robotics and Automation, Vol. 3, Washington, DC, pp. 3016–3023. External Links: ISBN 0780372727, ISSN 10504729 Cited by: §3.