📄 hinge2effector.cpp

📁 rcssserver3d Robocup 3D比赛官方指定平台
💻 CPP
字号:
/* -*- mode: c++; c-basic-offset: 4; indent-tabs-mode: nil -*-   this file is part of rcssserver3D   Fri May 9 2003   Copyright (C) 2002,2003 Koblenz University   Copyright (C) 2003 RoboCup Soccer Server 3D Maintenance Group   $Id: hinge2effector.cpp,v 1.6 2008/03/27 03:01:27 hedayat Exp $   This program is free software; you can redistribute it and/or modify   it under the terms of the GNU General Public License as published by   the Free Software Foundation; version 2 of the License.   This program is distributed in the hope that it will be useful,   but WITHOUT ANY WARRANTY; without even the implied warranty of   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the   GNU General Public License for more details.   You should have received a copy of the GNU General Public License   along with this program; if not, write to the Free Software   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.*/#include "hinge2effector.h"#include "hinge2action.h"#include <oxygen/physicsserver/body.h>using namespace oxygen;using namespace zeitgeist;using namespace boost;using namespace std;Hinge2Effector::Hinge2Effector()    : JointEffector<Hinge2Joint>::JointEffector("hinge2"){}Hinge2Effector::~Hinge2Effector(){}bool Hinge2Effector::Realize(boost::shared_ptr<ActionObject> action){    if (mJoint.get() == 0)        {            return false;        }    shared_ptr<Hinge2Action> hinge2Action =        shared_dynamic_cast<Hinge2Action>(action);    if (hinge2Action.get() == 0)    {        GetLog()->Error()            << "ERROR: (Hinge2Effector) cannot realize an "            << "unknown ActionObject\n";        return false;    }    mJoint->SetAngularMotorVelocity        (Joint::AI_SECOND, hinge2Action->GetMotorVelocity());    if (hinge2Action->GetMotorVelocity() != 0)        {            shared_ptr<Body> body = mJoint->GetBody(Joint::BI_FIRST);            if (body && !body->IsEnabled())                {                    body->Enable();                }        }    return true;}shared_ptr<ActionObject> Hinge2Effector::GetActionObject(const Predicate& predicate){    for(;;)        {            if (mJoint.get() == 0)                {                    break;                }            if (predicate.name != GetPredicate())                {                    GetLog()->Error()                        << "ERROR: (KickEffector) invalid predicate"                        << predicate.name << "\n";                    break;                }            Predicate::Iterator iter = predicate.begin();            float velocity;            if (! predicate.AdvanceValue(iter, velocity))                {                    GetLog()->Error()                        << "ERROR: (KickEffector) motor velocity expected\n";                    break;                }            return shared_ptr<Hinge2Action>(new Hinge2Action(GetPredicate(),velocity));        }    return shared_ptr<ActionObject>();}
⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -