getcapability.cc

来自「2007年机器人足球世界杯3D仿真组亚军于07年底的源程序。该队还于2008年获」· CC 代码 · 共 29 行

#include "canturnright.ih"

Behavior::ConfidenceInterval CanTurnRight::getCapability(rf<Behavior::State> s, rf<Behavior::Goal> g)
{
  rf<StateVarNode> angleNode = rf_cast<StateVarNode>(g->findDeep("Angle"));
  if (!angleNode)
  {
    _debugLevel1("CanTurnRight doesn't understand!");
    return ConfidenceInterval(-1.0, 0.0);
  }
    
  StateVar angleVar = angleNode->getVar();
  double angle = angleVar.second.mean();
  
  _debugLevel4("Angle: " << angle);

  //WorldModel& wm = WorldModel::getInstance();
  
  if (angle > 0)// || !wm.onMyFeet())
  {
  	_debugLevel3("Can't turn right");
    return ConfidenceInterval(-1.0, 0.0);
  }
  //cout << "TurnLeft" << endl;
 	_debugLevel4("Can turn right");
  return ConfidenceInterval(0.8, 0.0);
  
}