REP and ROP update sub kinematics first

Author: Levi-Armstrong

tesseract/tesseract_kinematics/src/core/rep_inverse_kinematics.cpp

@@ -44,6 +44,8 @@ InverseKinematics::Ptr RobotWithExternalPositionerInvKin::clone() const
 
 bool RobotWithExternalPositionerInvKin::update()
 {
+  manip_inv_kin_->update();
+  positioner_fwd_kin_->update();
   return init(scene_graph_, manip_inv_kin_, manip_reach_, positioner_fwd_kin_, positioner_sample_resolution_, name_);
 }
 

tesseract/tesseract_kinematics/src/core/rop_inverse_kinematics.cpp

@@ -44,6 +44,8 @@ InverseKinematics::Ptr RobotOnPositionerInvKin::clone() const
 
 bool RobotOnPositionerInvKin::update()
 {
+  manip_inv_kin_->update();
+  positioner_fwd_kin_->update();
   return init(scene_graph_, manip_inv_kin_, manip_reach_, positioner_fwd_kin_, positioner_sample_resolution_, name_);
 }