Planning and obstacle avoidance in mobile robotics