run.cc

The Little Green BATS is the first and so far only Dutch team in the 3D simulation league. We are a

#include "beam.ih"


using namespace bats;

bool Beam::run()
{
  _debugLevel4("Beam is being run!");
  //  Parser parser;

  _debugLevel4((rf_cast<StateVarNode>(d_goal->findDeep("X")) ? "got X" : "dont have X"));
  _debugLevel4((rf_cast<StateVarNode>(d_goal->findDeep("Y")) ? "got Y" : "dont have Y"));
  _debugLevel4((rf_cast<StateVarNode>(d_goal->findDeep("Z")) ? "got Z" : "dont have Z"));
  
  StateVar x = rf_cast<StateVarNode>(d_goal->findDeep("X"))->getVar();
  Range xrange = x.second;
  StateVar y = rf_cast<StateVarNode>(d_goal->findDeep("Y"))->getVar();
  Range yrange = y.second;
  StateVar z = rf_cast<StateVarNode>(d_goal->findDeep("Z"))->getVar();
  Range zrange = z.second;

  // This is faster than using the parser.
  d_action = new Cerebellum::BeamAction(Vector3D(xrange.mean(), yrange.mean(), zrange.mean()));

  addToActionCommandBehaviors();
  
  return true;
}