Rapidly exploring random tree