put all code snippets together to form one program that:

• reads in the desired trajectory and places it into the workspace of Yumi
• communicates with the robot over EGM interface
• performs inverse kinematics by calling C++ code base