SMUG Planner: A Safe Multi-Goal Planner for Mobile Robots in Challenging Environments