本文整理汇总了C++中Workspace::safePoses方法的典型用法代码示例。如果您正苦于以下问题:C++ Workspace::safePoses方法的具体用法?C++ Workspace::safePoses怎么用?C++ Workspace::safePoses使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Workspace
的用法示例。
在下文中一共展示了Workspace::safePoses方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: fabs
GridDiscretization(const Workspace &workspace, const Agent &agent, const std::vector<double> &discretizationSizes) :
discretizationSizes(discretizationSizes.begin(), discretizationSizes.end()) {
bounds = workspace.getBounds();
assert(bounds.size() == discretizationSizes.size());
unsigned int cellCount = 1;
for(unsigned int i = 0; i < discretizationSizes.size(); i++) {
double range = fabs(bounds[i].first - bounds[i].second);
if(range == 0) {
dimensions.push_back(1);
} else {
dimensions.push_back(ceil(range / discretizationSizes[i]));
}
cellCount *= dimensions.back();
}
grid.resize(cellCount);
for(unsigned int i = 0; i < cellCount; i++) {
auto pt = getGridCenter(i);
if(workspace.safePoses(agent, agent.getRepresentivePosesForLocation(pt))) {
grid[i] = true;
} else {
grid[i] = false;
}
}
populateGridNeighborOffsets();
}