getcapability.cc

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

#include "goodpositionangle.ih"

Behavior::ConfidenceInterval GoodPositionAngle::getCapability(rf<State> s, rf<Goal> g)
{
  Vector3D pos = g->getVector("Pos");
  WorldModel& wm = WorldModel::getInstance();
  
  if (d_curStep >= 1 && pos.length() > 0.6)
    return ConfidenceInterval(0.0, 0.2);
  
  _debugLevel1("pos.length(): " << pos.length() << ", on feet: " << (wm.onMyFeet() ? "yes" : "no"));
  if (pos.length() > 8.0 || !wm.onMyFeet())
    return ConfidenceInterval(0.0, 0.2);
  
  return ConfidenceInterval(0.5, 0.2);
}