An Efficient Real-Time Planning Method for Swarm Robotics Based on an Optimal Virtual Tube