getcapability.cc

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

#include "strafetoball.ih"

Behavior::ConfidenceInterval StrafeToBall::getCapability(rf<State> s, rf<Goal> g)
{
  WorldModel& wm = WorldModel::getInstance();

  // The ball position.
  Vector3D ball = wm.getObjectPosition(Types::BALL).getMu();

  //cerr << "Y: " << ball.getY() << " Len: " << ball.length() << " Angle: " << atan(ball.getY()/ball.getX()) << endl;

  if (fabs(ball.getY()) > 1.5 && ball.length() < 7 && fabs(atan(ball.getY()/ball.getX())) < 0.25*M_PI) {
    //cerr << "I want to Strafe!" << endl;
    return ConfidenceInterval(1.0, 1.0);
  }

  return ConfidenceInterval(0.0, 0.0);
}