Design of a Real-Time Obstacle Avoiding and Trajectory Generation Algorithm for an Unmanned Aerial Vehicle