Two-Step Online Trajectory Planning of a Quadcopter in Indoor Environments with Obstacles