added ability to set an initial pos for the model (by setting joint angles in the yml file)
removed commented section from poseType.cpp
Added motor current output for Joints driver
Merge branch 'initial_pose' into initial_pose_joint_currents