27 #include <openrave/openrave.h> 29 #include <plugins/openrave/environment.h> 30 #include <plugins/openrave/robot.h> 31 #include <logging/console.h> 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());
Interface for logging to stderr.
Fawkes library namespace.
virtual void log_debug(const char *component, const char *format,...)
Log debug message.
virtual OpenRAVE::EnvironmentBasePtr get_env_ptr() const
Get EnvironmentBasePtr.
virtual void create()
Create and lock the environment.
virtual void log_error(const char *component, const char *format,...)
Log error message.
virtual const char * what() const
Get primary string.
Base class for exceptions in Fawkes.
OpenRaveEnvironment class.
virtual void load(const std::string &filename, fawkes::OpenRaveEnvironment *env)
Load robot from xml file.
virtual void add_robot(const std::string &filename)
Add a robot into the scene.
virtual void destroy()
Destroy the environment.
virtual void set_ready()
Set robot ready for usage.