void parseArgsThenInit(int argc, char* argv[]) {
startRobogen();
// ---------------------------------------
// verify usage and load configuration
// ---------------------------------------
if (argc > 1 && std::string(argv[1]) == "--help") {
printUsage(argv);
printHelp();
exitRobogen(EXIT_SUCCESS);
}
if ((argc < 4)) {
printUsage(argv);
std::cout << "RUN: " << std::endl << std::endl
<< " " << std::string(argv[0])
<< " --help to see all configuration options."
<< std::endl << std::endl;
exitRobogen(EXIT_FAILURE);
}
unsigned int seed = atoi(argv[1]);
std::string outputDirectory = std::string(argv[2]);
std::string confFileName = std::string(argv[3]);
bool overwrite = false;
bool saveAll = false;
int currentArg = 4;
for (; currentArg < argc; currentArg++) {
if (std::string("--help").compare(argv[currentArg]) == 0) {
printUsage(argv);
printHelp();
exitRobogen(EXIT_SUCCESS);
} else if (std::string("--overwrite").compare(argv[currentArg]) == 0) {
overwrite = true;
} else if (std::string("--save-all").compare(argv[currentArg]) == 0) {
saveAll = true;
} else {
std::cerr << std::endl << "Invalid option: " << argv[currentArg]
<< std::endl << std::endl;
printUsage(argv);
exitRobogen(EXIT_FAILURE);
}
}
init(seed, outputDirectory, confFileName, overwrite, saveAll);
}
float JSScenario::vectorDistance(emscripten::val vector1,
emscripten::val vector2) {
if ((!vector1["x"].isUndefined()) && (!vector2["x"].isUndefined())) {
if ((!vector1["y"].isUndefined()) && (!vector2["y"].isUndefined())) {
if ((!vector1["z"].isUndefined()) &&
(!vector2["z"].isUndefined())) {
return (osg::Vec3(vector1["x"].as<float>(),
vector1["y"].as<float>(),
vector1["z"].as<float>()) -
osg::Vec3(vector2["x"].as<float>(),
vector2["y"].as<float>(),
vector2["z"].as<float>())).length();
} else if ((!vector1["z"].isUndefined()) ||
(!vector2["z"].isUndefined())) {
std::cerr << "Problem computing vector distance! Both vectors"
<< " must have same dimension!!" << std::endl;
exitRobogen(EXIT_FAILURE);
} else {
return (osg::Vec2(vector1["x"].as<float>(),
vector1["y"].as<float>()) -
osg::Vec2(vector2["x"].as<float>(),
vector2["y"].as<float>())).length();
}
}else if ((!vector1["y"].isUndefined()) ||
(!vector2["y"].isUndefined())) {
std::cerr << "Problem computing vector distance! Both vectors"
<< " must have same dimension!!" << std::endl;
exitRobogen(EXIT_FAILURE);
} else {
return fabs(vector1["x"].as<float>() - vector2["x"].as<float>());
}
}
std::cerr << "Problem computing vector distance! Must provide two "
"equal dimensional vectors!!" << std::endl;
exitRobogen(EXIT_FAILURE);
return NAN;
}
void postEvaluateStd() {
// comma or plus?
if (conf->replacement == conf->PLUS_REPLACEMENT) {
children += *population.get();
}
// replace
population.reset(new Population());
if (!population->init(children, conf->mu)) {
std::cout << "Error when initializing population!" << std::endl;
exitRobogen(EXIT_FAILURE);
}
mainEvolutionLoop();
}
void mainEvolutionLoop() {
#ifdef EMSCRIPTEN
std::stringstream ss;
double best, average, stddev;
population->getStat(best, average, stddev);
ss << "{best : " << best << ", average : " << average << ", stddev : "
<< stddev << ", generation : " << generation << "}";
sendJSEvent("stats", ss.str());
#endif
std::cout << "mainEvolutionLoop" << std::endl;
if (!log->logGeneration(generation, *population.get())) {
exitRobogen(EXIT_FAILURE);
}
generation++;
if (generation <= conf->numGenerations) {
std::cout << "Generation " << generation << std::endl;
children.clear();
// create children
if (neat) {
//neatPopulation->Epoch();
if(!neatContainer->produceNextGeneration(population)) {
std::cerr << "Producing next generation from NEAT failed."
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
population->evaluate(robotConf, sockets);
} else {
selector->initPopulation(population);
unsigned int numOffspring = 0;
while (numOffspring < conf->lambda) {
std::pair<boost::shared_ptr<RobotRepresentation>,
boost::shared_ptr<RobotRepresentation> > selection;
if (!selector->select(selection.first)) {
std::cerr << "Selector::select() failed." << std::endl;
exitRobogen(EXIT_FAILURE);
}
unsigned int tries = 0;
do {
if (tries > 10000) {
std::cerr << "Selecting second parent failed after "
"10000 tries, giving up.";
exitRobogen(EXIT_FAILURE);
}
if (!selector->select(selection.second)) {
std::cerr << "Selector::select() failed." << std::endl;
exitRobogen(EXIT_FAILURE);
}
tries++;
} while (selection.first == selection.second);
std::vector<boost::shared_ptr<RobotRepresentation> > offspring
= mutator->createOffspring(selection.first,
selection.second);
// no crossover, or can fit both new individuals
if ( (numOffspring + offspring.size()) <= conf->lambda ) {
children.insert(children.end(), offspring.begin(),
offspring.end() );
numOffspring += offspring.size();
} else { // crossover, but can only fit one
children.push_back(offspring[0]);
numOffspring++;
}
}
children.evaluate(robotConf, sockets);
}
#ifndef EMSCRIPTEN
triggerPostEvaluate();
#endif
} else {
#ifdef EMSCRIPTEN
sendJSEvent("evolutionTerminated", "{}");
#endif
}
}
void init(unsigned int seed, std::string outputDirectory,
std::string confFileName, bool overwrite, bool saveAll) {
// Seed random number generator
rng.seed(seed);
conf.reset(new EvolverConfiguration());
if (!conf->init(confFileName)) {
std::cerr << "Problems parsing the evolution configuration file. Quit."
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
robotConf = ConfigurationReader::parseConfigurationFile(
conf->simulatorConfFile);
if (robotConf == NULL) {
std::cerr << "Problems parsing the robot configuration file. Quit."
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
// ---------------------------------------
// Set up evolution
// ---------------------------------------
if (conf->selection == conf->DETERMINISTIC_TOURNAMENT) {
selector.reset(new DeterministicTournament(conf->tournamentSize, rng));
} else {
std::cerr << "Selection type id " << conf->selection << " unknown."
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
mutator.reset(new Mutator(conf, rng));
log.reset(new EvolverLog());
try {
if (!log->init(conf, robotConf, outputDirectory, overwrite, saveAll)) {
std::cerr << "Error creating evolver log. Aborting." << std::endl;
exitRobogen(EXIT_FAILURE);
}
} catch (std::exception& e) {
std::cerr << e.what() << std::endl;
exitRobogen(EXIT_FAILURE);
} catch (...) {
std::cerr << "non standard exception " << std::endl;
exitRobogen(EXIT_FAILURE);
}
// ---------------------------------------
// parse robot from file & initialize population
// ---------------------------------------
boost::shared_ptr<RobotRepresentation> referenceBot(
new RobotRepresentation());
bool growBodies = false;
if (conf->evolutionMode == EvolverConfiguration::BRAIN_EVOLVER
&& conf->referenceRobotFile.compare("") == 0) {
std::cerr << "Trying to evolve brain, but no robot file provided."
<< std::endl;
exitRobogen(EXIT_FAILURE);
} else if (conf->referenceRobotFile.compare("") != 0) {
if (!referenceBot->init(conf->referenceRobotFile)) {
std::cerr << "Failed interpreting robot from text file"
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
} else { //doing body evolution and don't have a reference robot
if (referenceBot->init()) {
growBodies = true;
} else {
std::cerr << "Failed creating base robot for body evolution"
<< std::endl;
exitRobogen(EXIT_FAILURE);
}
}
neat = (conf->evolutionaryAlgorithm == EvolverConfiguration::HYPER_NEAT);
population.reset(new Population());
if (!population->init(referenceBot, conf->mu, mutator, growBodies,
(!(conf->useBrainSeed || neat)) ) ) {
std::cerr << "Error when initializing population!" << std::endl;
exitRobogen(EXIT_FAILURE);
}
if (neat) {
neatContainer.reset(new NeatContainer(conf, population, seed, rng));
}
// ---------------------------------------
// open sockets for communication with simulator processes
// ---------------------------------------
#ifndef EMSCRIPTEN
sockets.resize(conf->sockets.size());
for (unsigned int i = 0; i < conf->sockets.size(); i++) {
sockets[i] = new TcpSocket;
#ifndef FAKEROBOTREPRESENTATION_H // do not bother with sockets when using
// benchmark
if (!sockets[i]->open(conf->sockets[i].first,
conf->sockets[i].second)) {
std::cerr << "Could not open connection to simulator" << std::endl;
exitRobogen(EXIT_FAILURE);
}
#endif
}
#endif
// ---------------------------------------
// run evolution TODO stopping criterion
// ---------------------------------------
if(neat) {
if(!neatContainer->fillPopulationWeights(population)) {
std::cerr << "Filling weights from NEAT failed." << std::endl;
exitRobogen(EXIT_FAILURE);
}
}
generation = 1;
population->evaluate(robotConf, sockets);
}
