Function peopleTracksCallback

opt_utils/apps/ros2udp_converter.cpp:136–207

void peopleTracksCallback(const opt_msgs::TrackArray::ConstPtr& association_message)
{
  Jzon::Array tracks;
  if (association_message->tracks.size() != 0){
    facetracksflag = 1;
  }

  if (facetracksflag==0){
    return;
  }
  
  
  Jzon::Object root, header, stamp;

  /// Add header (84 characters):
  header.Add("seq", int(association_message->header.seq));
  stamp.Add("sec", int(association_message->header.stamp.sec));
  stamp.Add("nsec", int(association_message->header.stamp.nsec));
  header.Add("stamp", stamp);
  std::string camera_name = association_message->header.frame_id;
    if (strcmp(camera_name.substr(0,1).c_str(), "/") == 0)  // Remove bar at the beginning
    {
      camera_name = camera_name.substr(1, camera_name.size() - 1);
    }
  header.Add("frame_id", camera_name);
  root.Add("header", header);

  /// Add tracks array:
  // >50 characters for every track
  for (unsigned int i = 0; i < association_message->tracks.size(); i++)
  {
    Jzon::Object current_track;
    current_track.Add("id", association_message->tracks[i].id);
    current_track.Add("x", association_message->tracks[i].x);
    current_track.Add("y", association_message->tracks[i].y);
    current_track.Add("height", association_message->tracks[i].height);
    current_track.Add("age", association_message->tracks[i].age);
    current_track.Add("confidence", association_message->tracks[i].confidence);
    current_track.Add("stable_id", association_message->tracks[i].stable_id);
    
    if (namePairs.count(association_message->tracks[i].stable_id)) {
      current_track.Add("face_name", namePairs.at(association_message->tracks[i].stable_id));
    }

    tracks.Add(current_track);
  }
  root.Add("people_tracks", tracks);

  /// Convert JSON object to string:
  Jzon::Format message_format = Jzon::StandardFormat;
  message_format.indentSize = json_indent_size;
  message_format.newline = json_newline;
  message_format.spacing = json_spacing;
  message_format.useTabs = json_use_tabs;
  Jzon::Writer writer(root, message_format);
  writer.Write();
  std::string json_string = writer.GetResult();
  //  std::cout << "String sent: " << json_string << std::endl;