On-line Estimation and Path Planning for Multiple Vehicles in an Uncertain Environment