Test files for loading robot from urdf and performing inverse kinematics
Converted pose_generator to C++ in order to use necessary libraries
Corrected to work with IK library
Merge branch 'jarvis_grasp' into integration