Created new models that use yaw. Note that gripper_joint1_R has been moved to the middle of nowhere because something is wrong with it
Updated InvKin and RavenCommand to work with new model
Tested new yaw with IK. Works. Test with trajopt tomorrow