Marker::Marker(const Marker &m) :m_id(m.getID()) { for(int i=0; i<16; i++) { m_position[i]=m.getTransformation()[i]; } }
AntState* DroppingMarker::update() { properties_.currentMarker = NULL; if(!hasTooCloseMarker()) { Marker* dropped = properties_.robot->dropMarker(); properties_.currentMarker = dropped; LOG(DEBUG) << "-- dropped marker id " << dropped->getID() << " (" << properties_.robot->getName() << ")"; } return new SelectingTarget(properties_); }