27 #include <openrave/openrave.h>
29 #include <plugins/openrave/environment.h>
30 #include <plugins/openrave/robot.h>
31 #include <logging/console.h>
38 using namespace fawkes;
42 printVector(vector<float> &v)
46 for(
unsigned int i=0; i<v.size(); i++)
48 s <<
"(" << i <<
")" << v[i] <<
" ";
51 printf(
"%s \n", s.str().c_str());
55 main(
int argc,
char **argv)
57 printf(
"++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++\n");
59 string robotFile = SRCDIR
"/../manipulators/katana.robot.xml";
66 vector<OpenRAVE::RobotBasePtr> robots;
67 list<OpenRAVE::ModuleBasePtr> modules;
75 cl->
log_debug(
"qa_modules",
"Environment created");
76 cl->
log_debug(
"qa_modules",
"#modules:%u #robots:%u", modules.size(), robots.size());
82 robot->
load(robotFile, env);
90 cl->
log_debug(
"qa_modules",
"Robot loaded");
91 cl->
log_debug(
"qa_modules",
"#modules:%u #robots:%u", modules.size(), robots.size());
100 cl->
log_debug(
"qa_modules",
"Robot initialized");
101 cl->
log_debug(
"qa_modules",
"#modules:%u #robots:%u", modules.size(), robots.size());
109 cl->
log_debug(
"qa_modules",
"Robot Destroyed");
110 cl->
log_debug(
"qa_modules",
"#modules:%u #robots:%u", modules.size(), robots.size());