blob: bd5a4c25a460d2caf9c3a0a5c6cbe4c49bf33231 [file] [log] [blame]
danilchap1edb7ab2016-04-20 05:25:10 -07001/*
2 * Copyright (c) 2016 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
Mirko Bonadei92ea95e2017-09-15 06:47:31 +020011#include "modules/rtp_rtcp/source/rtp_packet.h"
danilchap1edb7ab2016-04-20 05:25:10 -070012
Yves Gerey988cc082018-10-23 12:03:01 +020013#include <cstdint>
danilchap1edb7ab2016-04-20 05:25:10 -070014#include <cstring>
Danil Chapovalova64a2fb2016-09-12 11:41:35 +020015#include <utility>
danilchap1edb7ab2016-04-20 05:25:10 -070016
Mirko Bonadei92ea95e2017-09-15 06:47:31 +020017#include "modules/rtp_rtcp/source/byte_io.h"
18#include "rtc_base/checks.h"
19#include "rtc_base/logging.h"
Karl Wiberge40468b2017-11-22 10:42:26 +010020#include "rtc_base/numerics/safe_conversions.h"
danilchap1edb7ab2016-04-20 05:25:10 -070021
22namespace webrtc {
danilchap1edb7ab2016-04-20 05:25:10 -070023namespace {
24constexpr size_t kFixedHeaderSize = 12;
25constexpr uint8_t kRtpVersion = 2;
Johannes Kron07ba2b92018-09-26 13:33:35 +020026constexpr uint16_t kOneByteExtensionProfileId = 0xBEDE;
27constexpr uint16_t kTwoByteExtensionProfileId = 0x1000;
28constexpr size_t kOneByteExtensionHeaderLength = 1;
29constexpr size_t kTwoByteExtensionHeaderLength = 2;
danilchap1edb7ab2016-04-20 05:25:10 -070030constexpr size_t kDefaultPacketSize = 1500;
31} // namespace
danilchap653063f2017-04-03 06:16:30 -070032
danilchap1edb7ab2016-04-20 05:25:10 -070033// 0 1 2 3
34// 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
35// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
36// |V=2|P|X| CC |M| PT | sequence number |
37// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
38// | timestamp |
39// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
40// | synchronization source (SSRC) identifier |
41// +=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+
42// | Contributing source (CSRC) identifiers |
43// | .... |
44// +=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+
Johannes Kron07ba2b92018-09-26 13:33:35 +020045// | header eXtension profile id | length in 32bits |
danilchap1edb7ab2016-04-20 05:25:10 -070046// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
47// | Extensions |
48// | .... |
49// +=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+
50// | Payload |
51// | .... : padding... |
52// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
53// | padding | Padding size |
54// +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
Danil Chapovalov8769e172017-09-14 14:08:22 +020055RtpPacket::RtpPacket() : RtpPacket(nullptr, kDefaultPacketSize) {}
danilchap70f39a32016-12-16 05:48:18 -080056
Danil Chapovalov8769e172017-09-14 14:08:22 +020057RtpPacket::RtpPacket(const ExtensionManager* extensions)
58 : RtpPacket(extensions, kDefaultPacketSize) {}
danilchap1edb7ab2016-04-20 05:25:10 -070059
Danil Chapovalov8769e172017-09-14 14:08:22 +020060RtpPacket::RtpPacket(const RtpPacket&) = default;
nisse76e62b02017-05-31 02:24:52 -070061
Danil Chapovalov8769e172017-09-14 14:08:22 +020062RtpPacket::RtpPacket(const ExtensionManager* extensions, size_t capacity)
Johannes Kron3dd473b2018-10-29 14:42:36 +010063 : extensions_(extensions ? *extensions : ExtensionManager()),
64 buffer_(capacity) {
danilchap1edb7ab2016-04-20 05:25:10 -070065 RTC_DCHECK_GE(capacity, kFixedHeaderSize);
66 Clear();
67}
68
Danil Chapovalov8769e172017-09-14 14:08:22 +020069RtpPacket::~RtpPacket() {}
danilchap1edb7ab2016-04-20 05:25:10 -070070
Danil Chapovalov8769e172017-09-14 14:08:22 +020071void RtpPacket::IdentifyExtensions(const ExtensionManager& extensions) {
Johannes Kronc5744b82018-09-24 14:50:48 +020072 extensions_ = extensions;
danilchap1edb7ab2016-04-20 05:25:10 -070073}
74
Danil Chapovalov8769e172017-09-14 14:08:22 +020075bool RtpPacket::Parse(const uint8_t* buffer, size_t buffer_size) {
danilchap1edb7ab2016-04-20 05:25:10 -070076 if (!ParseBuffer(buffer, buffer_size)) {
77 Clear();
78 return false;
79 }
danilchap1edb7ab2016-04-20 05:25:10 -070080 buffer_.SetData(buffer, buffer_size);
Danil Chapovalov31e4e802016-08-03 18:27:40 +020081 RTC_DCHECK_EQ(size(), buffer_size);
danilchap1edb7ab2016-04-20 05:25:10 -070082 return true;
83}
84
Danil Chapovalov8769e172017-09-14 14:08:22 +020085bool RtpPacket::Parse(rtc::ArrayView<const uint8_t> packet) {
brandtrb29e6522016-12-21 06:37:18 -080086 return Parse(packet.data(), packet.size());
87}
88
Danil Chapovalov8769e172017-09-14 14:08:22 +020089bool RtpPacket::Parse(rtc::CopyOnWriteBuffer buffer) {
Danil Chapovalov31e4e802016-08-03 18:27:40 +020090 if (!ParseBuffer(buffer.cdata(), buffer.size())) {
danilchap1edb7ab2016-04-20 05:25:10 -070091 Clear();
92 return false;
93 }
Danil Chapovalov31e4e802016-08-03 18:27:40 +020094 size_t buffer_size = buffer.size();
danilchap1edb7ab2016-04-20 05:25:10 -070095 buffer_ = std::move(buffer);
Danil Chapovalov31e4e802016-08-03 18:27:40 +020096 RTC_DCHECK_EQ(size(), buffer_size);
danilchap1edb7ab2016-04-20 05:25:10 -070097 return true;
98}
99
Danil Chapovalov8769e172017-09-14 14:08:22 +0200100std::vector<uint32_t> RtpPacket::Csrcs() const {
danilchap1edb7ab2016-04-20 05:25:10 -0700101 size_t num_csrc = data()[0] & 0x0F;
102 RTC_DCHECK_GE(capacity(), kFixedHeaderSize + num_csrc * 4);
103 std::vector<uint32_t> csrcs(num_csrc);
104 for (size_t i = 0; i < num_csrc; ++i) {
105 csrcs[i] =
106 ByteReader<uint32_t>::ReadBigEndian(&data()[kFixedHeaderSize + i * 4]);
107 }
108 return csrcs;
109}
110
Danil Chapovalov8769e172017-09-14 14:08:22 +0200111void RtpPacket::CopyHeaderFrom(const RtpPacket& packet) {
danilchap1edb7ab2016-04-20 05:25:10 -0700112 RTC_DCHECK_GE(capacity(), packet.headers_size());
113
114 marker_ = packet.marker_;
115 payload_type_ = packet.payload_type_;
116 sequence_number_ = packet.sequence_number_;
117 timestamp_ = packet.timestamp_;
118 ssrc_ = packet.ssrc_;
119 payload_offset_ = packet.payload_offset_;
Johannes Kronc5744b82018-09-24 14:50:48 +0200120 extensions_ = packet.extensions_;
121 extension_entries_ = packet.extension_entries_;
danilchap1edb7ab2016-04-20 05:25:10 -0700122 extensions_size_ = packet.extensions_size_;
123 buffer_.SetData(packet.data(), packet.headers_size());
124 // Reset payload and padding.
125 payload_size_ = 0;
126 padding_size_ = 0;
127}
128
Danil Chapovalov8769e172017-09-14 14:08:22 +0200129void RtpPacket::SetMarker(bool marker_bit) {
danilchap1edb7ab2016-04-20 05:25:10 -0700130 marker_ = marker_bit;
131 if (marker_) {
132 WriteAt(1, data()[1] | 0x80);
133 } else {
134 WriteAt(1, data()[1] & 0x7F);
135 }
136}
137
Danil Chapovalov8769e172017-09-14 14:08:22 +0200138void RtpPacket::SetPayloadType(uint8_t payload_type) {
danilchap1edb7ab2016-04-20 05:25:10 -0700139 RTC_DCHECK_LE(payload_type, 0x7Fu);
140 payload_type_ = payload_type;
141 WriteAt(1, (data()[1] & 0x80) | payload_type);
142}
143
Danil Chapovalov8769e172017-09-14 14:08:22 +0200144void RtpPacket::SetSequenceNumber(uint16_t seq_no) {
danilchap1edb7ab2016-04-20 05:25:10 -0700145 sequence_number_ = seq_no;
146 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(2), seq_no);
147}
148
Danil Chapovalov8769e172017-09-14 14:08:22 +0200149void RtpPacket::SetTimestamp(uint32_t timestamp) {
danilchap1edb7ab2016-04-20 05:25:10 -0700150 timestamp_ = timestamp;
151 ByteWriter<uint32_t>::WriteBigEndian(WriteAt(4), timestamp);
152}
153
Danil Chapovalov8769e172017-09-14 14:08:22 +0200154void RtpPacket::SetSsrc(uint32_t ssrc) {
danilchap1edb7ab2016-04-20 05:25:10 -0700155 ssrc_ = ssrc;
156 ByteWriter<uint32_t>::WriteBigEndian(WriteAt(8), ssrc);
157}
158
Ilya Nikolaevskiy2d821c32019-06-26 14:39:36 +0200159void RtpPacket::CopyAndZeroMutableExtensions(
160 rtc::ArrayView<uint8_t> buffer) const {
161 RTC_CHECK_GE(buffer.size(), buffer_.size());
162 memcpy(buffer.data(), buffer_.cdata(), buffer_.size());
163 for (const ExtensionInfo& extension : extension_entries_) {
164 switch (extensions_.GetType(extension.id)) {
165 case RTPExtensionType::kRtpExtensionNone: {
166 RTC_LOG(LS_WARNING) << "Unidentified extension in the packet.";
167 break;
168 }
169 case RTPExtensionType::kRtpExtensionVideoTiming: {
170 // Nullify 3 last entries: packetization delay and 2 network timestamps.
171 // Each of them is 2 bytes.
172 memset(buffer.data() + extension.offset +
173 VideoSendTiming::kPacerExitDeltaOffset,
174 0, 6);
175 break;
176 }
177 case RTPExtensionType::kRtpExtensionTransportSequenceNumber:
178 case RTPExtensionType::kRtpExtensionTransportSequenceNumber02:
179 case RTPExtensionType::kRtpExtensionTransmissionTimeOffset:
180 case RTPExtensionType::kRtpExtensionAbsoluteSendTime: {
181 // Nullify whole extension, as it's filled in the pacer.
182 memset(buffer.data() + extension.offset, 0, extension.length);
183 break;
184 }
185 case RTPExtensionType::kRtpExtensionAudioLevel:
186 case RTPExtensionType::kRtpExtensionColorSpace:
187 case RTPExtensionType::kRtpExtensionFrameMarking:
188 case RTPExtensionType::kRtpExtensionGenericFrameDescriptor00:
189 case RTPExtensionType::kRtpExtensionGenericFrameDescriptor01:
Danil Chapovalov52e52422019-06-27 16:45:40 +0200190 case RTPExtensionType::kRtpExtensionGenericFrameDescriptor02:
Ilya Nikolaevskiy2d821c32019-06-26 14:39:36 +0200191 case RTPExtensionType::kRtpExtensionMid:
192 case RTPExtensionType::kRtpExtensionNumberOfExtensions:
193 case RTPExtensionType::kRtpExtensionPlayoutDelay:
194 case RTPExtensionType::kRtpExtensionRepairedRtpStreamId:
195 case RTPExtensionType::kRtpExtensionRtpStreamId:
196 case RTPExtensionType::kRtpExtensionVideoContentType:
197 case RTPExtensionType::kRtpExtensionVideoRotation: {
198 // Non-mutable extension. Don't change it.
199 break;
200 }
201 }
202 }
203}
204
Danil Chapovalov7d2df3f2018-08-14 17:18:07 +0200205void RtpPacket::SetCsrcs(rtc::ArrayView<const uint32_t> csrcs) {
danilchap70f39a32016-12-16 05:48:18 -0800206 RTC_DCHECK_EQ(extensions_size_, 0);
kwibergaf476c72016-11-28 15:21:39 -0800207 RTC_DCHECK_EQ(payload_size_, 0);
208 RTC_DCHECK_EQ(padding_size_, 0);
danilchap1edb7ab2016-04-20 05:25:10 -0700209 RTC_DCHECK_LE(csrcs.size(), 0x0fu);
210 RTC_DCHECK_LE(kFixedHeaderSize + 4 * csrcs.size(), capacity());
211 payload_offset_ = kFixedHeaderSize + 4 * csrcs.size();
danilchap772bd8b2017-09-13 03:24:28 -0700212 WriteAt(0, (data()[0] & 0xF0) | rtc::dchecked_cast<uint8_t>(csrcs.size()));
danilchap1edb7ab2016-04-20 05:25:10 -0700213 size_t offset = kFixedHeaderSize;
214 for (uint32_t csrc : csrcs) {
215 ByteWriter<uint32_t>::WriteBigEndian(WriteAt(offset), csrc);
216 offset += 4;
217 }
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200218 buffer_.SetSize(payload_offset_);
danilchap1edb7ab2016-04-20 05:25:10 -0700219}
220
Danil Chapovalov8769e172017-09-14 14:08:22 +0200221rtc::ArrayView<uint8_t> RtpPacket::AllocateRawExtension(int id, size_t length) {
Johannes Kron07ba2b92018-09-26 13:33:35 +0200222 RTC_DCHECK_GE(id, RtpExtension::kMinId);
Johannes Kron78cdde32018-10-05 10:00:46 +0200223 RTC_DCHECK_LE(id, RtpExtension::kMaxId);
danilchap653063f2017-04-03 06:16:30 -0700224 RTC_DCHECK_GE(length, 1);
Johannes Kron78cdde32018-10-05 10:00:46 +0200225 RTC_DCHECK_LE(length, RtpExtension::kMaxValueSize);
Johannes Kronc5744b82018-09-24 14:50:48 +0200226 const ExtensionInfo* extension_entry = FindExtensionInfo(id);
227 if (extension_entry != nullptr) {
danilchap653063f2017-04-03 06:16:30 -0700228 // Extension already reserved. Check if same length is used.
229 if (extension_entry->length == length)
230 return rtc::MakeArrayView(WriteAt(extension_entry->offset), length);
231
Johannes Kronc5744b82018-09-24 14:50:48 +0200232 RTC_LOG(LS_ERROR) << "Length mismatch for extension id " << id
Mirko Bonadei675513b2017-11-09 11:09:25 +0100233 << ": expected "
234 << static_cast<int>(extension_entry->length)
235 << ". received " << length;
danilchap653063f2017-04-03 06:16:30 -0700236 return nullptr;
237 }
238 if (payload_size_ > 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100239 RTC_LOG(LS_ERROR) << "Can't add new extension id " << id
240 << " after payload was set.";
danilchap653063f2017-04-03 06:16:30 -0700241 return nullptr;
242 }
243 if (padding_size_ > 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100244 RTC_LOG(LS_ERROR) << "Can't add new extension id " << id
245 << " after padding was set.";
danilchap653063f2017-04-03 06:16:30 -0700246 return nullptr;
247 }
248
Johannes Kron78cdde32018-10-05 10:00:46 +0200249 const size_t num_csrc = data()[0] & 0x0F;
250 const size_t extensions_offset = kFixedHeaderSize + (num_csrc * 4) + 4;
251 // Determine if two-byte header is required for the extension based on id and
252 // length. Please note that a length of 0 also requires two-byte header
253 // extension. See RFC8285 Section 4.2-4.3.
254 const bool two_byte_header_required =
255 id > RtpExtension::kOneByteHeaderExtensionMaxId ||
256 length > RtpExtension::kOneByteHeaderExtensionMaxValueSize || length == 0;
Johannes Kron9581bc42018-10-23 10:17:39 +0200257 RTC_CHECK(!two_byte_header_required || extensions_.ExtmapAllowMixed());
Johannes Kron78cdde32018-10-05 10:00:46 +0200258
259 uint16_t profile_id;
260 if (extensions_size_ > 0) {
261 profile_id =
262 ByteReader<uint16_t>::ReadBigEndian(data() + extensions_offset - 4);
263 if (profile_id == kOneByteExtensionProfileId && two_byte_header_required) {
264 // Is buffer size big enough to fit promotion and new data field?
265 // The header extension will grow with one byte per already allocated
266 // extension + the size of the extension that is about to be allocated.
267 size_t expected_new_extensions_size =
268 extensions_size_ + extension_entries_.size() +
269 kTwoByteExtensionHeaderLength + length;
270 if (extensions_offset + expected_new_extensions_size > capacity()) {
271 RTC_LOG(LS_ERROR)
272 << "Extension cannot be registered: Not enough space left in "
273 "buffer to change to two-byte header extension and add new "
274 "extension.";
275 return nullptr;
276 }
277 // Promote already written data to two-byte header format.
278 PromoteToTwoByteHeaderExtension();
279 profile_id = kTwoByteExtensionProfileId;
280 }
281 } else {
282 // Profile specific ID, set to OneByteExtensionHeader unless
283 // TwoByteExtensionHeader is required.
284 profile_id = two_byte_header_required ? kTwoByteExtensionProfileId
285 : kOneByteExtensionProfileId;
286 }
287
288 const size_t extension_header_size = profile_id == kOneByteExtensionProfileId
289 ? kOneByteExtensionHeaderLength
290 : kTwoByteExtensionHeaderLength;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200291 size_t new_extensions_size =
Johannes Kron78cdde32018-10-05 10:00:46 +0200292 extensions_size_ + extension_header_size + length;
danilchap653063f2017-04-03 06:16:30 -0700293 if (extensions_offset + new_extensions_size > capacity()) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100294 RTC_LOG(LS_ERROR)
danilchap653063f2017-04-03 06:16:30 -0700295 << "Extension cannot be registered: Not enough space left in buffer.";
296 return nullptr;
297 }
298
299 // All checks passed, write down the extension headers.
300 if (extensions_size_ == 0) {
301 RTC_DCHECK_EQ(payload_offset_, kFixedHeaderSize + (num_csrc * 4));
302 WriteAt(0, data()[0] | 0x10); // Set extension bit.
danilchap653063f2017-04-03 06:16:30 -0700303 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 4),
Johannes Kron78cdde32018-10-05 10:00:46 +0200304 profile_id);
danilchap653063f2017-04-03 06:16:30 -0700305 }
306
Johannes Kron78cdde32018-10-05 10:00:46 +0200307 if (profile_id == kOneByteExtensionProfileId) {
308 uint8_t one_byte_header = rtc::dchecked_cast<uint8_t>(id) << 4;
309 one_byte_header |= rtc::dchecked_cast<uint8_t>(length - 1);
310 WriteAt(extensions_offset + extensions_size_, one_byte_header);
311 } else {
312 // TwoByteHeaderExtension.
313 uint8_t extension_id = rtc::dchecked_cast<uint8_t>(id);
314 WriteAt(extensions_offset + extensions_size_, extension_id);
315 uint8_t extension_length = rtc::dchecked_cast<uint8_t>(length);
316 WriteAt(extensions_offset + extensions_size_ + 1, extension_length);
317 }
danilchap653063f2017-04-03 06:16:30 -0700318
Johannes Kronc5744b82018-09-24 14:50:48 +0200319 const uint16_t extension_info_offset = rtc::dchecked_cast<uint16_t>(
Johannes Kron78cdde32018-10-05 10:00:46 +0200320 extensions_offset + extensions_size_ + extension_header_size);
Johannes Kronc5744b82018-09-24 14:50:48 +0200321 const uint8_t extension_info_length = rtc::dchecked_cast<uint8_t>(length);
322 extension_entries_.emplace_back(id, extension_info_length,
323 extension_info_offset);
Johannes Kron78cdde32018-10-05 10:00:46 +0200324
Danil Chapovalov61405bc2018-02-13 13:55:30 +0100325 extensions_size_ = new_extensions_size;
danilchap653063f2017-04-03 06:16:30 -0700326
Johannes Kron78cdde32018-10-05 10:00:46 +0200327 uint16_t extensions_size_padded =
328 SetExtensionLengthMaybeAddZeroPadding(extensions_offset);
329 payload_offset_ = extensions_offset + extensions_size_padded;
330 buffer_.SetSize(payload_offset_);
331 return rtc::MakeArrayView(WriteAt(extension_info_offset),
332 extension_info_length);
333}
334
335void RtpPacket::PromoteToTwoByteHeaderExtension() {
336 size_t num_csrc = data()[0] & 0x0F;
337 size_t extensions_offset = kFixedHeaderSize + (num_csrc * 4) + 4;
338
339 RTC_CHECK_GT(extension_entries_.size(), 0);
340 RTC_CHECK_EQ(payload_size_, 0);
341 RTC_CHECK_EQ(kOneByteExtensionProfileId, ByteReader<uint16_t>::ReadBigEndian(
342 data() + extensions_offset - 4));
343 // Rewrite data.
344 // Each extension adds one to the offset. The write-read delta for the last
345 // extension is therefore the same as the number of extension entries.
346 size_t write_read_delta = extension_entries_.size();
347 for (auto extension_entry = extension_entries_.rbegin();
348 extension_entry != extension_entries_.rend(); ++extension_entry) {
349 size_t read_index = extension_entry->offset;
350 size_t write_index = read_index + write_read_delta;
351 // Update offset.
352 extension_entry->offset = rtc::dchecked_cast<uint16_t>(write_index);
353 // Copy data. Use memmove since read/write regions may overlap.
354 memmove(WriteAt(write_index), data() + read_index, extension_entry->length);
355 // Rewrite id and length.
356 WriteAt(--write_index, extension_entry->length);
357 WriteAt(--write_index, extension_entry->id);
358 --write_read_delta;
359 }
360
361 // Update profile header, extensions length, and zero padding.
362 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 4),
363 kTwoByteExtensionProfileId);
364 extensions_size_ += extension_entries_.size();
365 uint16_t extensions_size_padded =
366 SetExtensionLengthMaybeAddZeroPadding(extensions_offset);
367 payload_offset_ = extensions_offset + extensions_size_padded;
368 buffer_.SetSize(payload_offset_);
369}
370
371uint16_t RtpPacket::SetExtensionLengthMaybeAddZeroPadding(
372 size_t extensions_offset) {
danilchap653063f2017-04-03 06:16:30 -0700373 // Update header length field.
Danil Chapovalov61405bc2018-02-13 13:55:30 +0100374 uint16_t extensions_words = rtc::dchecked_cast<uint16_t>(
375 (extensions_size_ + 3) / 4); // Wrap up to 32bit.
danilchap653063f2017-04-03 06:16:30 -0700376 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 2),
377 extensions_words);
378 // Fill extension padding place with zeroes.
379 size_t extension_padding_size = 4 * extensions_words - extensions_size_;
380 memset(WriteAt(extensions_offset + extensions_size_), 0,
381 extension_padding_size);
Johannes Kron78cdde32018-10-05 10:00:46 +0200382 return 4 * extensions_words;
danilchap653063f2017-04-03 06:16:30 -0700383}
384
Danil Chapovalov8769e172017-09-14 14:08:22 +0200385uint8_t* RtpPacket::AllocatePayload(size_t size_bytes) {
danilchap07a01b32017-03-29 07:33:13 -0700386 // Reset payload size to 0. If CopyOnWrite buffer_ was shared, this will cause
387 // reallocation and memcpy. Keeping just header reduces memcpy size.
388 SetPayloadSize(0);
389 return SetPayloadSize(size_bytes);
390}
391
Danil Chapovalov8769e172017-09-14 14:08:22 +0200392uint8_t* RtpPacket::SetPayloadSize(size_t size_bytes) {
kwibergaf476c72016-11-28 15:21:39 -0800393 RTC_DCHECK_EQ(padding_size_, 0);
danilchap1edb7ab2016-04-20 05:25:10 -0700394 if (payload_offset_ + size_bytes > capacity()) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100395 RTC_LOG(LS_WARNING) << "Cannot set payload, not enough space in buffer.";
danilchap1edb7ab2016-04-20 05:25:10 -0700396 return nullptr;
397 }
398 payload_size_ = size_bytes;
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200399 buffer_.SetSize(payload_offset_ + payload_size_);
danilchap1edb7ab2016-04-20 05:25:10 -0700400 return WriteAt(payload_offset_);
401}
402
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200403bool RtpPacket::SetPadding(size_t padding_bytes) {
404 if (payload_offset_ + payload_size_ + padding_bytes > capacity()) {
405 RTC_LOG(LS_WARNING) << "Cannot set padding size " << padding_bytes
406 << ", only "
Mirko Bonadei675513b2017-11-09 11:09:25 +0100407 << (capacity() - payload_offset_ - payload_size_)
408 << " bytes left in buffer.";
danilchap1edb7ab2016-04-20 05:25:10 -0700409 return false;
410 }
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200411 padding_size_ = rtc::dchecked_cast<uint8_t>(padding_bytes);
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200412 buffer_.SetSize(payload_offset_ + payload_size_ + padding_size_);
danilchap1edb7ab2016-04-20 05:25:10 -0700413 if (padding_size_ > 0) {
414 size_t padding_offset = payload_offset_ + payload_size_;
415 size_t padding_end = padding_offset + padding_size_;
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200416 memset(WriteAt(padding_offset), 0, padding_size_ - 1);
danilchap1edb7ab2016-04-20 05:25:10 -0700417 WriteAt(padding_end - 1, padding_size_);
418 WriteAt(0, data()[0] | 0x20); // Set padding bit.
419 } else {
420 WriteAt(0, data()[0] & ~0x20); // Clear padding bit.
421 }
422 return true;
423}
424
Danil Chapovalov8769e172017-09-14 14:08:22 +0200425void RtpPacket::Clear() {
danilchap1edb7ab2016-04-20 05:25:10 -0700426 marker_ = false;
427 payload_type_ = 0;
428 sequence_number_ = 0;
429 timestamp_ = 0;
430 ssrc_ = 0;
431 payload_offset_ = kFixedHeaderSize;
432 payload_size_ = 0;
433 padding_size_ = 0;
danilchap1edb7ab2016-04-20 05:25:10 -0700434 extensions_size_ = 0;
Johannes Kronc5744b82018-09-24 14:50:48 +0200435 extension_entries_.clear();
danilchap1edb7ab2016-04-20 05:25:10 -0700436
437 memset(WriteAt(0), 0, kFixedHeaderSize);
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200438 buffer_.SetSize(kFixedHeaderSize);
danilchap1edb7ab2016-04-20 05:25:10 -0700439 WriteAt(0, kRtpVersion << 6);
440}
441
Danil Chapovalov8769e172017-09-14 14:08:22 +0200442bool RtpPacket::ParseBuffer(const uint8_t* buffer, size_t size) {
danilchap1edb7ab2016-04-20 05:25:10 -0700443 if (size < kFixedHeaderSize) {
444 return false;
445 }
446 const uint8_t version = buffer[0] >> 6;
447 if (version != kRtpVersion) {
448 return false;
449 }
450 const bool has_padding = (buffer[0] & 0x20) != 0;
451 const bool has_extension = (buffer[0] & 0x10) != 0;
452 const uint8_t number_of_crcs = buffer[0] & 0x0f;
453 marker_ = (buffer[1] & 0x80) != 0;
454 payload_type_ = buffer[1] & 0x7f;
455
456 sequence_number_ = ByteReader<uint16_t>::ReadBigEndian(&buffer[2]);
457 timestamp_ = ByteReader<uint32_t>::ReadBigEndian(&buffer[4]);
458 ssrc_ = ByteReader<uint32_t>::ReadBigEndian(&buffer[8]);
459 if (size < kFixedHeaderSize + number_of_crcs * 4) {
460 return false;
461 }
462 payload_offset_ = kFixedHeaderSize + number_of_crcs * 4;
463
464 if (has_padding) {
465 padding_size_ = buffer[size - 1];
466 if (padding_size_ == 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100467 RTC_LOG(LS_WARNING) << "Padding was set, but padding size is zero";
danilchap1edb7ab2016-04-20 05:25:10 -0700468 return false;
469 }
470 } else {
471 padding_size_ = 0;
472 }
473
danilchap1edb7ab2016-04-20 05:25:10 -0700474 extensions_size_ = 0;
Johannes Kron6ea77192018-09-24 17:19:52 +0200475 extension_entries_.clear();
danilchap1edb7ab2016-04-20 05:25:10 -0700476 if (has_extension) {
477 /* RTP header extension, RFC 3550.
478 0 1 2 3
479 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
480 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
481 | defined by profile | length |
482 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
483 | header extension |
484 | .... |
485 */
486 size_t extension_offset = payload_offset_ + 4;
487 if (extension_offset > size) {
488 return false;
489 }
490 uint16_t profile =
491 ByteReader<uint16_t>::ReadBigEndian(&buffer[payload_offset_]);
492 size_t extensions_capacity =
493 ByteReader<uint16_t>::ReadBigEndian(&buffer[payload_offset_ + 2]);
494 extensions_capacity *= 4;
495 if (extension_offset + extensions_capacity > size) {
496 return false;
497 }
Johannes Kron07ba2b92018-09-26 13:33:35 +0200498 if (profile != kOneByteExtensionProfileId &&
499 profile != kTwoByteExtensionProfileId) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100500 RTC_LOG(LS_WARNING) << "Unsupported rtp extension " << profile;
danilchap1edb7ab2016-04-20 05:25:10 -0700501 } else {
Johannes Kron07ba2b92018-09-26 13:33:35 +0200502 size_t extension_header_length = profile == kOneByteExtensionProfileId
503 ? kOneByteExtensionHeaderLength
504 : kTwoByteExtensionHeaderLength;
505 constexpr uint8_t kPaddingByte = 0;
danilchap1edb7ab2016-04-20 05:25:10 -0700506 constexpr uint8_t kPaddingId = 0;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200507 constexpr uint8_t kOneByteHeaderExtensionReservedId = 15;
508 while (extensions_size_ + extension_header_length < extensions_capacity) {
509 if (buffer[extension_offset + extensions_size_] == kPaddingByte) {
danilchap1edb7ab2016-04-20 05:25:10 -0700510 extensions_size_++;
511 continue;
512 }
Johannes Kron07ba2b92018-09-26 13:33:35 +0200513 int id;
514 uint8_t length;
515 if (profile == kOneByteExtensionProfileId) {
516 id = buffer[extension_offset + extensions_size_] >> 4;
517 length = 1 + (buffer[extension_offset + extensions_size_] & 0xf);
518 if (id == kOneByteHeaderExtensionReservedId ||
519 (id == kPaddingId && length != 1)) {
520 break;
521 }
522 } else {
523 id = buffer[extension_offset + extensions_size_];
524 length = buffer[extension_offset + extensions_size_ + 1];
525 }
526
527 if (extensions_size_ + extension_header_length + length >
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200528 extensions_capacity) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100529 RTC_LOG(LS_WARNING) << "Oversized rtp header extension.";
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200530 break;
danilchap1edb7ab2016-04-20 05:25:10 -0700531 }
danilchap70f39a32016-12-16 05:48:18 -0800532
Johannes Kronc5744b82018-09-24 14:50:48 +0200533 ExtensionInfo& extension_info = FindOrCreateExtensionInfo(id);
534 if (extension_info.length != 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100535 RTC_LOG(LS_VERBOSE)
536 << "Duplicate rtp header extension id " << id << ". Overwriting.";
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200537 }
danilchap70f39a32016-12-16 05:48:18 -0800538
Danil Chapovalovc2dd59c2018-02-06 11:29:35 +0100539 size_t offset =
Johannes Kron07ba2b92018-09-26 13:33:35 +0200540 extension_offset + extensions_size_ + extension_header_length;
Danil Chapovalovc2dd59c2018-02-06 11:29:35 +0100541 if (!rtc::IsValueInRangeForNumericType<uint16_t>(offset)) {
542 RTC_DLOG(LS_WARNING) << "Oversized rtp header extension.";
543 break;
544 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200545 extension_info.offset = static_cast<uint16_t>(offset);
546 extension_info.length = length;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200547 extensions_size_ += extension_header_length + length;
danilchap1edb7ab2016-04-20 05:25:10 -0700548 }
549 }
550 payload_offset_ = extension_offset + extensions_capacity;
551 }
552
553 if (payload_offset_ + padding_size_ > size) {
554 return false;
555 }
556 payload_size_ = size - payload_offset_ - padding_size_;
557 return true;
558}
559
Johannes Kronc5744b82018-09-24 14:50:48 +0200560const RtpPacket::ExtensionInfo* RtpPacket::FindExtensionInfo(int id) const {
danilchap70f39a32016-12-16 05:48:18 -0800561 for (const ExtensionInfo& extension : extension_entries_) {
Johannes Kronc5744b82018-09-24 14:50:48 +0200562 if (extension.id == id) {
563 return &extension;
danilchap1edb7ab2016-04-20 05:25:10 -0700564 }
565 }
danilchap978504e2017-04-06 01:03:53 -0700566 return nullptr;
danilchap1edb7ab2016-04-20 05:25:10 -0700567}
568
Johannes Kronc5744b82018-09-24 14:50:48 +0200569RtpPacket::ExtensionInfo& RtpPacket::FindOrCreateExtensionInfo(int id) {
570 for (ExtensionInfo& extension : extension_entries_) {
571 if (extension.id == id) {
572 return extension;
danilchap70f39a32016-12-16 05:48:18 -0800573 }
danilchap1edb7ab2016-04-20 05:25:10 -0700574 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200575 extension_entries_.emplace_back(id);
576 return extension_entries_.back();
577}
578
579rtc::ArrayView<const uint8_t> RtpPacket::FindExtension(
580 ExtensionType type) const {
581 uint8_t id = extensions_.GetId(type);
582 if (id == ExtensionManager::kInvalidId) {
583 // Extension not registered.
584 return nullptr;
585 }
586 ExtensionInfo const* extension_info = FindExtensionInfo(id);
587 if (extension_info == nullptr) {
588 return nullptr;
589 }
590 return rtc::MakeArrayView(data() + extension_info->offset,
591 extension_info->length);
592}
593
594rtc::ArrayView<uint8_t> RtpPacket::AllocateExtension(ExtensionType type,
595 size_t length) {
Johannes Kron78cdde32018-10-05 10:00:46 +0200596 // TODO(webrtc:7990): Add support for empty extensions (length==0).
597 if (length == 0 || length > RtpExtension::kMaxValueSize ||
Johannes Kron9581bc42018-10-23 10:17:39 +0200598 (!extensions_.ExtmapAllowMixed() &&
Johannes Kron78cdde32018-10-05 10:00:46 +0200599 length > RtpExtension::kOneByteHeaderExtensionMaxValueSize)) {
600 return nullptr;
601 }
602
Johannes Kronc5744b82018-09-24 14:50:48 +0200603 uint8_t id = extensions_.GetId(type);
604 if (id == ExtensionManager::kInvalidId) {
605 // Extension not registered.
606 return nullptr;
607 }
Johannes Kron9581bc42018-10-23 10:17:39 +0200608 if (!extensions_.ExtmapAllowMixed() &&
Johannes Kron78cdde32018-10-05 10:00:46 +0200609 id > RtpExtension::kOneByteHeaderExtensionMaxId) {
610 return nullptr;
611 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200612 return AllocateRawExtension(id, length);
danilchap1edb7ab2016-04-20 05:25:10 -0700613}
614
Amit Hilbuch77938e62018-12-21 09:23:38 -0800615bool RtpPacket::HasExtension(ExtensionType type) const {
616 // TODO(webrtc:7990): Add support for empty extensions (length==0).
617 return !FindExtension(type).empty();
618}
619
Erik Språng1d46f9c2019-07-02 21:24:47 +0200620bool RtpPacket::IsExtensionReserved(ExtensionType type) const {
621 uint8_t id = extensions_.GetId(type);
622 if (id == ExtensionManager::kInvalidId) {
623 // Extension not registered.
624 return false;
625 }
626 return FindExtensionInfo(id) != nullptr;
627}
628
danilchap1edb7ab2016-04-20 05:25:10 -0700629} // namespace webrtc