Path Planning and Control for Multiple AGVs Based on Improved Two-Stage Traffic Scheduling