blob: 282bea2a8514fc5a805c5b74c8bc45687090cf28 [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:
190 case RTPExtensionType::kRtpExtensionMid:
191 case RTPExtensionType::kRtpExtensionNumberOfExtensions:
192 case RTPExtensionType::kRtpExtensionPlayoutDelay:
193 case RTPExtensionType::kRtpExtensionRepairedRtpStreamId:
194 case RTPExtensionType::kRtpExtensionRtpStreamId:
195 case RTPExtensionType::kRtpExtensionVideoContentType:
196 case RTPExtensionType::kRtpExtensionVideoRotation: {
197 // Non-mutable extension. Don't change it.
198 break;
199 }
200 }
201 }
202}
203
Danil Chapovalov7d2df3f2018-08-14 17:18:07 +0200204void RtpPacket::SetCsrcs(rtc::ArrayView<const uint32_t> csrcs) {
danilchap70f39a32016-12-16 05:48:18 -0800205 RTC_DCHECK_EQ(extensions_size_, 0);
kwibergaf476c72016-11-28 15:21:39 -0800206 RTC_DCHECK_EQ(payload_size_, 0);
207 RTC_DCHECK_EQ(padding_size_, 0);
danilchap1edb7ab2016-04-20 05:25:10 -0700208 RTC_DCHECK_LE(csrcs.size(), 0x0fu);
209 RTC_DCHECK_LE(kFixedHeaderSize + 4 * csrcs.size(), capacity());
210 payload_offset_ = kFixedHeaderSize + 4 * csrcs.size();
danilchap772bd8b2017-09-13 03:24:28 -0700211 WriteAt(0, (data()[0] & 0xF0) | rtc::dchecked_cast<uint8_t>(csrcs.size()));
danilchap1edb7ab2016-04-20 05:25:10 -0700212 size_t offset = kFixedHeaderSize;
213 for (uint32_t csrc : csrcs) {
214 ByteWriter<uint32_t>::WriteBigEndian(WriteAt(offset), csrc);
215 offset += 4;
216 }
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200217 buffer_.SetSize(payload_offset_);
danilchap1edb7ab2016-04-20 05:25:10 -0700218}
219
Danil Chapovalov8769e172017-09-14 14:08:22 +0200220rtc::ArrayView<uint8_t> RtpPacket::AllocateRawExtension(int id, size_t length) {
Johannes Kron07ba2b92018-09-26 13:33:35 +0200221 RTC_DCHECK_GE(id, RtpExtension::kMinId);
Johannes Kron78cdde32018-10-05 10:00:46 +0200222 RTC_DCHECK_LE(id, RtpExtension::kMaxId);
danilchap653063f2017-04-03 06:16:30 -0700223 RTC_DCHECK_GE(length, 1);
Johannes Kron78cdde32018-10-05 10:00:46 +0200224 RTC_DCHECK_LE(length, RtpExtension::kMaxValueSize);
Johannes Kronc5744b82018-09-24 14:50:48 +0200225 const ExtensionInfo* extension_entry = FindExtensionInfo(id);
226 if (extension_entry != nullptr) {
danilchap653063f2017-04-03 06:16:30 -0700227 // Extension already reserved. Check if same length is used.
228 if (extension_entry->length == length)
229 return rtc::MakeArrayView(WriteAt(extension_entry->offset), length);
230
Johannes Kronc5744b82018-09-24 14:50:48 +0200231 RTC_LOG(LS_ERROR) << "Length mismatch for extension id " << id
Mirko Bonadei675513b2017-11-09 11:09:25 +0100232 << ": expected "
233 << static_cast<int>(extension_entry->length)
234 << ". received " << length;
danilchap653063f2017-04-03 06:16:30 -0700235 return nullptr;
236 }
237 if (payload_size_ > 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100238 RTC_LOG(LS_ERROR) << "Can't add new extension id " << id
239 << " after payload was set.";
danilchap653063f2017-04-03 06:16:30 -0700240 return nullptr;
241 }
242 if (padding_size_ > 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100243 RTC_LOG(LS_ERROR) << "Can't add new extension id " << id
244 << " after padding was set.";
danilchap653063f2017-04-03 06:16:30 -0700245 return nullptr;
246 }
247
Johannes Kron78cdde32018-10-05 10:00:46 +0200248 const size_t num_csrc = data()[0] & 0x0F;
249 const size_t extensions_offset = kFixedHeaderSize + (num_csrc * 4) + 4;
250 // Determine if two-byte header is required for the extension based on id and
251 // length. Please note that a length of 0 also requires two-byte header
252 // extension. See RFC8285 Section 4.2-4.3.
253 const bool two_byte_header_required =
254 id > RtpExtension::kOneByteHeaderExtensionMaxId ||
255 length > RtpExtension::kOneByteHeaderExtensionMaxValueSize || length == 0;
Johannes Kron9581bc42018-10-23 10:17:39 +0200256 RTC_CHECK(!two_byte_header_required || extensions_.ExtmapAllowMixed());
Johannes Kron78cdde32018-10-05 10:00:46 +0200257
258 uint16_t profile_id;
259 if (extensions_size_ > 0) {
260 profile_id =
261 ByteReader<uint16_t>::ReadBigEndian(data() + extensions_offset - 4);
262 if (profile_id == kOneByteExtensionProfileId && two_byte_header_required) {
263 // Is buffer size big enough to fit promotion and new data field?
264 // The header extension will grow with one byte per already allocated
265 // extension + the size of the extension that is about to be allocated.
266 size_t expected_new_extensions_size =
267 extensions_size_ + extension_entries_.size() +
268 kTwoByteExtensionHeaderLength + length;
269 if (extensions_offset + expected_new_extensions_size > capacity()) {
270 RTC_LOG(LS_ERROR)
271 << "Extension cannot be registered: Not enough space left in "
272 "buffer to change to two-byte header extension and add new "
273 "extension.";
274 return nullptr;
275 }
276 // Promote already written data to two-byte header format.
277 PromoteToTwoByteHeaderExtension();
278 profile_id = kTwoByteExtensionProfileId;
279 }
280 } else {
281 // Profile specific ID, set to OneByteExtensionHeader unless
282 // TwoByteExtensionHeader is required.
283 profile_id = two_byte_header_required ? kTwoByteExtensionProfileId
284 : kOneByteExtensionProfileId;
285 }
286
287 const size_t extension_header_size = profile_id == kOneByteExtensionProfileId
288 ? kOneByteExtensionHeaderLength
289 : kTwoByteExtensionHeaderLength;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200290 size_t new_extensions_size =
Johannes Kron78cdde32018-10-05 10:00:46 +0200291 extensions_size_ + extension_header_size + length;
danilchap653063f2017-04-03 06:16:30 -0700292 if (extensions_offset + new_extensions_size > capacity()) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100293 RTC_LOG(LS_ERROR)
danilchap653063f2017-04-03 06:16:30 -0700294 << "Extension cannot be registered: Not enough space left in buffer.";
295 return nullptr;
296 }
297
298 // All checks passed, write down the extension headers.
299 if (extensions_size_ == 0) {
300 RTC_DCHECK_EQ(payload_offset_, kFixedHeaderSize + (num_csrc * 4));
301 WriteAt(0, data()[0] | 0x10); // Set extension bit.
danilchap653063f2017-04-03 06:16:30 -0700302 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 4),
Johannes Kron78cdde32018-10-05 10:00:46 +0200303 profile_id);
danilchap653063f2017-04-03 06:16:30 -0700304 }
305
Johannes Kron78cdde32018-10-05 10:00:46 +0200306 if (profile_id == kOneByteExtensionProfileId) {
307 uint8_t one_byte_header = rtc::dchecked_cast<uint8_t>(id) << 4;
308 one_byte_header |= rtc::dchecked_cast<uint8_t>(length - 1);
309 WriteAt(extensions_offset + extensions_size_, one_byte_header);
310 } else {
311 // TwoByteHeaderExtension.
312 uint8_t extension_id = rtc::dchecked_cast<uint8_t>(id);
313 WriteAt(extensions_offset + extensions_size_, extension_id);
314 uint8_t extension_length = rtc::dchecked_cast<uint8_t>(length);
315 WriteAt(extensions_offset + extensions_size_ + 1, extension_length);
316 }
danilchap653063f2017-04-03 06:16:30 -0700317
Johannes Kronc5744b82018-09-24 14:50:48 +0200318 const uint16_t extension_info_offset = rtc::dchecked_cast<uint16_t>(
Johannes Kron78cdde32018-10-05 10:00:46 +0200319 extensions_offset + extensions_size_ + extension_header_size);
Johannes Kronc5744b82018-09-24 14:50:48 +0200320 const uint8_t extension_info_length = rtc::dchecked_cast<uint8_t>(length);
321 extension_entries_.emplace_back(id, extension_info_length,
322 extension_info_offset);
Johannes Kron78cdde32018-10-05 10:00:46 +0200323
Danil Chapovalov61405bc2018-02-13 13:55:30 +0100324 extensions_size_ = new_extensions_size;
danilchap653063f2017-04-03 06:16:30 -0700325
Johannes Kron78cdde32018-10-05 10:00:46 +0200326 uint16_t extensions_size_padded =
327 SetExtensionLengthMaybeAddZeroPadding(extensions_offset);
328 payload_offset_ = extensions_offset + extensions_size_padded;
329 buffer_.SetSize(payload_offset_);
330 return rtc::MakeArrayView(WriteAt(extension_info_offset),
331 extension_info_length);
332}
333
334void RtpPacket::PromoteToTwoByteHeaderExtension() {
335 size_t num_csrc = data()[0] & 0x0F;
336 size_t extensions_offset = kFixedHeaderSize + (num_csrc * 4) + 4;
337
338 RTC_CHECK_GT(extension_entries_.size(), 0);
339 RTC_CHECK_EQ(payload_size_, 0);
340 RTC_CHECK_EQ(kOneByteExtensionProfileId, ByteReader<uint16_t>::ReadBigEndian(
341 data() + extensions_offset - 4));
342 // Rewrite data.
343 // Each extension adds one to the offset. The write-read delta for the last
344 // extension is therefore the same as the number of extension entries.
345 size_t write_read_delta = extension_entries_.size();
346 for (auto extension_entry = extension_entries_.rbegin();
347 extension_entry != extension_entries_.rend(); ++extension_entry) {
348 size_t read_index = extension_entry->offset;
349 size_t write_index = read_index + write_read_delta;
350 // Update offset.
351 extension_entry->offset = rtc::dchecked_cast<uint16_t>(write_index);
352 // Copy data. Use memmove since read/write regions may overlap.
353 memmove(WriteAt(write_index), data() + read_index, extension_entry->length);
354 // Rewrite id and length.
355 WriteAt(--write_index, extension_entry->length);
356 WriteAt(--write_index, extension_entry->id);
357 --write_read_delta;
358 }
359
360 // Update profile header, extensions length, and zero padding.
361 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 4),
362 kTwoByteExtensionProfileId);
363 extensions_size_ += extension_entries_.size();
364 uint16_t extensions_size_padded =
365 SetExtensionLengthMaybeAddZeroPadding(extensions_offset);
366 payload_offset_ = extensions_offset + extensions_size_padded;
367 buffer_.SetSize(payload_offset_);
368}
369
370uint16_t RtpPacket::SetExtensionLengthMaybeAddZeroPadding(
371 size_t extensions_offset) {
danilchap653063f2017-04-03 06:16:30 -0700372 // Update header length field.
Danil Chapovalov61405bc2018-02-13 13:55:30 +0100373 uint16_t extensions_words = rtc::dchecked_cast<uint16_t>(
374 (extensions_size_ + 3) / 4); // Wrap up to 32bit.
danilchap653063f2017-04-03 06:16:30 -0700375 ByteWriter<uint16_t>::WriteBigEndian(WriteAt(extensions_offset - 2),
376 extensions_words);
377 // Fill extension padding place with zeroes.
378 size_t extension_padding_size = 4 * extensions_words - extensions_size_;
379 memset(WriteAt(extensions_offset + extensions_size_), 0,
380 extension_padding_size);
Johannes Kron78cdde32018-10-05 10:00:46 +0200381 return 4 * extensions_words;
danilchap653063f2017-04-03 06:16:30 -0700382}
383
Danil Chapovalov8769e172017-09-14 14:08:22 +0200384uint8_t* RtpPacket::AllocatePayload(size_t size_bytes) {
danilchap07a01b32017-03-29 07:33:13 -0700385 // Reset payload size to 0. If CopyOnWrite buffer_ was shared, this will cause
386 // reallocation and memcpy. Keeping just header reduces memcpy size.
387 SetPayloadSize(0);
388 return SetPayloadSize(size_bytes);
389}
390
Danil Chapovalov8769e172017-09-14 14:08:22 +0200391uint8_t* RtpPacket::SetPayloadSize(size_t size_bytes) {
kwibergaf476c72016-11-28 15:21:39 -0800392 RTC_DCHECK_EQ(padding_size_, 0);
danilchap1edb7ab2016-04-20 05:25:10 -0700393 if (payload_offset_ + size_bytes > capacity()) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100394 RTC_LOG(LS_WARNING) << "Cannot set payload, not enough space in buffer.";
danilchap1edb7ab2016-04-20 05:25:10 -0700395 return nullptr;
396 }
397 payload_size_ = size_bytes;
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200398 buffer_.SetSize(payload_offset_ + payload_size_);
danilchap1edb7ab2016-04-20 05:25:10 -0700399 return WriteAt(payload_offset_);
400}
401
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200402bool RtpPacket::SetPadding(size_t padding_bytes) {
403 if (payload_offset_ + payload_size_ + padding_bytes > capacity()) {
404 RTC_LOG(LS_WARNING) << "Cannot set padding size " << padding_bytes
405 << ", only "
Mirko Bonadei675513b2017-11-09 11:09:25 +0100406 << (capacity() - payload_offset_ - payload_size_)
407 << " bytes left in buffer.";
danilchap1edb7ab2016-04-20 05:25:10 -0700408 return false;
409 }
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200410 padding_size_ = rtc::dchecked_cast<uint8_t>(padding_bytes);
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200411 buffer_.SetSize(payload_offset_ + payload_size_ + padding_size_);
danilchap1edb7ab2016-04-20 05:25:10 -0700412 if (padding_size_ > 0) {
413 size_t padding_offset = payload_offset_ + payload_size_;
414 size_t padding_end = padding_offset + padding_size_;
Danil Chapovalovf7fcaf02018-10-10 14:56:01 +0200415 memset(WriteAt(padding_offset), 0, padding_size_ - 1);
danilchap1edb7ab2016-04-20 05:25:10 -0700416 WriteAt(padding_end - 1, padding_size_);
417 WriteAt(0, data()[0] | 0x20); // Set padding bit.
418 } else {
419 WriteAt(0, data()[0] & ~0x20); // Clear padding bit.
420 }
421 return true;
422}
423
Danil Chapovalov8769e172017-09-14 14:08:22 +0200424void RtpPacket::Clear() {
danilchap1edb7ab2016-04-20 05:25:10 -0700425 marker_ = false;
426 payload_type_ = 0;
427 sequence_number_ = 0;
428 timestamp_ = 0;
429 ssrc_ = 0;
430 payload_offset_ = kFixedHeaderSize;
431 payload_size_ = 0;
432 padding_size_ = 0;
danilchap1edb7ab2016-04-20 05:25:10 -0700433 extensions_size_ = 0;
Johannes Kronc5744b82018-09-24 14:50:48 +0200434 extension_entries_.clear();
danilchap1edb7ab2016-04-20 05:25:10 -0700435
436 memset(WriteAt(0), 0, kFixedHeaderSize);
Danil Chapovalov31e4e802016-08-03 18:27:40 +0200437 buffer_.SetSize(kFixedHeaderSize);
danilchap1edb7ab2016-04-20 05:25:10 -0700438 WriteAt(0, kRtpVersion << 6);
439}
440
Danil Chapovalov8769e172017-09-14 14:08:22 +0200441bool RtpPacket::ParseBuffer(const uint8_t* buffer, size_t size) {
danilchap1edb7ab2016-04-20 05:25:10 -0700442 if (size < kFixedHeaderSize) {
443 return false;
444 }
445 const uint8_t version = buffer[0] >> 6;
446 if (version != kRtpVersion) {
447 return false;
448 }
449 const bool has_padding = (buffer[0] & 0x20) != 0;
450 const bool has_extension = (buffer[0] & 0x10) != 0;
451 const uint8_t number_of_crcs = buffer[0] & 0x0f;
452 marker_ = (buffer[1] & 0x80) != 0;
453 payload_type_ = buffer[1] & 0x7f;
454
455 sequence_number_ = ByteReader<uint16_t>::ReadBigEndian(&buffer[2]);
456 timestamp_ = ByteReader<uint32_t>::ReadBigEndian(&buffer[4]);
457 ssrc_ = ByteReader<uint32_t>::ReadBigEndian(&buffer[8]);
458 if (size < kFixedHeaderSize + number_of_crcs * 4) {
459 return false;
460 }
461 payload_offset_ = kFixedHeaderSize + number_of_crcs * 4;
462
463 if (has_padding) {
464 padding_size_ = buffer[size - 1];
465 if (padding_size_ == 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100466 RTC_LOG(LS_WARNING) << "Padding was set, but padding size is zero";
danilchap1edb7ab2016-04-20 05:25:10 -0700467 return false;
468 }
469 } else {
470 padding_size_ = 0;
471 }
472
danilchap1edb7ab2016-04-20 05:25:10 -0700473 extensions_size_ = 0;
Johannes Kron6ea77192018-09-24 17:19:52 +0200474 extension_entries_.clear();
danilchap1edb7ab2016-04-20 05:25:10 -0700475 if (has_extension) {
476 /* RTP header extension, RFC 3550.
477 0 1 2 3
478 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
479 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
480 | defined by profile | length |
481 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
482 | header extension |
483 | .... |
484 */
485 size_t extension_offset = payload_offset_ + 4;
486 if (extension_offset > size) {
487 return false;
488 }
489 uint16_t profile =
490 ByteReader<uint16_t>::ReadBigEndian(&buffer[payload_offset_]);
491 size_t extensions_capacity =
492 ByteReader<uint16_t>::ReadBigEndian(&buffer[payload_offset_ + 2]);
493 extensions_capacity *= 4;
494 if (extension_offset + extensions_capacity > size) {
495 return false;
496 }
Johannes Kron07ba2b92018-09-26 13:33:35 +0200497 if (profile != kOneByteExtensionProfileId &&
498 profile != kTwoByteExtensionProfileId) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100499 RTC_LOG(LS_WARNING) << "Unsupported rtp extension " << profile;
danilchap1edb7ab2016-04-20 05:25:10 -0700500 } else {
Johannes Kron07ba2b92018-09-26 13:33:35 +0200501 size_t extension_header_length = profile == kOneByteExtensionProfileId
502 ? kOneByteExtensionHeaderLength
503 : kTwoByteExtensionHeaderLength;
504 constexpr uint8_t kPaddingByte = 0;
danilchap1edb7ab2016-04-20 05:25:10 -0700505 constexpr uint8_t kPaddingId = 0;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200506 constexpr uint8_t kOneByteHeaderExtensionReservedId = 15;
507 while (extensions_size_ + extension_header_length < extensions_capacity) {
508 if (buffer[extension_offset + extensions_size_] == kPaddingByte) {
danilchap1edb7ab2016-04-20 05:25:10 -0700509 extensions_size_++;
510 continue;
511 }
Johannes Kron07ba2b92018-09-26 13:33:35 +0200512 int id;
513 uint8_t length;
514 if (profile == kOneByteExtensionProfileId) {
515 id = buffer[extension_offset + extensions_size_] >> 4;
516 length = 1 + (buffer[extension_offset + extensions_size_] & 0xf);
517 if (id == kOneByteHeaderExtensionReservedId ||
518 (id == kPaddingId && length != 1)) {
519 break;
520 }
521 } else {
522 id = buffer[extension_offset + extensions_size_];
523 length = buffer[extension_offset + extensions_size_ + 1];
524 }
525
526 if (extensions_size_ + extension_header_length + length >
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200527 extensions_capacity) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100528 RTC_LOG(LS_WARNING) << "Oversized rtp header extension.";
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200529 break;
danilchap1edb7ab2016-04-20 05:25:10 -0700530 }
danilchap70f39a32016-12-16 05:48:18 -0800531
Johannes Kronc5744b82018-09-24 14:50:48 +0200532 ExtensionInfo& extension_info = FindOrCreateExtensionInfo(id);
533 if (extension_info.length != 0) {
Mirko Bonadei675513b2017-11-09 11:09:25 +0100534 RTC_LOG(LS_VERBOSE)
535 << "Duplicate rtp header extension id " << id << ". Overwriting.";
Danil Chapovalova64a2fb2016-09-12 11:41:35 +0200536 }
danilchap70f39a32016-12-16 05:48:18 -0800537
Danil Chapovalovc2dd59c2018-02-06 11:29:35 +0100538 size_t offset =
Johannes Kron07ba2b92018-09-26 13:33:35 +0200539 extension_offset + extensions_size_ + extension_header_length;
Danil Chapovalovc2dd59c2018-02-06 11:29:35 +0100540 if (!rtc::IsValueInRangeForNumericType<uint16_t>(offset)) {
541 RTC_DLOG(LS_WARNING) << "Oversized rtp header extension.";
542 break;
543 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200544 extension_info.offset = static_cast<uint16_t>(offset);
545 extension_info.length = length;
Johannes Kron07ba2b92018-09-26 13:33:35 +0200546 extensions_size_ += extension_header_length + length;
danilchap1edb7ab2016-04-20 05:25:10 -0700547 }
548 }
549 payload_offset_ = extension_offset + extensions_capacity;
550 }
551
552 if (payload_offset_ + padding_size_ > size) {
553 return false;
554 }
555 payload_size_ = size - payload_offset_ - padding_size_;
556 return true;
557}
558
Johannes Kronc5744b82018-09-24 14:50:48 +0200559const RtpPacket::ExtensionInfo* RtpPacket::FindExtensionInfo(int id) const {
danilchap70f39a32016-12-16 05:48:18 -0800560 for (const ExtensionInfo& extension : extension_entries_) {
Johannes Kronc5744b82018-09-24 14:50:48 +0200561 if (extension.id == id) {
562 return &extension;
danilchap1edb7ab2016-04-20 05:25:10 -0700563 }
564 }
danilchap978504e2017-04-06 01:03:53 -0700565 return nullptr;
danilchap1edb7ab2016-04-20 05:25:10 -0700566}
567
Johannes Kronc5744b82018-09-24 14:50:48 +0200568RtpPacket::ExtensionInfo& RtpPacket::FindOrCreateExtensionInfo(int id) {
569 for (ExtensionInfo& extension : extension_entries_) {
570 if (extension.id == id) {
571 return extension;
danilchap70f39a32016-12-16 05:48:18 -0800572 }
danilchap1edb7ab2016-04-20 05:25:10 -0700573 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200574 extension_entries_.emplace_back(id);
575 return extension_entries_.back();
576}
577
578rtc::ArrayView<const uint8_t> RtpPacket::FindExtension(
579 ExtensionType type) const {
580 uint8_t id = extensions_.GetId(type);
581 if (id == ExtensionManager::kInvalidId) {
582 // Extension not registered.
583 return nullptr;
584 }
585 ExtensionInfo const* extension_info = FindExtensionInfo(id);
586 if (extension_info == nullptr) {
587 return nullptr;
588 }
589 return rtc::MakeArrayView(data() + extension_info->offset,
590 extension_info->length);
591}
592
593rtc::ArrayView<uint8_t> RtpPacket::AllocateExtension(ExtensionType type,
594 size_t length) {
Johannes Kron78cdde32018-10-05 10:00:46 +0200595 // TODO(webrtc:7990): Add support for empty extensions (length==0).
596 if (length == 0 || length > RtpExtension::kMaxValueSize ||
Johannes Kron9581bc42018-10-23 10:17:39 +0200597 (!extensions_.ExtmapAllowMixed() &&
Johannes Kron78cdde32018-10-05 10:00:46 +0200598 length > RtpExtension::kOneByteHeaderExtensionMaxValueSize)) {
599 return nullptr;
600 }
601
Johannes Kronc5744b82018-09-24 14:50:48 +0200602 uint8_t id = extensions_.GetId(type);
603 if (id == ExtensionManager::kInvalidId) {
604 // Extension not registered.
605 return nullptr;
606 }
Johannes Kron9581bc42018-10-23 10:17:39 +0200607 if (!extensions_.ExtmapAllowMixed() &&
Johannes Kron78cdde32018-10-05 10:00:46 +0200608 id > RtpExtension::kOneByteHeaderExtensionMaxId) {
609 return nullptr;
610 }
Johannes Kronc5744b82018-09-24 14:50:48 +0200611 return AllocateRawExtension(id, length);
danilchap1edb7ab2016-04-20 05:25:10 -0700612}
613
Amit Hilbuch77938e62018-12-21 09:23:38 -0800614bool RtpPacket::HasExtension(ExtensionType type) const {
615 // TODO(webrtc:7990): Add support for empty extensions (length==0).
616 return !FindExtension(type).empty();
617}
618
danilchap1edb7ab2016-04-20 05:25:10 -0700619} // namespace webrtc