Improved Follow the Gap Method for obstacle avoidance
Real-time obstacle avoidance for manipu-lators and mobile robots