Changed infrastructure to allow multiple packages and added a recovery behavior that clears the voxel map right in front of the robot when stuck