The D plus plus Algorithm: Real-Time and Collision-Free Path-Planning for Mobile Robot