Something went wrong. Try again.
[READ-ONLY] Mirror of https://github.com/Schniz/robotikka. Lee Ve Tom Ve Ani Doin our Robottttt
Something went wrong. Try again.
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114#include "config.h"
#include <iostream>#include <fstream>#include <stdlib.h>using namespace std;
struct Decleration { string name; string value;};
#include <tr1/regex>#include <regex.h>#include "log.h"
vector<Decleration> readLines(string fileName) { vector<Decleration> lines; ifstream fileStream(fileName.c_str()); if (!fileStream) { cout << "WAT"; return lines; } string line; while (getline(fileStream, line)) { Decleration lineDec; int colon = line.find(':'); lineDec.name = line.substr(0, colon); lineDec.value = line.substr(colon + 2, line.length() - colon - 3); lines.push_back(lineDec); } return lines;}
void parseGoal(Config* config, string value) { int space = value.find(' '); unsigned x = atoi(value.substr(0, space).c_str()); unsigned y = atoi(value.substr(space+1).c_str()); config->goal[0] = x; config->goal[1] = y;}
void parseStartLocation(Config* config, string value) { int firstSpace = value.find(' '); int secondSpace = value.substr(firstSpace+1).find(' ') + firstSpace + 1; unsigned x = atoi(value.substr(0, firstSpace).c_str()); unsigned y = atoi(value.substr(firstSpace+1, secondSpace).c_str()); unsigned yaw = atoi(value.substr(secondSpace+1).c_str()); config->startLocation[0] = x; config->startLocation[1] = y; config->startLocation[2] = yaw;}
void parseRobotSize(Config* config, string value) { int space = value.find(' '); unsigned width = atoi(value.substr(0, space).c_str()); unsigned height = atoi(value.substr(space+1).c_str()); config->robotSize[0] = width; config->robotSize[1] = height;}
void Config::parse(string fileName) { vector<Decleration> decs = readLines(fileName);
// OMFG its ugly for (Decleration dec : decs) { if (!dec.name.compare("goal")) { parseGoal(this, dec.value); } else if (!dec.name.compare("map")) { this->mapLocation = dec.value; } else if (!dec.name.compare("startLocation")) { parseStartLocation(this, dec.value); } else if (!dec.name.compare("robotSize")) { parseRobotSize(this, dec.value); } else if (!dec.name.compare("MapResolutionCM")) { this->mapResolutionCm = atof(dec.value.c_str()); } else if (!dec.name.compare("GridResolutionCM")) { this->gridResolutionCm = atof(dec.value.c_str()); } }
// Debug it cout << "config.cpp" << endl << "---------------------------------------------" << endl << "map location: " << this->mapLocation << endl << "start location: " << this->startLocation[0] << " " << this->startLocation[1] << " " << this->startLocation[2] << endl << "goal: " << this->goal[0] << " " << this->goal[1] << endl << "robot size: " << this->robotSize[0] << " " << this->robotSize[1] << endl << "map res: " << this->mapResolutionCm << endl << "grid res: " << this->gridResolutionCm << endl << "---------------------------------------------" << endl ;}
Config::Config(string fileName) { this->mapLocation = string("/home/colman/git/robotikka/Reasurce/roboticLabMap.png"); this->startLocation = new int[3]; this->goal = new int[2]; this->robotSize = new int[2]; this->robotSize[0] = 30; this->robotSize[1]= 30; this->mapResolutionCm = 2.5; this->gridResolutionCm = 10; this->parse(fileName);}
Config::~Config() { delete[] this->goal; delete[] this->startLocation; delete[] this->robotSize;}