A Novel Navigation Algorithm for Mapping Indoor Environments with a Quadrotor