I think this argument type should be  const robot_state::RobotStatePtr&