Path planning for first responders in the presence of moving obstacles