jvi["goal"][2].asFloat()
)
);
+ p.firsts().push(p.goal());
jvo["init"][0] = p.root()->x();
jvo["init"][1] = p.root()->y();
jvo["init"][2] = p.root()->h();
+ jvo["goal"][0] = jvi["goal"][0].asFloat();
+ jvo["goal"][1] = jvi["goal"][1].asFloat();
+ jvo["goal"][2] = jvi["goal"][2].asFloat();
if (jvi["goals"] != Json::nullValue) {
for (auto g: jvi["goals"]) {
}
}
+ if (jvi["slot"] != Json::nullValue) {
+ jvo["slot"] = jvi["slot"];
+ }
+
std::vector<CircleObstacle> co;
std::vector<SegmentObstacle> so;
p.HMIN = p.root()->x();
p.tlog(p.findt());
}
}
+ p.tend();
+ jvo["time"] = p.elapsed();
#elif defined USE_PTHREAD
bool gf = false;
RRTNode *ron = nullptr;
}
j++;
}
+ jvo["goals"][0][0] = p.tlog()[p.tlog().size() - 1].front()->x();
+ jvo["goals"][0][1] = p.tlog()[p.tlog().size() - 1].front()->y();
+ jvo["goals"][0][2] = p.tlog()[p.tlog().size() - 1].front()->h();
#ifdef JSONLOGEDGES
i = 0;
j = 0;