我正在使用ompl进行3D的路径规划。请指导如何从此行收到的目标指针中获取目标位置(x,y,z)。
const ob::Goal *Goalptr = pdef->getGoal().get();
其中pdef
是问题定义。ob
是ompl::base
路径规划者正在规划路径,但我不能从中获得这个目标。
我应该如何做这样的事情:
x= Goalptr[0];
y= Goalptr[1];
z= Goalptr[2];
或者我应该先将这个Goalptr
类型转换为其他类型,然后再这样做。请帮帮忙。
https://stackoverflow.com/questions/57224624
复制相似问题