A multi agent path planning prototype with roadmap algorithm