1 #include "header/logger.h" 5 Logger::Logger(std::string nodeName, std::string pathLog){
7 this->nodeName = nodeName;
8 this->pathLog = pathLog +=
"/" + nodeName;
9 std::cout <<
"[" << nodeName
10 <<
"][Logger] Start " << std::endl;
13 void Logger::createDirectoryForNode(){
14 PRT::createDirectory(pathLog);
15 std::cout <<
"[" << nodeName
16 <<
"][Logger] Created Log Folder in " 17 << pathLog << std::endl;
20 int Logger::createTasksListDirectories(std::vector <Task*> tasksList){
22 for (
int i =0; i< tasksList.size(); ++i){
23 PRT::createDirectory(pathLog +
"/" +tasksList[i]->getName());
25 std::cout <<
"[" << nodeName
26 <<
"][Logger] Created Log SubFolders for tasks in " 27 << pathLog << std::endl;
32 int Logger::logAllForTasks(std::vector <Task*> tasksList){
34 Logger::logTasksActivation(tasksList);
35 Logger::logTasksReference(tasksList);
36 Logger::logTasksError(tasksList);
41 int Logger::logTasksActivation(std::vector <Task*> tasksList){
43 for(
int i=0; i<tasksList.size(); i++){
44 std::string pathname = pathLog +
"/" + tasksList[i]->getName();
45 PRT::matrixCmat2file(pathname +
"/activation.txt",
46 tasksList[i]->getActivation().GetDiag());
53 int Logger::logTasksReference(std::vector <Task*> tasksList){
55 for(
int i=0; i<tasksList.size(); i++){
56 std::string pathname = pathLog +
"/" + tasksList[i]->getName();
58 PRT::matrixCmat2file(pathname +
"/reference.txt",
59 tasksList[i]->getReference());
65 int Logger::logTasksError(std::vector <Task*> tasksList){
67 for(
int i=0; i<tasksList.size(); i++){
68 std::string pathname = pathLog +
"/" + tasksList[i]->getName();
70 PRT::matrixCmat2file(pathname +
"/error.txt",
71 tasksList[i]->getError());
77 void Logger::logNumbers(std::vector<double> matrix, std::string fileName){
78 std::string path = pathLog +
"/" + fileName +
".txt";
79 PRT::vectorStd2file(path, matrix);
82 void Logger::logNumbers(Eigen::MatrixXd matrix, std::string fileName){
83 std::string path = pathLog +
"/" + fileName +
".txt";
84 PRT::matrixEigen2file(path, matrix);
87 void Logger::logNumbers(
double scalar, std::string fileName){
88 std::string path = pathLog +
"/" + fileName +
".txt";
89 PRT::double2file(path, scalar);
92 void Logger::logNumbers(CMAT::Matrix matrix, std::string fileName){
93 Logger::logNumbers(CONV::matrix_cmat2eigen(matrix), fileName);
107 std::string fileName){
110 CONV::matrix_eigen2cmat(base), fileName);
116 std::string fileName){
118 CMAT::Vect6 stressErrorSwapped = CMAT::CartError(goal, base);
120 std::vector<double> stressError(6);
121 stressError.at(0) = stressErrorSwapped(4);
122 stressError.at(1) = stressErrorSwapped(5);
123 stressError.at(2) = stressErrorSwapped(6);
124 stressError.at(3) = stressErrorSwapped(1);
125 stressError.at(4) = stressErrorSwapped(2);
126 stressError.at(5) = stressErrorSwapped(3);
128 std::string path = pathLog +
"/" + fileName +
".txt";
129 PRT::vectorStd2file(path, stressError);
void logCartError(Eigen::Matrix4d goal, Eigen::Matrix4d base, std::string fileName)
Logger::logCartError log cartesian error for two frames The result is the error that brings in2 towar...