+ Added icub_simulation.urdf
+ Added a bunch of commented out debug statements for future use
+ Added a simple G compensation example in thread.cpp (commented out now)