当前位置: 首页>>代码示例>>C++>>正文


C++ Workspace::safePoses方法代码示例

本文整理汇总了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();
	}
开发者ID:csbence,项目名称:motionplanningtoolkit,代码行数:29,代码来源:griddiscretization.hpp


注:本文中的Workspace::safePoses方法示例由纯净天空整理自Github/MSDocs等开源代码及文档管理平台,相关代码片段筛选自各路编程大神贡献的开源项目,源码版权归原作者所有,传播和使用请参考对应项目的License;未经允许,请勿转载。