src/plugins/utils/muxer/muxer.c

   1 /*
   2  * Copyright 2017 Philippe Proulx <pproulx@efficios.com>
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a copy
   5  * of this software and associated documentation files (the "Software"), to deal
   6  * in the Software without restriction, including without limitation the rights
   7  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   8  * copies of the Software, and to permit persons to whom the Software is
   9  * furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  17  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  18  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  19  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  20  * SOFTWARE.
  21  */
  22
  23 #define BT_COMP_LOG_SELF_COMP (muxer_comp->self_comp)
  24 #define BT_LOG_OUTPUT_LEVEL (muxer_comp->log_level)
  25 #define BT_LOG_TAG "PLUGIN/FLT.UTILS.MUXER"
  26 #include "logging/comp-logging.h"
  27
  28 #include "common/macros.h"
  29 #include "common/uuid.h"
  30 #include <babeltrace2/babeltrace.h>
  31 #include <glib.h>
  32 #include <stdbool.h>
  33 #include <inttypes.h>
  34 #include "common/assert.h"
  35 #include "common/common.h"
  36 #include <stdlib.h>
  37 #include <string.h>
  38
  39 #include "plugins/common/muxing/muxing.h"
  40
  41 #include "muxer.h"
  42
  43 #define ASSUME_ABSOLUTE_CLOCK_CLASSES_PARAM_NAME        "assume-absolute-clock-classes"
  44
  45 struct muxer_comp {
  46         /* Weak refs */
  47         bt_self_component_filter *self_comp_flt;
  48         bt_self_component *self_comp;
  49
  50         unsigned int next_port_num;
  51         size_t available_input_ports;
  52         bool initializing_muxer_msg_iter;
  53         bool assume_absolute_clock_classes;
  54         bt_logging_level log_level;
  55 };
  56
  57 struct muxer_upstream_msg_iter {
  58         struct muxer_comp *muxer_comp;
  59
  60         /* Owned by this, NULL if ended */
  61         bt_self_component_port_input_message_iterator *msg_iter;
  62
  63         /* Contains `const bt_message *`, owned by this */
  64         GQueue *msgs;
  65 };
  66
  67 enum muxer_msg_iter_clock_class_expectation {
  68         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ANY = 0,
  69         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NONE,
  70         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ABSOLUTE,
  71         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_SPEC_UUID,
  72         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_NO_UUID,
  73 };
  74
  75 struct muxer_msg_iter {
  76         struct muxer_comp *muxer_comp;
  77
  78         /* Weak */
  79         bt_self_message_iterator *self_msg_iter;
  80
  81         /*
  82          * Array of struct muxer_upstream_msg_iter * (owned by this).
  83          *
  84          * NOTE: This array is searched in linearly to find the youngest
  85          * current message. Keep this until benchmarks confirm that
  86          * another data structure is faster than this for our typical
  87          * use cases.
  88          */
  89         GPtrArray *active_muxer_upstream_msg_iters;
  90
  91         /*
  92          * Array of struct muxer_upstream_msg_iter * (owned by this).
  93          *
  94          * We move ended message iterators from
  95          * `active_muxer_upstream_msg_iters` to this array so as to be
  96          * able to restore them when seeking.
  97          */
  98         GPtrArray *ended_muxer_upstream_msg_iters;
  99
 100         /* Last time returned in a message */
 101         int64_t last_returned_ts_ns;
 102
 103         /* Clock class expectation state */
 104         enum muxer_msg_iter_clock_class_expectation clock_class_expectation;
 105
 106         /*
 107          * Expected clock class UUID, only valid when
 108          * clock_class_expectation is
 109          * MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_SPEC_UUID.
 110          */
 111         bt_uuid_t expected_clock_class_uuid;
 112 };
 113
 114 static
 115 void empty_message_queue(struct muxer_upstream_msg_iter *upstream_msg_iter)
 116 {
 117         const bt_message *msg;
 118
 119         while ((msg = g_queue_pop_head(upstream_msg_iter->msgs))) {
 120                 bt_message_put_ref(msg);
 121         }
 122 }
 123
 124 static
 125 void destroy_muxer_upstream_msg_iter(
 126                 struct muxer_upstream_msg_iter *muxer_upstream_msg_iter)
 127 {
 128         struct muxer_comp *muxer_comp;
 129
 130         if (!muxer_upstream_msg_iter) {
 131                 return;
 132         }
 133
 134         muxer_comp = muxer_upstream_msg_iter->muxer_comp;
 135         BT_COMP_LOGD("Destroying muxer's upstream message iterator wrapper: "
 136                 "addr=%p, msg-iter-addr=%p, queue-len=%u",
 137                 muxer_upstream_msg_iter,
 138                 muxer_upstream_msg_iter->msg_iter,
 139                 muxer_upstream_msg_iter->msgs->length);
 140         bt_self_component_port_input_message_iterator_put_ref(
 141                 muxer_upstream_msg_iter->msg_iter);
 142
 143         if (muxer_upstream_msg_iter->msgs) {
 144                 empty_message_queue(muxer_upstream_msg_iter);
 145                 g_queue_free(muxer_upstream_msg_iter->msgs);
 146         }
 147
 148         g_free(muxer_upstream_msg_iter);
 149 }
 150
 151 static
 152 int muxer_msg_iter_add_upstream_msg_iter(struct muxer_msg_iter *muxer_msg_iter,
 153                 bt_self_component_port_input_message_iterator *self_msg_iter)
 154 {
 155         int ret = 0;
 156         struct muxer_upstream_msg_iter *muxer_upstream_msg_iter =
 157                 g_new0(struct muxer_upstream_msg_iter, 1);
 158         struct muxer_comp *muxer_comp = muxer_msg_iter->muxer_comp;
 159
 160         if (!muxer_upstream_msg_iter) {
 161                 BT_COMP_LOGE_STR("Failed to allocate one muxer's upstream message iterator wrapper.");
 162                 goto error;
 163         }
 164
 165         muxer_upstream_msg_iter->muxer_comp = muxer_comp;
 166         muxer_upstream_msg_iter->msg_iter = self_msg_iter;
 167         bt_self_component_port_input_message_iterator_get_ref(muxer_upstream_msg_iter->msg_iter);
 168         muxer_upstream_msg_iter->msgs = g_queue_new();
 169         if (!muxer_upstream_msg_iter->msgs) {
 170                 BT_COMP_LOGE_STR("Failed to allocate a GQueue.");
 171                 goto error;
 172         }
 173
 174         g_ptr_array_add(muxer_msg_iter->active_muxer_upstream_msg_iters,
 175                 muxer_upstream_msg_iter);
 176         BT_COMP_LOGD("Added muxer's upstream message iterator wrapper: "
 177                 "addr=%p, muxer-msg-iter-addr=%p, msg-iter-addr=%p",
 178                 muxer_upstream_msg_iter, muxer_msg_iter,
 179                 self_msg_iter);
 180
 181         goto end;
 182
 183 error:
 184         g_free(muxer_upstream_msg_iter);
 185         ret = -1;
 186
 187 end:
 188         return ret;
 189 }
 190
 191 static
 192 bt_self_component_add_port_status add_available_input_port(
 193                 bt_self_component_filter *self_comp)
 194 {
 195         struct muxer_comp *muxer_comp = bt_self_component_get_data(
 196                 bt_self_component_filter_as_self_component(self_comp));
 197         bt_self_component_add_port_status status =
 198                 BT_SELF_COMPONENT_ADD_PORT_STATUS_OK;
 199         GString *port_name = NULL;
 200
 201         BT_ASSERT(muxer_comp);
 202         port_name = g_string_new("in");
 203         if (!port_name) {
 204                 BT_COMP_LOGE_STR("Failed to allocate a GString.");
 205                 status = BT_SELF_COMPONENT_ADD_PORT_STATUS_MEMORY_ERROR;
 206                 goto end;
 207         }
 208
 209         g_string_append_printf(port_name, "%u", muxer_comp->next_port_num);
 210         status = bt_self_component_filter_add_input_port(
 211                 self_comp, port_name->str, NULL, NULL);
 212         if (status != BT_SELF_COMPONENT_ADD_PORT_STATUS_OK) {
 213                 BT_COMP_LOGE("Cannot add input port to muxer component: "
 214                         "port-name=\"%s\", comp-addr=%p, status=%s",
 215                         port_name->str, self_comp,
 216                         bt_common_func_status_string(status));
 217                 goto end;
 218         }
 219
 220         muxer_comp->available_input_ports++;
 221         muxer_comp->next_port_num++;
 222         BT_COMP_LOGI("Added one input port to muxer component: "
 223                 "port-name=\"%s\", comp-addr=%p",
 224                 port_name->str, self_comp);
 225
 226 end:
 227         if (port_name) {
 228                 g_string_free(port_name, TRUE);
 229         }
 230
 231         return status;
 232 }
 233
 234 static
 235 bt_self_component_add_port_status create_output_port(
 236                 bt_self_component_filter *self_comp)
 237 {
 238         return bt_self_component_filter_add_output_port(
 239                 self_comp, "out", NULL, NULL);
 240 }
 241
 242 static
 243 void destroy_muxer_comp(struct muxer_comp *muxer_comp)
 244 {
 245         if (!muxer_comp) {
 246                 return;
 247         }
 248
 249         g_free(muxer_comp);
 250 }
 251
 252 static
 253 bt_value *get_default_params(struct muxer_comp *muxer_comp)
 254 {
 255         bt_value *params;
 256         int ret;
 257
 258         params = bt_value_map_create();
 259         if (!params) {
 260                 BT_COMP_LOGE_STR("Cannot create a map value object.");
 261                 goto error;
 262         }
 263
 264         ret = bt_value_map_insert_bool_entry(params,
 265                 ASSUME_ABSOLUTE_CLOCK_CLASSES_PARAM_NAME, false);
 266         if (ret) {
 267                 BT_COMP_LOGE_STR("Cannot add boolean value to map value object.");
 268                 goto error;
 269         }
 270
 271         goto end;
 272
 273 error:
 274         BT_VALUE_PUT_REF_AND_RESET(params);
 275
 276 end:
 277         return params;
 278 }
 279
 280 static
 281 int configure_muxer_comp(struct muxer_comp *muxer_comp,
 282                 const bt_value *params)
 283 {
 284         bt_value *default_params = NULL;
 285         bt_value *real_params = NULL;
 286         const bt_value *assume_absolute_clock_classes = NULL;
 287         int ret = 0;
 288         bt_bool bool_val;
 289
 290         default_params = get_default_params(muxer_comp);
 291         if (!default_params) {
 292                 BT_COMP_LOGE("Cannot get default parameters: "
 293                         "muxer-comp-addr=%p", muxer_comp);
 294                 goto error;
 295         }
 296
 297         ret = bt_value_map_extend(default_params, params, &real_params);
 298         if (ret) {
 299                 BT_COMP_LOGE("Cannot extend default parameters map value: "
 300                         "muxer-comp-addr=%p, def-params-addr=%p, "
 301                         "params-addr=%p", muxer_comp, default_params,
 302                         params);
 303                 goto error;
 304         }
 305
 306         assume_absolute_clock_classes = bt_value_map_borrow_entry_value(real_params,
 307                                                                         ASSUME_ABSOLUTE_CLOCK_CLASSES_PARAM_NAME);
 308         if (assume_absolute_clock_classes &&
 309                         !bt_value_is_bool(assume_absolute_clock_classes)) {
 310                 BT_COMP_LOGE("Expecting a boolean value for the `%s` parameter: "
 311                         "muxer-comp-addr=%p, value-type=%s",
 312                         ASSUME_ABSOLUTE_CLOCK_CLASSES_PARAM_NAME, muxer_comp,
 313                         bt_common_value_type_string(
 314                                 bt_value_get_type(assume_absolute_clock_classes)));
 315                 goto error;
 316         }
 317
 318         bool_val = bt_value_bool_get(assume_absolute_clock_classes);
 319         muxer_comp->assume_absolute_clock_classes = (bool) bool_val;
 320         BT_COMP_LOGI("Configured muxer component: muxer-comp-addr=%p, "
 321                 "assume-absolute-clock-classes=%d",
 322                 muxer_comp, muxer_comp->assume_absolute_clock_classes);
 323         goto end;
 324
 325 error:
 326         ret = -1;
 327
 328 end:
 329         bt_value_put_ref(default_params);
 330         bt_value_put_ref(real_params);
 331         return ret;
 332 }
 333
 334 BT_HIDDEN
 335 bt_component_class_init_method_status muxer_init(
 336                 bt_self_component_filter *self_comp_flt,
 337                 const bt_value *params, void *init_data)
 338 {
 339         int ret;
 340         bt_component_class_init_method_status status =
 341                 BT_COMPONENT_CLASS_INIT_METHOD_STATUS_OK;
 342         bt_self_component_add_port_status add_port_status;
 343         bt_self_component *self_comp =
 344                 bt_self_component_filter_as_self_component(self_comp_flt);
 345         struct muxer_comp *muxer_comp = g_new0(struct muxer_comp, 1);
 346         bt_logging_level log_level = bt_component_get_logging_level(
 347                 bt_self_component_as_component(self_comp));
 348
 349         BT_COMP_LOG_CUR_LVL(BT_LOG_INFO, log_level, self_comp,
 350                 "Initializing muxer component: "
 351                 "comp-addr=%p, params-addr=%p", self_comp, params);
 352
 353         if (!muxer_comp) {
 354                 BT_COMP_LOG_CUR_LVL(BT_LOG_ERROR, log_level, self_comp,
 355                         "Failed to allocate one muxer component.");
 356                 goto error;
 357         }
 358
 359         muxer_comp->log_level = log_level;
 360         muxer_comp->self_comp = self_comp;
 361         muxer_comp->self_comp_flt = self_comp_flt;
 362         ret = configure_muxer_comp(muxer_comp, params);
 363         if (ret) {
 364                 BT_COMP_LOGE("Cannot configure muxer component: "
 365                         "muxer-comp-addr=%p, params-addr=%p",
 366                         muxer_comp, params);
 367                 goto error;
 368         }
 369
 370         bt_self_component_set_data(self_comp, muxer_comp);
 371         add_port_status = add_available_input_port(self_comp_flt);
 372         if (add_port_status != BT_SELF_COMPONENT_ADD_PORT_STATUS_OK) {
 373                 BT_COMP_LOGE("Cannot ensure that at least one muxer component's input port is available: "
 374                         "muxer-comp-addr=%p, status=%s",
 375                         muxer_comp,
 376                         bt_common_func_status_string(add_port_status));
 377                 if (add_port_status ==
 378                                 BT_SELF_COMPONENT_ADD_PORT_STATUS_MEMORY_ERROR) {
 379                         status = BT_COMPONENT_CLASS_INIT_METHOD_STATUS_MEMORY_ERROR;
 380                 } else {
 381                         status = BT_COMPONENT_CLASS_INIT_METHOD_STATUS_ERROR;
 382                 }
 383
 384                 goto error;
 385         }
 386
 387         add_port_status = create_output_port(self_comp_flt);
 388         if (add_port_status != BT_SELF_COMPONENT_ADD_PORT_STATUS_OK) {
 389                 BT_COMP_LOGE("Cannot create muxer component's output port: "
 390                         "muxer-comp-addr=%p, status=%s",
 391                         muxer_comp,
 392                         bt_common_func_status_string(add_port_status));
 393                 if (add_port_status ==
 394                                 BT_SELF_COMPONENT_ADD_PORT_STATUS_MEMORY_ERROR) {
 395                         status = BT_COMPONENT_CLASS_INIT_METHOD_STATUS_MEMORY_ERROR;
 396                 } else {
 397                         status = BT_COMPONENT_CLASS_INIT_METHOD_STATUS_ERROR;
 398                 }
 399
 400                 goto error;
 401         }
 402
 403         BT_COMP_LOGI("Initialized muxer component: "
 404                 "comp-addr=%p, params-addr=%p, muxer-comp-addr=%p",
 405                 self_comp, params, muxer_comp);
 406
 407         goto end;
 408
 409 error:
 410         destroy_muxer_comp(muxer_comp);
 411         bt_self_component_set_data(self_comp, NULL);
 412
 413         if (status == BT_COMPONENT_CLASS_INIT_METHOD_STATUS_OK) {
 414                 status = BT_COMPONENT_CLASS_INIT_METHOD_STATUS_ERROR;
 415         }
 416
 417 end:
 418         return status;
 419 }
 420
 421 BT_HIDDEN
 422 void muxer_finalize(bt_self_component_filter *self_comp)
 423 {
 424         struct muxer_comp *muxer_comp = bt_self_component_get_data(
 425                 bt_self_component_filter_as_self_component(self_comp));
 426
 427         BT_COMP_LOGI("Finalizing muxer component: comp-addr=%p",
 428                 self_comp);
 429         destroy_muxer_comp(muxer_comp);
 430 }
 431
 432 static
 433 bt_self_component_port_input_message_iterator *
 434 create_msg_iter_on_input_port(struct muxer_comp *muxer_comp,
 435                 struct muxer_msg_iter *muxer_msg_iter,
 436                 bt_self_component_port_input *self_port)
 437 {
 438         const bt_port *port = bt_self_component_port_as_port(
 439                 bt_self_component_port_input_as_self_component_port(
 440                         self_port));
 441         bt_self_component_port_input_message_iterator *msg_iter =
 442                 NULL;
 443
 444         BT_ASSERT(port);
 445         BT_ASSERT(bt_port_is_connected(port));
 446
 447         // TODO: Advance the iterator to >= the time of the latest
 448         //       returned message by the muxer message
 449         //       iterator which creates it.
 450         msg_iter = bt_self_component_port_input_message_iterator_create_from_message_iterator(
 451                 muxer_msg_iter->self_msg_iter, self_port);
 452         if (!msg_iter) {
 453                 BT_COMP_LOGE("Cannot create upstream message iterator on input port: "
 454                         "port-addr=%p, port-name=\"%s\"",
 455                         port, bt_port_get_name(port));
 456                 goto end;
 457         }
 458
 459         BT_COMP_LOGI("Created upstream message iterator on input port: "
 460                 "port-addr=%p, port-name=\"%s\", msg-iter-addr=%p",
 461                 port, bt_port_get_name(port), msg_iter);
 462
 463 end:
 464         return msg_iter;
 465 }
 466
 467 static
 468 bt_component_class_message_iterator_next_method_status muxer_upstream_msg_iter_next(
 469                 struct muxer_upstream_msg_iter *muxer_upstream_msg_iter,
 470                 bool *is_ended)
 471 {
 472         struct muxer_comp *muxer_comp =
 473                 muxer_upstream_msg_iter->muxer_comp;
 474         bt_component_class_message_iterator_next_method_status status;
 475         bt_message_iterator_next_status input_port_iter_status;
 476         bt_message_array_const msgs;
 477         uint64_t i;
 478         uint64_t count;
 479
 480         BT_COMP_LOGD("Calling upstream message iterator's \"next\" method: "
 481                 "muxer-upstream-msg-iter-wrap-addr=%p, msg-iter-addr=%p",
 482                 muxer_upstream_msg_iter,
 483                 muxer_upstream_msg_iter->msg_iter);
 484         input_port_iter_status = bt_self_component_port_input_message_iterator_next(
 485                 muxer_upstream_msg_iter->msg_iter, &msgs, &count);
 486         BT_COMP_LOGD("Upstream message iterator's \"next\" method returned: "
 487                 "status=%s",
 488                 bt_common_func_status_string(input_port_iter_status));
 489
 490         switch (input_port_iter_status) {
 491         case BT_MESSAGE_ITERATOR_NEXT_STATUS_OK:
 492                 /*
 493                  * Message iterator's current message is
 494                  * valid: it must be considered for muxing operations.
 495                  */
 496                 BT_COMP_LOGD_STR("Validated upstream message iterator wrapper.");
 497                 BT_ASSERT(count > 0);
 498
 499                 /* Move messages to our queue */
 500                 for (i = 0; i < count; i++) {
 501                         /*
 502                          * Push to tail in order; other side
 503                          * (muxer_msg_iter_do_next_one()) consumes
 504                          * from the head first.
 505                          */
 506                         g_queue_push_tail(muxer_upstream_msg_iter->msgs,
 507                                 (void *) msgs[i]);
 508                 }
 509                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
 510                 break;
 511         case BT_MESSAGE_ITERATOR_NEXT_STATUS_AGAIN:
 512                 /*
 513                  * Message iterator's current message is not
 514                  * valid anymore. Return
 515                  * BT_MESSAGE_ITERATOR_NEXT_STATUS_AGAIN immediately.
 516                  */
 517                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_AGAIN;
 518                 break;
 519         case BT_MESSAGE_ITERATOR_NEXT_STATUS_END:       /* Fall-through. */
 520                 /*
 521                  * Message iterator reached the end: release it. It
 522                  * won't be considered again to find the youngest
 523                  * message.
 524                  */
 525                 *is_ended = true;
 526                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
 527                 break;
 528         default:
 529                 /* Error or unsupported status code */
 530                 BT_COMP_LOGE("Error or unsupported status code: "
 531                         "status-code=%d", input_port_iter_status);
 532                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_ERROR;
 533                 break;
 534         }
 535
 536         return status;
 537 }
 538
 539 static
 540 int get_msg_ts_ns(struct muxer_comp *muxer_comp,
 541                 struct muxer_msg_iter *muxer_msg_iter,
 542                 const bt_message *msg, int64_t last_returned_ts_ns,
 543                 int64_t *ts_ns)
 544 {
 545         const bt_clock_snapshot *clock_snapshot = NULL;
 546         int ret = 0;
 547         const bt_stream_class *stream_class = NULL;
 548         bt_message_type msg_type;
 549
 550         BT_ASSERT(msg);
 551         BT_ASSERT(ts_ns);
 552         BT_COMP_LOGD("Getting message's timestamp: "
 553                 "muxer-msg-iter-addr=%p, msg-addr=%p, "
 554                 "last-returned-ts=%" PRId64,
 555                 muxer_msg_iter, msg, last_returned_ts_ns);
 556
 557         if (G_UNLIKELY(muxer_msg_iter->clock_class_expectation ==
 558                         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NONE)) {
 559                 *ts_ns = last_returned_ts_ns;
 560                 goto end;
 561         }
 562
 563         msg_type = bt_message_get_type(msg);
 564
 565         if (G_UNLIKELY(msg_type == BT_MESSAGE_TYPE_PACKET_BEGINNING)) {
 566                 stream_class = bt_stream_borrow_class_const(
 567                         bt_packet_borrow_stream_const(
 568                                 bt_message_packet_beginning_borrow_packet_const(
 569                                         msg)));
 570         } else if (G_UNLIKELY(msg_type == BT_MESSAGE_TYPE_PACKET_END)) {
 571                 stream_class = bt_stream_borrow_class_const(
 572                         bt_packet_borrow_stream_const(
 573                                 bt_message_packet_end_borrow_packet_const(
 574                                         msg)));
 575         } else if (G_UNLIKELY(msg_type == BT_MESSAGE_TYPE_DISCARDED_EVENTS)) {
 576                 stream_class = bt_stream_borrow_class_const(
 577                         bt_message_discarded_events_borrow_stream_const(msg));
 578         } else if (G_UNLIKELY(msg_type == BT_MESSAGE_TYPE_DISCARDED_PACKETS)) {
 579                 stream_class = bt_stream_borrow_class_const(
 580                         bt_message_discarded_packets_borrow_stream_const(msg));
 581         }
 582
 583         switch (msg_type) {
 584         case BT_MESSAGE_TYPE_EVENT:
 585                 BT_ASSERT(bt_message_event_borrow_stream_class_default_clock_class_const(
 586                                 msg));
 587                 clock_snapshot = bt_message_event_borrow_default_clock_snapshot_const(
 588                         msg);
 589                 break;
 590         case BT_MESSAGE_TYPE_PACKET_BEGINNING:
 591                 if (bt_stream_class_packets_have_beginning_default_clock_snapshot(
 592                                 stream_class)) {
 593                         clock_snapshot = bt_message_packet_beginning_borrow_default_clock_snapshot_const(
 594                                 msg);
 595                 } else {
 596                         goto no_clock_snapshot;
 597                 }
 598
 599                 break;
 600         case BT_MESSAGE_TYPE_PACKET_END:
 601                 if (bt_stream_class_packets_have_end_default_clock_snapshot(
 602                                 stream_class)) {
 603                         clock_snapshot = bt_message_packet_end_borrow_default_clock_snapshot_const(
 604                                 msg);
 605                 } else {
 606                         goto no_clock_snapshot;
 607                 }
 608
 609                 break;
 610         case BT_MESSAGE_TYPE_STREAM_BEGINNING:
 611         {
 612                 enum bt_message_stream_clock_snapshot_state snapshot_state =
 613                         bt_message_stream_beginning_borrow_default_clock_snapshot_const(
 614                                 msg, &clock_snapshot);
 615                 if (snapshot_state == BT_MESSAGE_STREAM_CLOCK_SNAPSHOT_STATE_UNKNOWN) {
 616                         goto no_clock_snapshot;
 617                 }
 618
 619                 break;
 620         }
 621         case BT_MESSAGE_TYPE_STREAM_END:
 622         {
 623                 enum bt_message_stream_clock_snapshot_state snapshot_state =
 624                         bt_message_stream_end_borrow_default_clock_snapshot_const(
 625                                 msg, &clock_snapshot);
 626                 if (snapshot_state == BT_MESSAGE_STREAM_CLOCK_SNAPSHOT_STATE_UNKNOWN) {
 627                         goto no_clock_snapshot;
 628                 }
 629
 630                 break;
 631         }
 632         case BT_MESSAGE_TYPE_DISCARDED_EVENTS:
 633                 if (bt_stream_class_discarded_events_have_default_clock_snapshots(
 634                                 stream_class)) {
 635                         clock_snapshot = bt_message_discarded_events_borrow_beginning_default_clock_snapshot_const(
 636                                 msg);
 637                 } else {
 638                         goto no_clock_snapshot;
 639                 }
 640
 641                 break;
 642         case BT_MESSAGE_TYPE_DISCARDED_PACKETS:
 643                 if (bt_stream_class_discarded_packets_have_default_clock_snapshots(
 644                                 stream_class)) {
 645                         clock_snapshot = bt_message_discarded_packets_borrow_beginning_default_clock_snapshot_const(
 646                                 msg);
 647                 } else {
 648                         goto no_clock_snapshot;
 649                 }
 650
 651                 break;
 652         case BT_MESSAGE_TYPE_MESSAGE_ITERATOR_INACTIVITY:
 653                 clock_snapshot = bt_message_message_iterator_inactivity_borrow_default_clock_snapshot_const(
 654                         msg);
 655                 break;
 656         default:
 657                 /* All the other messages have a higher priority */
 658                 BT_COMP_LOGD_STR("Message has no timestamp: using the last returned timestamp.");
 659                 *ts_ns = last_returned_ts_ns;
 660                 goto end;
 661         }
 662
 663         ret = bt_clock_snapshot_get_ns_from_origin(clock_snapshot, ts_ns);
 664         if (ret) {
 665                 BT_COMP_LOGE("Cannot get nanoseconds from Epoch of clock snapshot: "
 666                         "clock-snapshot-addr=%p", clock_snapshot);
 667                 goto error;
 668         }
 669
 670         goto end;
 671
 672 no_clock_snapshot:
 673         BT_COMP_LOGD_STR("Message's default clock snapshot is missing: "
 674                 "using the last returned timestamp.");
 675         *ts_ns = last_returned_ts_ns;
 676         goto end;
 677
 678 error:
 679         ret = -1;
 680
 681 end:
 682         if (ret == 0) {
 683                 BT_COMP_LOGD("Found message's timestamp: "
 684                         "muxer-msg-iter-addr=%p, msg-addr=%p, "
 685                         "last-returned-ts=%" PRId64 ", ts=%" PRId64,
 686                         muxer_msg_iter, msg, last_returned_ts_ns,
 687                         *ts_ns);
 688         }
 689
 690         return ret;
 691 }
 692
 693 static inline
 694 int validate_clock_class(struct muxer_msg_iter *muxer_msg_iter,
 695                 struct muxer_comp *muxer_comp,
 696                 const bt_clock_class *clock_class)
 697 {
 698         int ret = 0;
 699         const uint8_t *cc_uuid;
 700         const char *cc_name;
 701
 702         BT_ASSERT(clock_class);
 703         cc_uuid = bt_clock_class_get_uuid(clock_class);
 704         cc_name = bt_clock_class_get_name(clock_class);
 705
 706         if (muxer_msg_iter->clock_class_expectation ==
 707                         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ANY) {
 708                 /*
 709                  * This is the first clock class that this muxer
 710                  * message iterator encounters. Its properties
 711                  * determine what to expect for the whole lifetime of
 712                  * the iterator without a true
 713                  * `assume-absolute-clock-classes` parameter.
 714                  */
 715                 if (bt_clock_class_origin_is_unix_epoch(clock_class)) {
 716                         /* Expect absolute clock classes */
 717                         muxer_msg_iter->clock_class_expectation =
 718                                 MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ABSOLUTE;
 719                 } else {
 720                         if (cc_uuid) {
 721                                 /*
 722                                  * Expect non-absolute clock classes
 723                                  * with a specific UUID.
 724                                  */
 725                                 muxer_msg_iter->clock_class_expectation =
 726                                         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_SPEC_UUID;
 727                                 bt_uuid_copy(muxer_msg_iter->expected_clock_class_uuid, cc_uuid);
 728                         } else {
 729                                 /*
 730                                  * Expect non-absolute clock classes
 731                                  * with no UUID.
 732                                  */
 733                                 muxer_msg_iter->clock_class_expectation =
 734                                         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_NO_UUID;
 735                         }
 736                 }
 737         }
 738
 739         if (!muxer_comp->assume_absolute_clock_classes) {
 740                 switch (muxer_msg_iter->clock_class_expectation) {
 741                 case MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ABSOLUTE:
 742                         if (!bt_clock_class_origin_is_unix_epoch(clock_class)) {
 743                                 BT_COMP_LOGE("Expecting an absolute clock class, "
 744                                         "but got a non-absolute one: "
 745                                         "clock-class-addr=%p, clock-class-name=\"%s\"",
 746                                         clock_class, cc_name);
 747                                 goto error;
 748                         }
 749                         break;
 750                 case MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_NO_UUID:
 751                         if (bt_clock_class_origin_is_unix_epoch(clock_class)) {
 752                                 BT_COMP_LOGE("Expecting a non-absolute clock class with no UUID, "
 753                                         "but got an absolute one: "
 754                                         "clock-class-addr=%p, clock-class-name=\"%s\"",
 755                                         clock_class, cc_name);
 756                                 goto error;
 757                         }
 758
 759                         if (cc_uuid) {
 760                                 BT_COMP_LOGE("Expecting a non-absolute clock class with no UUID, "
 761                                         "but got one with a UUID: "
 762                                         "clock-class-addr=%p, clock-class-name=\"%s\", "
 763                                         "uuid=\"" BT_UUID_FMT "\"",
 764                                         clock_class, cc_name, BT_UUID_FMT_VALUES(cc_uuid));
 765                                 goto error;
 766                         }
 767                         break;
 768                 case MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NOT_ABS_SPEC_UUID:
 769                         if (bt_clock_class_origin_is_unix_epoch(clock_class)) {
 770                                 BT_COMP_LOGE("Expecting a non-absolute clock class with a specific UUID, "
 771                                         "but got an absolute one: "
 772                                         "clock-class-addr=%p, clock-class-name=\"%s\"",
 773                                         clock_class, cc_name);
 774                                 goto error;
 775                         }
 776
 777                         if (!cc_uuid) {
 778                                 BT_COMP_LOGE("Expecting a non-absolute clock class with a specific UUID, "
 779                                         "but got one with no UUID: "
 780                                         "clock-class-addr=%p, clock-class-name=\"%s\"",
 781                                         clock_class, cc_name);
 782                                 goto error;
 783                         }
 784
 785                         if (bt_uuid_compare(muxer_msg_iter->expected_clock_class_uuid, cc_uuid) != 0) {
 786                                 BT_COMP_LOGE("Expecting a non-absolute clock class with a specific UUID, "
 787                                         "but got one with different UUID: "
 788                                         "clock-class-addr=%p, clock-class-name=\"%s\", "
 789                                         "expected-uuid=\"" BT_UUID_FMT "\", "
 790                                         "uuid=\"" BT_UUID_FMT "\"",
 791                                         clock_class, cc_name,
 792                                         BT_UUID_FMT_VALUES(muxer_msg_iter->expected_clock_class_uuid),
 793                                         BT_UUID_FMT_VALUES(cc_uuid));
 794                                 goto error;
 795                         }
 796                         break;
 797                 case MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NONE:
 798                         BT_COMP_LOGE("Expecting no clock class, but got one: "
 799                                 "clock-class-addr=%p, clock-class-name=\"%s\"",
 800                                 clock_class, cc_name);
 801                         goto error;
 802                 default:
 803                         /* Unexpected */
 804                         BT_COMP_LOGF("Unexpected clock class expectation: "
 805                                 "expectation-code=%d",
 806                                 muxer_msg_iter->clock_class_expectation);
 807                         abort();
 808                 }
 809         }
 810
 811         goto end;
 812
 813 error:
 814         ret = -1;
 815
 816 end:
 817         return ret;
 818 }
 819
 820 static inline
 821 int validate_new_stream_clock_class(struct muxer_msg_iter *muxer_msg_iter,
 822                 struct muxer_comp *muxer_comp, const bt_stream *stream)
 823 {
 824         int ret = 0;
 825         const bt_stream_class *stream_class =
 826                 bt_stream_borrow_class_const(stream);
 827         const bt_clock_class *clock_class =
 828                 bt_stream_class_borrow_default_clock_class_const(stream_class);
 829
 830         if (!clock_class) {
 831                 if (muxer_msg_iter->clock_class_expectation ==
 832                         MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ANY) {
 833                         /* Expect no clock class */
 834                         muxer_msg_iter->clock_class_expectation =
 835                                 MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NONE;
 836                 } else if (muxer_msg_iter->clock_class_expectation !=
 837                                 MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_NONE) {
 838                         BT_COMP_LOGE("Expecting stream class without a default clock class: "
 839                                 "stream-class-addr=%p, stream-class-name=\"%s\", "
 840                                 "stream-class-id=%" PRIu64,
 841                                 stream_class, bt_stream_class_get_name(stream_class),
 842                                 bt_stream_class_get_id(stream_class));
 843                         ret = -1;
 844                 }
 845
 846                 goto end;
 847         }
 848
 849         ret = validate_clock_class(muxer_msg_iter, muxer_comp, clock_class);
 850
 851 end:
 852         return ret;
 853 }
 854
 855 /*
 856  * This function finds the youngest available message amongst the
 857  * non-ended upstream message iterators and returns the upstream
 858  * message iterator which has it, or
 859  * BT_MESSAGE_ITERATOR_STATUS_END if there's no available
 860  * message.
 861  *
 862  * This function does NOT:
 863  *
 864  * * Update any upstream message iterator.
 865  * * Check the upstream message iterators to retry.
 866  *
 867  * On sucess, this function sets *muxer_upstream_msg_iter to the
 868  * upstream message iterator of which the current message is
 869  * the youngest, and sets *ts_ns to its time.
 870  */
 871 static
 872 bt_component_class_message_iterator_next_method_status
 873 muxer_msg_iter_youngest_upstream_msg_iter(
 874                 struct muxer_comp *muxer_comp,
 875                 struct muxer_msg_iter *muxer_msg_iter,
 876                 struct muxer_upstream_msg_iter **muxer_upstream_msg_iter,
 877                 int64_t *ts_ns)
 878 {
 879         size_t i;
 880         int ret;
 881         int64_t youngest_ts_ns = INT64_MAX;
 882         bt_component_class_message_iterator_next_method_status status =
 883                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
 884
 885         BT_ASSERT(muxer_comp);
 886         BT_ASSERT(muxer_msg_iter);
 887         BT_ASSERT(muxer_upstream_msg_iter);
 888         *muxer_upstream_msg_iter = NULL;
 889
 890         for (i = 0; i < muxer_msg_iter->active_muxer_upstream_msg_iters->len;
 891                         i++) {
 892                 const bt_message *msg;
 893                 struct muxer_upstream_msg_iter *cur_muxer_upstream_msg_iter =
 894                         g_ptr_array_index(
 895                                 muxer_msg_iter->active_muxer_upstream_msg_iters,
 896                                 i);
 897                 int64_t msg_ts_ns;
 898
 899                 if (!cur_muxer_upstream_msg_iter->msg_iter) {
 900                         /* This upstream message iterator is ended */
 901                         BT_COMP_LOGT("Skipping ended upstream message iterator: "
 902                                 "muxer-upstream-msg-iter-wrap-addr=%p",
 903                                 cur_muxer_upstream_msg_iter);
 904                         continue;
 905                 }
 906
 907                 BT_ASSERT(cur_muxer_upstream_msg_iter->msgs->length > 0);
 908                 msg = g_queue_peek_head(cur_muxer_upstream_msg_iter->msgs);
 909                 BT_ASSERT(msg);
 910
 911                 if (G_UNLIKELY(bt_message_get_type(msg) ==
 912                                 BT_MESSAGE_TYPE_STREAM_BEGINNING)) {
 913                         ret = validate_new_stream_clock_class(
 914                                 muxer_msg_iter, muxer_comp,
 915                                 bt_message_stream_beginning_borrow_stream_const(
 916                                         msg));
 917                         if (ret) {
 918                                 /*
 919                                  * validate_new_stream_clock_class() logs
 920                                  * errors.
 921                                  */
 922                                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_ERROR;
 923                                 goto end;
 924                         }
 925                 } else if (G_UNLIKELY(bt_message_get_type(msg) ==
 926                                 BT_MESSAGE_TYPE_MESSAGE_ITERATOR_INACTIVITY)) {
 927                         const bt_clock_snapshot *cs;
 928
 929                         cs = bt_message_message_iterator_inactivity_borrow_default_clock_snapshot_const(
 930                                 msg);
 931                         ret = validate_clock_class(muxer_msg_iter, muxer_comp,
 932                                 bt_clock_snapshot_borrow_clock_class_const(cs));
 933                         if (ret) {
 934                                 /* validate_clock_class() logs errors */
 935                                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_ERROR;
 936                                 goto end;
 937                         }
 938                 }
 939
 940                 ret = get_msg_ts_ns(muxer_comp, muxer_msg_iter, msg,
 941                         muxer_msg_iter->last_returned_ts_ns, &msg_ts_ns);
 942                 if (ret) {
 943                         /* get_msg_ts_ns() logs errors */
 944                         *muxer_upstream_msg_iter = NULL;
 945                         status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_ERROR;
 946                         goto end;
 947                 }
 948
 949                 /*
 950                  * Update the current message iterator if it has not been set
 951                  * yet, or if its current message has a timestamp smaller than
 952                  * the previously selected youngest message.
 953                  */
 954                 if (G_UNLIKELY(*muxer_upstream_msg_iter == NULL) ||
 955                                 msg_ts_ns < youngest_ts_ns) {
 956                         *muxer_upstream_msg_iter =
 957                                 cur_muxer_upstream_msg_iter;
 958                         youngest_ts_ns = msg_ts_ns;
 959                         *ts_ns = youngest_ts_ns;
 960                 } else if (msg_ts_ns == youngest_ts_ns) {
 961                         /*
 962                          * The currently selected message to be sent downstream
 963                          * next has the exact same timestamp that of the
 964                          * current candidate message. We must break the tie
 965                          * in a predictable manner.
 966                          */
 967                         const bt_message *selected_msg = g_queue_peek_head(
 968                                 (*muxer_upstream_msg_iter)->msgs);
 969                         BT_COMP_LOGD_STR("Two of the next message candidates have the same timestamps, pick one deterministically.");
 970
 971                         /*
 972                          * Order the messages in an arbitrary but determinitic
 973                          * way.
 974                          */
 975                         ret = common_muxing_compare_messages(msg, selected_msg);
 976                         if (ret < 0) {
 977                                 /*
 978                                  * The `msg` should go first. Update the next
 979                                  * iterator and the current timestamp.
 980                                  */
 981                                 *muxer_upstream_msg_iter =
 982                                         cur_muxer_upstream_msg_iter;
 983                                 youngest_ts_ns = msg_ts_ns;
 984                                 *ts_ns = youngest_ts_ns;
 985                         } else if (ret == 0) {
 986                                 /* Unable to pick which one should go first. */
 987                                 BT_COMP_LOGW("Cannot deterministically pick next upstream message iterator because they have identical next messages: "
 988                                         "muxer-upstream-msg-iter-wrap-addr=%p"
 989                                         "cur-muxer-upstream-msg-iter-wrap-addr=%p",
 990                                         *muxer_upstream_msg_iter,
 991                                         cur_muxer_upstream_msg_iter);
 992                         }
 993                 }
 994         }
 995
 996         if (!*muxer_upstream_msg_iter) {
 997                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_END;
 998                 *ts_ns = INT64_MIN;
 999         }
1000
1001 end:
1002         return status;
1003 }
1004
1005 static
1006 bt_component_class_message_iterator_next_method_status
1007 validate_muxer_upstream_msg_iter(
1008         struct muxer_upstream_msg_iter *muxer_upstream_msg_iter,
1009         bool *is_ended)
1010 {
1011         struct muxer_comp *muxer_comp =
1012                 muxer_upstream_msg_iter->muxer_comp;
1013         bt_component_class_message_iterator_next_method_status status =
1014                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
1015
1016         BT_COMP_LOGD("Validating muxer's upstream message iterator wrapper: "
1017                 "muxer-upstream-msg-iter-wrap-addr=%p",
1018                 muxer_upstream_msg_iter);
1019
1020         if (muxer_upstream_msg_iter->msgs->length > 0 ||
1021                         !muxer_upstream_msg_iter->msg_iter) {
1022                 BT_COMP_LOGD("Already valid or not considered: "
1023                         "queue-len=%u, upstream-msg-iter-addr=%p",
1024                         muxer_upstream_msg_iter->msgs->length,
1025                         muxer_upstream_msg_iter->msg_iter);
1026                 goto end;
1027         }
1028
1029         /* muxer_upstream_msg_iter_next() logs details/errors */
1030         status = muxer_upstream_msg_iter_next(muxer_upstream_msg_iter,
1031                 is_ended);
1032
1033 end:
1034         return status;
1035 }
1036
1037 static
1038 bt_component_class_message_iterator_next_method_status
1039 validate_muxer_upstream_msg_iters(
1040                 struct muxer_msg_iter *muxer_msg_iter)
1041 {
1042         struct muxer_comp *muxer_comp = muxer_msg_iter->muxer_comp;
1043         bt_component_class_message_iterator_next_method_status status =
1044                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
1045         size_t i;
1046
1047         BT_COMP_LOGD("Validating muxer's upstream message iterator wrappers: "
1048                 "muxer-msg-iter-addr=%p", muxer_msg_iter);
1049
1050         for (i = 0; i < muxer_msg_iter->active_muxer_upstream_msg_iters->len;
1051                         i++) {
1052                 bool is_ended = false;
1053                 struct muxer_upstream_msg_iter *muxer_upstream_msg_iter =
1054                         g_ptr_array_index(
1055                                 muxer_msg_iter->active_muxer_upstream_msg_iters,
1056                                 i);
1057
1058                 status = validate_muxer_upstream_msg_iter(
1059                         muxer_upstream_msg_iter, &is_ended);
1060                 if (status != BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK) {
1061                         if (status < 0) {
1062                                 BT_COMP_LOGE("Cannot validate muxer's upstream message iterator wrapper: "
1063                                         "muxer-msg-iter-addr=%p, "
1064                                         "muxer-upstream-msg-iter-wrap-addr=%p",
1065                                         muxer_msg_iter,
1066                                         muxer_upstream_msg_iter);
1067                         } else {
1068                                 BT_COMP_LOGD("Cannot validate muxer's upstream message iterator wrapper: "
1069                                         "muxer-msg-iter-addr=%p, "
1070                                         "muxer-upstream-msg-iter-wrap-addr=%p",
1071                                         muxer_msg_iter,
1072                                         muxer_upstream_msg_iter);
1073                         }
1074
1075                         goto end;
1076                 }
1077
1078                 /*
1079                  * Move this muxer upstream message iterator to the
1080                  * array of ended iterators if it's ended.
1081                  */
1082                 if (G_UNLIKELY(is_ended)) {
1083                         BT_COMP_LOGD("Muxer's upstream message iterator wrapper: ended or canceled: "
1084                                 "muxer-msg-iter-addr=%p, "
1085                                 "muxer-upstream-msg-iter-wrap-addr=%p",
1086                                 muxer_msg_iter, muxer_upstream_msg_iter);
1087                         g_ptr_array_add(
1088                                 muxer_msg_iter->ended_muxer_upstream_msg_iters,
1089                                 muxer_upstream_msg_iter);
1090                         muxer_msg_iter->active_muxer_upstream_msg_iters->pdata[i] = NULL;
1091
1092                         /*
1093                          * Use g_ptr_array_remove_fast() because the
1094                          * order of those elements is not important.
1095                          */
1096                         g_ptr_array_remove_index_fast(
1097                                 muxer_msg_iter->active_muxer_upstream_msg_iters,
1098                                 i);
1099                         i--;
1100                 }
1101         }
1102
1103 end:
1104         return status;
1105 }
1106
1107 static inline
1108 bt_component_class_message_iterator_next_method_status muxer_msg_iter_do_next_one(
1109                 struct muxer_comp *muxer_comp,
1110                 struct muxer_msg_iter *muxer_msg_iter,
1111                 const bt_message **msg)
1112 {
1113         bt_component_class_message_iterator_next_method_status status;
1114         struct muxer_upstream_msg_iter *muxer_upstream_msg_iter = NULL;
1115         int64_t next_return_ts;
1116
1117         status = validate_muxer_upstream_msg_iters(muxer_msg_iter);
1118         if (status != BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK) {
1119                 /* validate_muxer_upstream_msg_iters() logs details */
1120                 goto end;
1121         }
1122
1123         /*
1124          * At this point we know that all the existing upstream
1125          * message iterators are valid. We can find the one,
1126          * amongst those, of which the current message is the
1127          * youngest.
1128          */
1129         status = muxer_msg_iter_youngest_upstream_msg_iter(muxer_comp,
1130                         muxer_msg_iter, &muxer_upstream_msg_iter,
1131                         &next_return_ts);
1132         if (status < 0 || status == BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_END) {
1133                 if (status < 0) {
1134                         BT_COMP_LOGE("Cannot find the youngest upstream message iterator wrapper: "
1135                                 "status=%s",
1136                                 bt_common_func_status_string(status));
1137                 } else {
1138                         BT_COMP_LOGD("Cannot find the youngest upstream message iterator wrapper: "
1139                                 "status=%s",
1140                                 bt_common_func_status_string(status));
1141                 }
1142
1143                 goto end;
1144         }
1145
1146         if (next_return_ts < muxer_msg_iter->last_returned_ts_ns) {
1147                 BT_COMP_LOGE("Youngest upstream message iterator wrapper's timestamp is less than muxer's message iterator's last returned timestamp: "
1148                         "muxer-msg-iter-addr=%p, ts=%" PRId64 ", "
1149                         "last-returned-ts=%" PRId64,
1150                         muxer_msg_iter, next_return_ts,
1151                         muxer_msg_iter->last_returned_ts_ns);
1152                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_ERROR;
1153                 goto end;
1154         }
1155
1156         BT_COMP_LOGD("Found youngest upstream message iterator wrapper: "
1157                 "muxer-msg-iter-addr=%p, "
1158                 "muxer-upstream-msg-iter-wrap-addr=%p, "
1159                 "ts=%" PRId64,
1160                 muxer_msg_iter, muxer_upstream_msg_iter, next_return_ts);
1161         BT_ASSERT(status == BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK);
1162         BT_ASSERT(muxer_upstream_msg_iter);
1163
1164         /*
1165          * Consume from the queue's head: other side
1166          * (muxer_upstream_msg_iter_next()) writes to the tail.
1167          */
1168         *msg = g_queue_pop_head(muxer_upstream_msg_iter->msgs);
1169         BT_ASSERT(*msg);
1170         muxer_msg_iter->last_returned_ts_ns = next_return_ts;
1171
1172 end:
1173         return status;
1174 }
1175
1176 static
1177 bt_component_class_message_iterator_next_method_status muxer_msg_iter_do_next(
1178                 struct muxer_comp *muxer_comp,
1179                 struct muxer_msg_iter *muxer_msg_iter,
1180                 bt_message_array_const msgs, uint64_t capacity,
1181                 uint64_t *count)
1182 {
1183         bt_component_class_message_iterator_next_method_status status =
1184                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
1185         uint64_t i = 0;
1186
1187         while (i < capacity && status == BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK) {
1188                 status = muxer_msg_iter_do_next_one(muxer_comp,
1189                         muxer_msg_iter, &msgs[i]);
1190                 if (status == BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK) {
1191                         i++;
1192                 }
1193         }
1194
1195         if (i > 0) {
1196                 /*
1197                  * Even if muxer_msg_iter_do_next_one() returned
1198                  * something else than
1199                  * BT_MESSAGE_ITERATOR_STATUS_OK, we accumulated
1200                  * message objects in the output message
1201                  * array, so we need to return
1202                  * BT_MESSAGE_ITERATOR_STATUS_OK so that they are
1203                  * transfered to downstream. This other status occurs
1204                  * again the next time muxer_msg_iter_do_next() is
1205                  * called, possibly without any accumulated
1206                  * message, in which case we'll return it.
1207                  */
1208                 *count = i;
1209                 status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_NEXT_METHOD_STATUS_OK;
1210         }
1211
1212         return status;
1213 }
1214
1215 static
1216 void destroy_muxer_msg_iter(struct muxer_msg_iter *muxer_msg_iter)
1217 {
1218         struct muxer_comp *muxer_comp;
1219
1220         if (!muxer_msg_iter) {
1221                 return;
1222         }
1223
1224         muxer_comp = muxer_msg_iter->muxer_comp;
1225         BT_COMP_LOGD("Destroying muxer component's message iterator: "
1226                 "muxer-msg-iter-addr=%p", muxer_msg_iter);
1227
1228         if (muxer_msg_iter->active_muxer_upstream_msg_iters) {
1229                 BT_COMP_LOGD_STR("Destroying muxer's active upstream message iterator wrappers.");
1230                 g_ptr_array_free(
1231                         muxer_msg_iter->active_muxer_upstream_msg_iters, TRUE);
1232         }
1233
1234         if (muxer_msg_iter->ended_muxer_upstream_msg_iters) {
1235                 BT_COMP_LOGD_STR("Destroying muxer's ended upstream message iterator wrappers.");
1236                 g_ptr_array_free(
1237                         muxer_msg_iter->ended_muxer_upstream_msg_iters, TRUE);
1238         }
1239
1240         g_free(muxer_msg_iter);
1241 }
1242
1243 static
1244 int muxer_msg_iter_init_upstream_iterators(struct muxer_comp *muxer_comp,
1245                 struct muxer_msg_iter *muxer_msg_iter)
1246 {
1247         int64_t count;
1248         int64_t i;
1249         int ret = 0;
1250
1251         count = bt_component_filter_get_input_port_count(
1252                 bt_self_component_filter_as_component_filter(
1253                         muxer_comp->self_comp_flt));
1254         if (count < 0) {
1255                 BT_COMP_LOGD("No input port to initialize for muxer component's message iterator: "
1256                         "muxer-comp-addr=%p, muxer-msg-iter-addr=%p",
1257                         muxer_comp, muxer_msg_iter);
1258                 goto end;
1259         }
1260
1261         for (i = 0; i < count; i++) {
1262                 bt_self_component_port_input_message_iterator *upstream_msg_iter;
1263                 bt_self_component_port_input *self_port =
1264                         bt_self_component_filter_borrow_input_port_by_index(
1265                                 muxer_comp->self_comp_flt, i);
1266                 const bt_port *port;
1267
1268                 BT_ASSERT(self_port);
1269                 port = bt_self_component_port_as_port(
1270                         bt_self_component_port_input_as_self_component_port(
1271                                 self_port));
1272                 BT_ASSERT(port);
1273
1274                 if (!bt_port_is_connected(port)) {
1275                         /* Skip non-connected port */
1276                         continue;
1277                 }
1278
1279                 upstream_msg_iter = create_msg_iter_on_input_port(muxer_comp,
1280                         muxer_msg_iter, self_port);
1281                 if (!upstream_msg_iter) {
1282                         /* create_msg_iter_on_input_port() logs errors */
1283                         BT_ASSERT(!upstream_msg_iter);
1284                         ret = -1;
1285                         goto end;
1286                 }
1287
1288                 ret = muxer_msg_iter_add_upstream_msg_iter(muxer_msg_iter,
1289                         upstream_msg_iter);
1290                 bt_self_component_port_input_message_iterator_put_ref(
1291                         upstream_msg_iter);
1292                 if (ret) {
1293                         /* muxer_msg_iter_add_upstream_msg_iter() logs errors */
1294                         goto end;
1295                 }
1296         }
1297
1298 end:
1299         return ret;
1300 }
1301
1302 BT_HIDDEN
1303 bt_component_class_message_iterator_init_method_status muxer_msg_iter_init(
1304                 bt_self_message_iterator *self_msg_iter,
1305                 bt_self_component_filter *self_comp,
1306                 bt_self_component_port_output *port)
1307 {
1308         struct muxer_comp *muxer_comp = NULL;
1309         struct muxer_msg_iter *muxer_msg_iter = NULL;
1310         bt_component_class_message_iterator_init_method_status status =
1311                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_INIT_METHOD_STATUS_OK;
1312         int ret;
1313
1314         muxer_comp = bt_self_component_get_data(
1315                 bt_self_component_filter_as_self_component(self_comp));
1316         BT_ASSERT(muxer_comp);
1317         BT_COMP_LOGD("Initializing muxer component's message iterator: "
1318                 "comp-addr=%p, muxer-comp-addr=%p, msg-iter-addr=%p",
1319                 self_comp, muxer_comp, self_msg_iter);
1320
1321         if (muxer_comp->initializing_muxer_msg_iter) {
1322                 /*
1323                  * Weird, unhandled situation detected: downstream
1324                  * creates a muxer message iterator while creating
1325                  * another muxer message iterator (same component).
1326                  */
1327                 BT_COMP_LOGE("Recursive initialization of muxer component's message iterator: "
1328                         "comp-addr=%p, muxer-comp-addr=%p, msg-iter-addr=%p",
1329                         self_comp, muxer_comp, self_msg_iter);
1330                 goto error;
1331         }
1332
1333         muxer_comp->initializing_muxer_msg_iter = true;
1334         muxer_msg_iter = g_new0(struct muxer_msg_iter, 1);
1335         if (!muxer_msg_iter) {
1336                 BT_COMP_LOGE_STR("Failed to allocate one muxer component's message iterator.");
1337                 goto error;
1338         }
1339
1340         muxer_msg_iter->muxer_comp = muxer_comp;
1341         muxer_msg_iter->self_msg_iter = self_msg_iter;
1342         muxer_msg_iter->last_returned_ts_ns = INT64_MIN;
1343         muxer_msg_iter->active_muxer_upstream_msg_iters =
1344                 g_ptr_array_new_with_free_func(
1345                         (GDestroyNotify) destroy_muxer_upstream_msg_iter);
1346         if (!muxer_msg_iter->active_muxer_upstream_msg_iters) {
1347                 BT_COMP_LOGE_STR("Failed to allocate a GPtrArray.");
1348                 goto error;
1349         }
1350
1351         muxer_msg_iter->ended_muxer_upstream_msg_iters =
1352                 g_ptr_array_new_with_free_func(
1353                         (GDestroyNotify) destroy_muxer_upstream_msg_iter);
1354         if (!muxer_msg_iter->ended_muxer_upstream_msg_iters) {
1355                 BT_COMP_LOGE_STR("Failed to allocate a GPtrArray.");
1356                 goto error;
1357         }
1358
1359         ret = muxer_msg_iter_init_upstream_iterators(muxer_comp,
1360                 muxer_msg_iter);
1361         if (ret) {
1362                 BT_COMP_LOGE("Cannot initialize connected input ports for muxer component's message iterator: "
1363                         "comp-addr=%p, muxer-comp-addr=%p, "
1364                         "muxer-msg-iter-addr=%p, msg-iter-addr=%p, ret=%d",
1365                         self_comp, muxer_comp, muxer_msg_iter,
1366                         self_msg_iter, ret);
1367                 goto error;
1368         }
1369
1370         bt_self_message_iterator_set_data(self_msg_iter, muxer_msg_iter);
1371         BT_COMP_LOGD("Initialized muxer component's message iterator: "
1372                 "comp-addr=%p, muxer-comp-addr=%p, muxer-msg-iter-addr=%p, "
1373                 "msg-iter-addr=%p",
1374                 self_comp, muxer_comp, muxer_msg_iter, self_msg_iter);
1375         goto end;
1376
1377 error:
1378         destroy_muxer_msg_iter(muxer_msg_iter);
1379         bt_self_message_iterator_set_data(self_msg_iter, NULL);
1380         status = BT_COMPONENT_CLASS_MESSAGE_ITERATOR_INIT_METHOD_STATUS_ERROR;
1381
1382 end:
1383         muxer_comp->initializing_muxer_msg_iter = false;
1384         return status;
1385 }
1386
1387 BT_HIDDEN
1388 void muxer_msg_iter_finalize(bt_self_message_iterator *self_msg_iter)
1389 {
1390         struct muxer_msg_iter *muxer_msg_iter =
1391                 bt_self_message_iterator_get_data(self_msg_iter);
1392         bt_self_component *self_comp = NULL;
1393         struct muxer_comp *muxer_comp = NULL;
1394
1395         self_comp = bt_self_message_iterator_borrow_component(
1396                 self_msg_iter);
1397         BT_ASSERT(self_comp);
1398         muxer_comp = bt_self_component_get_data(self_comp);
1399         BT_COMP_LOGD("Finalizing muxer component's message iterator: "
1400                 "comp-addr=%p, muxer-comp-addr=%p, muxer-msg-iter-addr=%p, "
1401                 "msg-iter-addr=%p",
1402                 self_comp, muxer_comp, muxer_msg_iter, self_msg_iter);
1403
1404         if (muxer_msg_iter) {
1405                 destroy_muxer_msg_iter(muxer_msg_iter);
1406         }
1407 }
1408
1409 BT_HIDDEN
1410 bt_component_class_message_iterator_next_method_status muxer_msg_iter_next(
1411                 bt_self_message_iterator *self_msg_iter,
1412                 bt_message_array_const msgs, uint64_t capacity,
1413                 uint64_t *count)
1414 {
1415         bt_component_class_message_iterator_next_method_status status;
1416         struct muxer_msg_iter *muxer_msg_iter =
1417                 bt_self_message_iterator_get_data(self_msg_iter);
1418         bt_self_component *self_comp = NULL;
1419         struct muxer_comp *muxer_comp = NULL;
1420
1421         BT_ASSERT(muxer_msg_iter);
1422         self_comp = bt_self_message_iterator_borrow_component(
1423                 self_msg_iter);
1424         BT_ASSERT(self_comp);
1425         muxer_comp = bt_self_component_get_data(self_comp);
1426         BT_ASSERT(muxer_comp);
1427         BT_COMP_LOGT("Muxer component's message iterator's \"next\" method called: "
1428                 "comp-addr=%p, muxer-comp-addr=%p, muxer-msg-iter-addr=%p, "
1429                 "msg-iter-addr=%p",
1430                 self_comp, muxer_comp, muxer_msg_iter, self_msg_iter);
1431
1432         status = muxer_msg_iter_do_next(muxer_comp, muxer_msg_iter,
1433                 msgs, capacity, count);
1434         if (status < 0) {
1435                 BT_COMP_LOGE("Cannot get next message: "
1436                         "comp-addr=%p, muxer-comp-addr=%p, muxer-msg-iter-addr=%p, "
1437                         "msg-iter-addr=%p, status=%s",
1438                         self_comp, muxer_comp, muxer_msg_iter, self_msg_iter,
1439                         bt_common_func_status_string(status));
1440         } else {
1441                 BT_COMP_LOGT("Returning from muxer component's message iterator's \"next\" method: "
1442                         "status=%s",
1443                         bt_common_func_status_string(status));
1444         }
1445
1446         return status;
1447 }
1448
1449 BT_HIDDEN
1450 bt_component_class_port_connected_method_status muxer_input_port_connected(
1451                 bt_self_component_filter *self_comp,
1452                 bt_self_component_port_input *self_port,
1453                 const bt_port_output *other_port)
1454 {
1455         bt_component_class_port_connected_method_status status =
1456                 BT_COMPONENT_CLASS_PORT_CONNECTED_METHOD_STATUS_OK;
1457         bt_self_component_add_port_status add_port_status;
1458         struct muxer_comp *muxer_comp = bt_self_component_get_data(
1459                 bt_self_component_filter_as_self_component(self_comp));
1460
1461         add_port_status = add_available_input_port(self_comp);
1462         if (add_port_status) {
1463                 BT_COMP_LOGE("Cannot add one muxer component's input port: "
1464                         "status=%s",
1465                         bt_common_func_status_string(status));
1466
1467                 if (add_port_status ==
1468                                 BT_SELF_COMPONENT_ADD_PORT_STATUS_MEMORY_ERROR) {
1469                         status = BT_COMPONENT_CLASS_PORT_CONNECTED_METHOD_STATUS_MEMORY_ERROR;
1470                 } else {
1471                         status = BT_COMPONENT_CLASS_PORT_CONNECTED_METHOD_STATUS_ERROR;
1472                 }
1473
1474                 goto end;
1475         }
1476
1477 end:
1478         return status;
1479 }
1480
1481 static inline
1482 bt_bool muxer_upstream_msg_iters_can_all_seek_beginning(
1483                 GPtrArray *muxer_upstream_msg_iters)
1484 {
1485         uint64_t i;
1486         bt_bool ret = BT_TRUE;
1487
1488         for (i = 0; i < muxer_upstream_msg_iters->len; i++) {
1489                 struct muxer_upstream_msg_iter *upstream_msg_iter =
1490                         muxer_upstream_msg_iters->pdata[i];
1491
1492                 if (!bt_self_component_port_input_message_iterator_can_seek_beginning(
1493                                 upstream_msg_iter->msg_iter)) {
1494                         ret = BT_FALSE;
1495                         goto end;
1496                 }
1497         }
1498
1499 end:
1500         return ret;
1501 }
1502
1503 BT_HIDDEN
1504 bt_bool muxer_msg_iter_can_seek_beginning(
1505                 bt_self_message_iterator *self_msg_iter)
1506 {
1507         struct muxer_msg_iter *muxer_msg_iter =
1508                 bt_self_message_iterator_get_data(self_msg_iter);
1509         bt_bool ret = BT_TRUE;
1510
1511         if (!muxer_upstream_msg_iters_can_all_seek_beginning(
1512                         muxer_msg_iter->active_muxer_upstream_msg_iters)) {
1513                 ret = BT_FALSE;
1514                 goto end;
1515         }
1516
1517         if (!muxer_upstream_msg_iters_can_all_seek_beginning(
1518                         muxer_msg_iter->ended_muxer_upstream_msg_iters)) {
1519                 ret = BT_FALSE;
1520                 goto end;
1521         }
1522
1523 end:
1524         return ret;
1525 }
1526
1527 BT_HIDDEN
1528 bt_component_class_message_iterator_seek_beginning_method_status muxer_msg_iter_seek_beginning(
1529                 bt_self_message_iterator *self_msg_iter)
1530 {
1531         struct muxer_msg_iter *muxer_msg_iter =
1532                 bt_self_message_iterator_get_data(self_msg_iter);
1533         bt_component_class_message_iterator_seek_beginning_method_status status =
1534                 BT_COMPONENT_CLASS_MESSAGE_ITERATOR_SEEK_BEGINNING_METHOD_STATUS_OK;
1535         bt_message_iterator_seek_beginning_status seek_beg_status;
1536         uint64_t i;
1537
1538         /* Seek all ended upstream iterators first */
1539         for (i = 0; i < muxer_msg_iter->ended_muxer_upstream_msg_iters->len;
1540                         i++) {
1541                 struct muxer_upstream_msg_iter *upstream_msg_iter =
1542                         muxer_msg_iter->ended_muxer_upstream_msg_iters->pdata[i];
1543
1544                 seek_beg_status = bt_self_component_port_input_message_iterator_seek_beginning(
1545                         upstream_msg_iter->msg_iter);
1546                 if (seek_beg_status != BT_MESSAGE_ITERATOR_SEEK_BEGINNING_STATUS_OK) {
1547                         status = (int) seek_beg_status;
1548                         goto end;
1549                 }
1550
1551                 empty_message_queue(upstream_msg_iter);
1552         }
1553
1554         /* Seek all previously active upstream iterators */
1555         for (i = 0; i < muxer_msg_iter->active_muxer_upstream_msg_iters->len;
1556                         i++) {
1557                 struct muxer_upstream_msg_iter *upstream_msg_iter =
1558                         muxer_msg_iter->active_muxer_upstream_msg_iters->pdata[i];
1559
1560                 seek_beg_status = bt_self_component_port_input_message_iterator_seek_beginning(
1561                         upstream_msg_iter->msg_iter);
1562                 if (seek_beg_status != BT_MESSAGE_ITERATOR_SEEK_BEGINNING_STATUS_OK) {
1563                         status = (int) seek_beg_status;
1564                         goto end;
1565                 }
1566
1567                 empty_message_queue(upstream_msg_iter);
1568         }
1569
1570         /* Make them all active */
1571         for (i = 0; i < muxer_msg_iter->ended_muxer_upstream_msg_iters->len;
1572                         i++) {
1573                 struct muxer_upstream_msg_iter *upstream_msg_iter =
1574                         muxer_msg_iter->ended_muxer_upstream_msg_iters->pdata[i];
1575
1576                 g_ptr_array_add(muxer_msg_iter->active_muxer_upstream_msg_iters,
1577                         upstream_msg_iter);
1578                 muxer_msg_iter->ended_muxer_upstream_msg_iters->pdata[i] = NULL;
1579         }
1580
1581         /*
1582          * GLib < 2.48.0 asserts when g_ptr_array_remove_range() is
1583          * called on an empty array.
1584          */
1585         if (muxer_msg_iter->ended_muxer_upstream_msg_iters->len > 0) {
1586                 g_ptr_array_remove_range(muxer_msg_iter->ended_muxer_upstream_msg_iters,
1587                         0, muxer_msg_iter->ended_muxer_upstream_msg_iters->len);
1588         }
1589         muxer_msg_iter->last_returned_ts_ns = INT64_MIN;
1590         muxer_msg_iter->clock_class_expectation =
1591                 MUXER_MSG_ITER_CLOCK_CLASS_EXPECTATION_ANY;
1592
1593 end:
1594         return status;
1595 }