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


C++ ItemPtr::SetGrab方法代码示例

本文整理汇总了C++中ItemPtr::SetGrab方法的典型用法代码示例。如果您正苦于以下问题:C++ ItemPtr::SetGrab方法的具体用法?C++ ItemPtr::SetGrab怎么用?C++ ItemPtr::SetGrab使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在ItemPtr的用法示例。


在下文中一共展示了ItemPtr::SetGrab方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。

示例1: UpdateSkeleton

// Update the skeleton transforms based on the dragger.
void IvJointDragger::UpdateSkeleton()
{
    ItemPtr selectedItem = GetSelectedItem();
    if( !selectedItem ) {
        return;
    }
    KinBodyItemPtr pbody = boost::dynamic_pointer_cast<KinBodyItem>(selectedItem);
    if( !pbody ) {
        return;
    }

    // save the transform of the object before dragging
    SbMatrix mrot;
    _trackball->rotation.getValue().getValue(mrot);

    float fang = -atan2f(mrot[2][1], mrot[1][1]);

    // if a robot, reset the controller
    RobotItemPtr probotitem = boost::dynamic_pointer_cast<RobotItem>(pbody);

    {
        EnvironmentMutex::scoped_try_lock lock(_penv->GetMutex());

        if( !!lock ) {
            KinBody::JointPtr pjoint = pbody->GetBody()->GetJoints()[_iJointIndex];
            int d = pjoint->GetDOFIndex();
            vector<dReal> vlower,vupper;
            pbody->GetBody()->GetDOFLimits(vlower, vupper);

            if( pjoint->GetType() == KinBody::JointSlider ) {
                fang = fang*(vupper.at(d)-vlower.at(d))+vlower.at(d);
            }

            // update the joint's transform
            vector<dReal> vjoints;
            pbody->GetBody()->GetDOFValues(vjoints);
            // double check all the limits
            for(size_t i = 0; i < vjoints.size(); ++i) {
                if( vjoints[i] < vlower[i] ) {
                    vjoints[i] = vlower[i];
                }
                else if( vjoints[i] > vupper[i] ) {
                    vjoints[i] = vupper[i];
                }
            }
            if( pjoint->GetType() == KinBody::JointSpherical ) {
                SbVec3f axis; float angle;
                _trackball->rotation.getValue(axis,angle);
                vjoints.at(d+0) = axis[0]*angle;
                vjoints.at(d+1) = axis[1]*angle;
                vjoints.at(d+2) = axis[2]*angle;
            }
            else {
                vjoints.at(d+0) = fang+_jointoffset;
                if( pjoint->IsRevolute(0) ) {
                    if( vjoints.at(d) < vlower.at(d) ) {
                        if( vlower.at(d)-vjoints.at(d) < vjoints.at(d)+2*PI-vupper.at(d) ) {
                            vjoints[d] = vlower[d];
                        }
                        else {
                            vjoints[d] = vupper[d];
                        }
                    }
                    else if( vjoints.at(d) > vupper.at(d) ) {
                        if( vlower.at(d)-vjoints.at(d)+2*PI < vjoints.at(d)-vupper.at(d) ) {
                            vjoints[d] = vlower[d];
                        }
                        else {
                            vjoints[d] = vupper[d];
                        }
                    }
                }
                else {
                    if( vjoints.at(d) < vlower.at(d) ) {
                        vjoints[d] = vlower[d];
                    }
                    else if( vjoints.at(d) > vupper.at(d) ) {
                        vjoints[d] = vupper[d];
                    }
                }
            }

            if( !!probotitem && !!probotitem->GetRobot()->GetController() ) {
                probotitem->GetRobot()->GetController()->SetDesired(vjoints);
            }
            else {
                pbody->GetBody()->SetDOFValues(vjoints, KinBody::CLA_CheckLimits);
            }
        }
    }

    _viewer.lock()->_UpdateCameraTransform(0);

    UpdateDragger();

    // do collision checking if required
    CheckCollision(_checkCollision);

    selectedItem->SetGrab(false, false); // will be updating manually
//.........这里部分代码省略.........
开发者ID:AbuShaqra,项目名称:openrave,代码行数:101,代码来源:ivselector.cpp


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