Hi,

I have a camera attached to a motor for yaw control. The motor has a encoder that I use to update the TF at 100Hz. Odometry is working at 50Hz.

The value measured from the encoder is in measured variable and update the TF with the follwing code:

static tf::TransformBroadcaster br;
tf::Transform transform;
transform.setOrigin( tf::Vector3(0.0, 0.0, 1.550) );
tf::Quaternion q;

lastAngle = (((20000.0-control.measured)*0.04366)*(M_PI/180));

q.setRPY(0, 0, lastAngle);
transform.setRotation(q);
br.sendTransform(tf::StampedTransform(transform, ros::Time::now(), "base_link", "camera2_link"));

I have the following model defined:

<link name="camera2_link">
    <visual>
      <origin xyz="0 0 0" rpy="0 0 0"/>
      <geometry>
        <box size="${camera_length} ${camera_width} ${camera_height}"/>
      </geometry>
    </visual>
    <inertial>
      <mass value="1"/>
      <inertia ixx="100" ixy="0.0" ixz="0.0" iyy="100" iyz="0.0" izz="100"/>
    </inertial>
  </link>  

  <joint name="CameratoBL" type="fixed">
      <origin
      xyz="${camera_x} ${camera_y} ${camera_z}"
      rpy="0 0 0" /> 

      <parent link="base_link" />
      <child link="camera2_link" />
  </joint>  

If you look at the video https://www.youtube.com/watch?v=YG3-VHbiBzo there is a delay on the camera2_link and I can't understand where it come from :s