packet_arrival_map.cc (5853B)
1 /* 2 * Copyright (c) 2021 The WebRTC project authors. All Rights Reserved. 3 * 4 * Use of this source code is governed by a BSD-style license 5 * that can be found in the LICENSE file in the root of the source 6 * tree. An additional intellectual property rights grant can be found 7 * in the file PATENTS. All contributing project authors may 8 * be found in the AUTHORS file in the root of the source tree. 9 */ 10 #include "modules/remote_bitrate_estimator/packet_arrival_map.h" 11 12 #include <algorithm> 13 #include <cstdint> 14 15 #include "api/units/timestamp.h" 16 #include "rtc_base/checks.h" 17 18 namespace webrtc { 19 20 void PacketArrivalTimeMap::AddPacket(int64_t sequence_number, 21 Timestamp arrival_time) { 22 RTC_DCHECK_GE(arrival_time, Timestamp::Zero()); 23 if (!has_seen_packet()) { 24 // First packet. 25 Reallocate(kMinCapacity); 26 begin_sequence_number_ = sequence_number; 27 end_sequence_number_ = sequence_number + 1; 28 arrival_times_[Index(sequence_number)] = arrival_time; 29 return; 30 } 31 32 if (sequence_number >= begin_sequence_number() && 33 sequence_number < end_sequence_number()) { 34 // The packet is within the buffer - no need to expand it. 35 arrival_times_[Index(sequence_number)] = arrival_time; 36 return; 37 } 38 39 if (sequence_number < begin_sequence_number()) { 40 // The packet goes before the current buffer. Expand to add packet, but only 41 // if it fits within kMaxNumberOfPackets. 42 int64_t new_size = end_sequence_number() - sequence_number; 43 if (new_size > kMaxNumberOfPackets) { 44 // Don't expand the buffer further, as that would remove newly received 45 // packets. 46 return; 47 } 48 AdjustToSize(new_size); 49 50 arrival_times_[Index(sequence_number)] = arrival_time; 51 SetNotReceived(sequence_number + 1, begin_sequence_number_); 52 begin_sequence_number_ = sequence_number; 53 return; 54 } 55 56 // The packet goes after the buffer. 57 RTC_DCHECK_GE(sequence_number, end_sequence_number_); 58 int64_t new_end_sequence_number = sequence_number + 1; 59 60 if (new_end_sequence_number >= end_sequence_number_ + kMaxNumberOfPackets) { 61 // All old packets have to be removed. 62 begin_sequence_number_ = sequence_number; 63 end_sequence_number_ = new_end_sequence_number; 64 arrival_times_[Index(sequence_number)] = arrival_time; 65 return; 66 } 67 68 if (begin_sequence_number_ < new_end_sequence_number - kMaxNumberOfPackets) { 69 // Remove oldest entries 70 begin_sequence_number_ = new_end_sequence_number - kMaxNumberOfPackets; 71 RTC_DCHECK_GT(end_sequence_number_, begin_sequence_number_); 72 } 73 74 AdjustToSize(new_end_sequence_number - begin_sequence_number_); 75 76 // Packets can be received out-of-order. If this isn't the next expected 77 // packet, add enough placeholders to fill the gap. 78 SetNotReceived(end_sequence_number_, sequence_number); 79 end_sequence_number_ = new_end_sequence_number; 80 arrival_times_[Index(sequence_number)] = arrival_time; 81 } 82 83 void PacketArrivalTimeMap::SetNotReceived( 84 int64_t begin_sequence_number_inclusive, 85 int64_t end_sequence_number_exclusive) { 86 static constexpr Timestamp value = Timestamp::MinusInfinity(); 87 88 int begin_index = Index(begin_sequence_number_inclusive); 89 int end_index = Index(end_sequence_number_exclusive); 90 91 if (begin_index <= end_index) { 92 // Entries to clear are in single block: 93 // [......{-----}....] 94 std::fill(arrival_times_.get() + begin_index, 95 arrival_times_.get() + end_index, value); 96 } else { 97 // Entries to clear span across arrival_times_ border: 98 // [--}..........{---] 99 std::fill(arrival_times_.get() + begin_index, 100 arrival_times_.get() + capacity(), value); 101 std::fill(arrival_times_.get(), arrival_times_.get() + end_index, value); 102 } 103 } 104 105 void PacketArrivalTimeMap::RemoveOldPackets(int64_t sequence_number, 106 Timestamp arrival_time_limit) { 107 int64_t check_to = std::min(sequence_number, end_sequence_number_); 108 while (begin_sequence_number_ < check_to && 109 arrival_times_[Index(begin_sequence_number_)] <= arrival_time_limit) { 110 ++begin_sequence_number_; 111 } 112 AdjustToSize(end_sequence_number_ - begin_sequence_number_); 113 } 114 115 void PacketArrivalTimeMap::EraseTo(int64_t sequence_number) { 116 if (sequence_number < begin_sequence_number_) { 117 return; 118 } 119 if (sequence_number >= end_sequence_number_) { 120 // Erase all. 121 begin_sequence_number_ = end_sequence_number_; 122 return; 123 } 124 // Remove some. 125 begin_sequence_number_ = sequence_number; 126 AdjustToSize(end_sequence_number_ - begin_sequence_number_); 127 } 128 129 void PacketArrivalTimeMap::AdjustToSize(int new_size) { 130 if (new_size > capacity()) { 131 int new_capacity = capacity(); 132 while (new_capacity < new_size) 133 new_capacity *= 2; 134 Reallocate(new_capacity); 135 } 136 if (capacity() > std::max(kMinCapacity, 4 * new_size)) { 137 int new_capacity = capacity(); 138 while (new_capacity > 2 * std::max(new_size, kMinCapacity)) { 139 new_capacity /= 2; 140 } 141 Reallocate(new_capacity); 142 } 143 RTC_DCHECK_LE(new_size, capacity()); 144 } 145 146 void PacketArrivalTimeMap::Reallocate(int new_capacity) { 147 int new_capacity_minus_1 = new_capacity - 1; 148 // Check capacity is a power of 2. 149 RTC_DCHECK_EQ(new_capacity & new_capacity_minus_1, 0); 150 // Create uninitialized memory. 151 // All valid entries should be set by `AddPacket` before use. 152 void* raw = operator new[](new_capacity * sizeof(Timestamp)); 153 Timestamp* new_buffer = static_cast<Timestamp*>(raw); 154 155 for (int64_t sequence_number = begin_sequence_number_; 156 sequence_number < end_sequence_number_; ++sequence_number) { 157 new_buffer[sequence_number & new_capacity_minus_1] = 158 arrival_times_[sequence_number & capacity_minus_1_]; 159 } 160 arrival_times_.reset(new_buffer); 161 capacity_minus_1_ = new_capacity_minus_1; 162 } 163 164 } // namespace webrtc