dxl state msg - not reporting current torque & hw states

[Noa-Thouard-Nexxis]

On the humble branch.

The torque and hw_state don't reflect the real state of the servo/s.

[Noa-Thouard-Nexxis]

Pretty simple fix for the torque. The following is my solution in my forked version:
using const auto& dxl_torque_state = dxl_comm_->GetDxlTorqueState(); instead of the unassigned dxl_torque_state_. I also went ahead and update the dxl_state_msg with the changes seen on Jazzy.

  if (dxl_state_pub_uni_ptr_) {
    dxl_state_msg_.header.stamp = this->now();
    dxl_state_msg_.comm_state = dxl_comm_err_;
    const auto& dxl_torque_state = dxl_comm_->GetDxlTorqueState();
    for (auto it : hdl_trans_states_) {
      dxl_state_msg_.id.at(index) = it.id;
      dxl_state_msg_.dxl_hw_state.at(index) = dxl_hw_err_[it.id];
      auto ts_it = dxl_torque_state.find({it.comm_id, it.id});
      bool ts = (ts_it != dxl_torque_state.end()) ? ts_it->second : false;
      dxl_state_msg_.torque_state.at(index) = ts;
      index++;
    }
    dxl_state_pub_uni_ptr_->tryPublish(dxl_state_msg_);
  }