本文整理汇总了C++中SimObj::getPartsCollection方法的典型用法代码示例。如果您正苦于以下问题:C++ SimObj::getPartsCollection方法的具体用法?C++ SimObj::getPartsCollection怎么用?C++ SimObj::getPartsCollection使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类SimObj
的用法示例。
在下文中一共展示了SimObj::getPartsCollection方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: onAction
//.........这里部分代码省略.........
// netVelocityTarget = sqrt(netVelocityTarget);
// stick->getPosition(pos);
// stick->getPartsPosition(pos, "LINK1");
// LOG_MSG((" LINK1 Position is : %f %f %f ", pos.x(), pos.y(), pos.z() ));
// Vector3d targetPos;
// box->getPosition(targetPos);
// Vector3d goalPos;
// goal_001->getPosition(goalPos);
// if (abs( goalPos.z() - targetPos.z()) < 1.4 )
// {
// cout << "The distance to goal is " << abs( goalPos.z() - targetPos.z()) << endl;
// cout << "The goal has been reached " << endl;
// exit(0);
// }
// if (netVelocityTarget > 0.1 )
// {
// double angle = atan ( (targetPos.z() - startPosition.z()) / (targetPos.x() - startPosition.x() ) ) * 180 / PI;
// cout << "The angle is" << angle;
// storePosition(targetPos);
// }
std::vector<std::string> s;
for(std::map<std::string, CParts *>::iterator it = stick->getPartsCollection().begin(); it != stick->getPartsCollection().end(); ++it){
if (it->first != "body")
s.push_back(it->first);
}
std::string linkName;
Size si;
cout << "The total links are " << s.size() << endl;
for (int i = 0; i < s.size(); i++){
const char* linkName = s[i].c_str();
CParts *link = stick->getParts(linkName);
link->getPosition(pos);
link->getRotation(linkRotation);
if (link->getType() == 0){
BoxParts* box = (BoxParts*) link;
si = box->getSize();
// cout << linkName << endl;
cout << linkName << " position : x = " << pos.x() << " y = " << pos.y() << " z = " << pos.z() << endl;
// cout << linkName << " size : x = " << si.x() << " y = " << si.y() << " z = " << si.z() << endl;
// cout << linkName << " Rotation: qw " << linkRotation.qw() << " qx = "<< linkRotation.qx() << " qy = "<< linkRotation.qy()
// << " qz = "<< linkRotation.qz() << endl;
try{
py::object main_module = py::import("__main__");
py::object main_namespace = main_module.attr("__dict__");
main_module.attr("linkName") = linkName;
main_module.attr("length") = si.x();
main_module.attr("height") = si.y();