Before revision:  The second and third layers actively re-plan and execute the path, exploiting the continuously updated map  . Moreover, they allow the robot to maximize its visibility of 3D visual features in the environment .
After revision:  The second and third layers actively re-plan and execute the path, exploiting the continuously updated map . Moreover, we introduce two utility formulations to account for the obstacle presence in the field of view and the robot's location .