fixed failing test by adding myriad calls to update the robot state after modifying it
Merge pull request #203 from jon-weisz/fix_kinematic_constraints_tests

fixes #113 #114 and #115 failing test by adding myriad calls to update the robot state afte...