Reactive Exploration of Unknown Environments for Redundant Robots using Virtual Model Control
Authors: Alessio Canzolino, Omar Faris, Alessandro De Blasi, Fulvio Forni
Organizations: Department of Electrical, Electronic, and Information Engineering “Guglielmo Marconi”, University of Bologna, Italy · Department of Engineering, University of Cambridge, UK.
The exploration of confined, occluded, and partially known spaces poses significant challenges in robotic manipulation. The overall pose of the robotic arm must be carefully controlled to respect tight geometric constraints while avoiding newly discovered obstacles. We address this problem by proposing an active exploration approach for redundant robotic arms with an eye-in-hand camera configuration. Our approach navigates and acquires information in real-time based on a novel scoring method that directly selects a target voxel from the unexplored space using the robot's current state and expected information gain. To move the robot safely toward the target voxel, we utilize Virtual Model Control, which guarantees compliance and enables whole-body reactive obstacle avoidance without the need for path replanning. Simulated and real-robot experiments in both confined and open environments demonstrate the effectiveness of our approach, achieving over 90% mapping coverage across all tested environments in under 120 seconds without colliding with obstacles.
Figures & tables
Fig. 1 : The shelving unit for testing autonomous exploration in partially known environments.
Fig. 2 : 2D visualization of the three scores used to select the next target voxel. R(v) counts unknown voxels in the neighbourhood of v , F(v) rewards voxels closer to the robot base, and D(v) rewards voxels closer to the camera position.
Fig. 3 : Camera nose mechanism: (a) configuration when a new target is selected (b) Fns pulls the nose in the direction of the target, orienting the camera accordingly.
Fig. 4 : The green spring and damper pull the camera nose (orange arrow) towards the target (yellow box). Repulsive springs from obstacles (red) and base plane (blue) regulate the robot posture, enabling whole-body obstacle avoidance.
Fig. 5 : (a) Real vs mapped shelving unit from one experimental run. Red voxels have occupied status ( Vocc ) and gray voxels are unexplored ( Vunk ). (b) Exploration curve R(t) for all experimental runs. (c) Curves of the normalized discovery rate γd(t) accumulated over a rolling time window of 5 s for all experimental runs.
Parameter
Value
Parameter
Value
wR,wF,wD
2,1,4
ln
25 cm
Vmin,Vmax
0,350
kns
300 N/m
Vfree,Vunk,Vocc
20,55,90
kr,i
330 N/m
λvel,λtorq
0.15 m/s, 0.02 Nm
Fˉns
18 N
rign
5
c
8.5 Ns/m
NR(v)
3
σr,i
5 cm
TABLE I : Parameters used in experiments and simulations.
Metric
Mean ± SD
Metric
Mean ± SD
R∞ (%)
92.5±1.3
Te (s)
91.4±7.3
L (m)
13.4±1.0
Nts
47.4±4.8
pstag (%)
40.9±6.1
Nts:TR
28.8±3.4
Ndl
29.8±2.1
Nts:γ,Nts:λ
12.0±1.5 , 6.6±4.6
TABLE II : Experimental results for the exploration of three-tier shelving unit environment.
Fig. 6 : Simulation tests with increased levels of clutter. Scenarios A-C shows increased number of smaller obstacles. Scenario D highlights challenging occlusions, as shown in the rear view.
Fig. 7 : Simulation results for the Scenarios A, B, C, and D, with R(t) shown in (a), the remaining metrics shown in (b), and the rear view of a mapped Scenario D environment shown in (c).
Fig. 8 : Real and mapped examples from the strawberry clusters experiment showing a front view at the top and a side view at the bottom. As the voxel resolution decreases from (b) 4 cm to (c) 3 cm to (d) 2 cm, the robot becomes capable of extracting finer details of the map at the expense of slower exploration.
Fig. 9 : Real vs mapped open-top boxes environment from one experimental run.
Fig. 10 : Number of sampled next-best-views required to reach more than 95% of workspace exploration for longer sensor range in Scenarios A, B, C, and D and the shelving unit environments.
Virtual Model Control (VMC) is an approach to design a controller for force-controlled robots in complex uncertain environments. While this method was primarily investigated for legged robot locomotion in the past, it can be more generally applicable to other types of robotic systems. This paper investigates the VMC framework for reaching tasks in a force-controlled robotic arm. We propose six different approaches to designing virtual models in order to achieve reaching tasks in environments with obstacles and uncertainties. A force-controlled 8 degree-of-freedom humanoid robot was used to validate the proposed approach in the real world. We conducted three experiments to test the performance of VMC controllers in terms of predictability, sensitivity to external force, and adaptability against known and unknown obstacles. Experimental analyses show that, even though the proposed approach needs to sacrifice accuracy and trajectory optimality, it enables us to design complex reaching motions under uncertainties, in an intuitive and extendable manner.
Yi Zhang, Daniel Larby, Fumiya Iida +1
Department of Engineering, University of Cambridge, UK.
This paper addresses the motion control problem for mobile robots in obstacle-cluttered environments. The mobile robot has partial environment information only, and aims to move from an initial position to a target position without collisions. For this purpose, a reactive planning based control strategy (RPCS) is proposed. First, the initial and target positions are connected as a reference trajectory. Then, a reactive planning strategy (RPS) is developed to ensure the collision avoidance by modifying the reference trajectory locally based on the partial environment information. Next, an adaptive tracking control strategy (ATCS) is proposed to track the reference trajectory with potentially local modifications via the discretization techniques. Finally, the RPS and ATCS are combined to establish the RPCS, whose efficacy and advantages are illustrated by numerical examples.
Li Tan, Junlin Xiong, Yan Wang +1
Department of Automation, University of Science and Technology of China, Hefei, 230031, China. · School of Intelligence Science and Engineering, Harbin Institute of Technology Shenzhen, Shenzhen 515100, China · School of Control Science and Engineering, Dalian University of Technology, Dalian 116024, China.
Reactive obstacle avoidance methods often cause agents to become trapped in local minima, because they can often only reason one step ahead (i.e., the next action based on the current state). In this paper, we use model checking to achieve reactive multi-step planning and obstacle avoidance on an autonomous robot. Our small, purpose-built model checking algorithm generates plans in situ (within the robot's code) based on ``core'' knowledge and attention as found in biological agents. This is achieved in real-time using no pre-computed data on a low-powered device. Our approach is based on chaining temporary control systems that are spawned to counteract disturbances in the local environment which disrupt an autonomous agent from its preferred action (or resting state). We mitigate state-space explosion by relying on temporary snapshots of the immediate environment, restricting the number of states. Multi-step planning using counter-examples generated by depth-first search and a negated LTL path property is applied to scenarios involving a cul-de-sac and a free-standing obstacle. Empirical results and informal proofs of two fundamental properties demonstrate the effectiveness of our approach for the creation of efficient multi-step plans for local obstacle avoidance. We significantly improve performance compared to a purely reactive agent that can only plan one step ahead. Our approach is an instructional case study for the development of safe and reliable navigation in the context of autonomous vehicles. We believe it also has general application in navigation for mission-critical mobile robots.
Christopher Chandler, Bernd Porr, Giulia Lafratta +1
Department of Electronic and Electrical Engineering, University of Strathclyde, Glasgow, Scotland, UK · School of Engineering, University of Glasgow, Glasgow, Scotland, UK · School of Computing Science, University of Glasgow, Glasgow, Scotland, UK