Autonomous aerial vehicle localization, path planning and navigation towards full and optimal 3D coverage of a known environment