Two Stage Smooth Path Planning for Mobile Robot for Optimal Obstacle Avoidance Problem in Unknown Environment