blob: 3d31f6811556dabe33bf5cb563088e53e18db278 [file] [log] [blame]
niklase@google.com470e71d2011-07-07 08:21:25 +00001/*
pwestin@webrtc.orgf6bb77a2012-01-24 17:16:59 +00002 * Copyright (c) 2012 The WebRTC project authors. All Rights Reserved.
niklase@google.com470e71d2011-07-07 08:21:25 +00003 *
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
11#include "rtp_utility.h"
12
niklase@google.com470e71d2011-07-07 08:21:25 +000013#include <cassert>
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000014#include <cmath> // ceil
15#include <cstring> // memcpy
16
17#if defined(_WIN32)
18#include <Windows.h> // FILETIME
19#include <WinSock.h> // timeval
20#include <MMSystem.h> // timeGetTime
21#elif ((defined WEBRTC_LINUX) || (defined WEBRTC_MAC))
22#include <sys/time.h> // gettimeofday
23#include <time.h>
24#endif
25#if (defined(_DEBUG) && defined(_WIN32) && (_MSC_VER >= 1400))
26#include <stdio.h>
27#endif
niklase@google.com470e71d2011-07-07 08:21:25 +000028
pwestin@webrtc.org18530052012-07-03 10:41:54 +000029#include "system_wrappers/interface/tick_util.h"
30#include "system_wrappers/interface/trace.h"
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +000031
niklase@google.com470e71d2011-07-07 08:21:25 +000032#if (defined(_DEBUG) && defined(_WIN32) && (_MSC_VER >= 1400))
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000033#define DEBUG_PRINT(...) \
34 { \
35 char msg[256]; \
36 sprintf(msg, __VA_ARGS__); \
niklase@google.com470e71d2011-07-07 08:21:25 +000037 OutputDebugString(msg); \
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000038 }
niklase@google.com470e71d2011-07-07 08:21:25 +000039#else
40// special fix for visual 2003
41#define DEBUG_PRINT(exp) ((void)0)
42#endif // defined(_DEBUG) && defined(_WIN32)
43
niklase@google.com470e71d2011-07-07 08:21:25 +000044namespace webrtc {
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000045
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000046namespace ModuleRTPUtility {
47
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +000048enum {
49 kRtcpMinHeaderLength = 4,
50 kRtcpExpectedVersion = 2
51};
52
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000053/*
54 * Time routines.
55 */
56
pbos@webrtc.org2f446732013-04-08 11:08:41 +000057uint32_t GetCurrentRTP(Clock* clock, uint32_t freq) {
henrike@webrtc.orgf5da4da2012-02-15 23:54:59 +000058 const bool use_global_clock = (clock == NULL);
stefan@webrtc.org20ed36d2013-01-17 14:01:20 +000059 Clock* local_clock = clock;
henrike@webrtc.orgf5da4da2012-02-15 23:54:59 +000060 if (use_global_clock) {
stefan@webrtc.org20ed36d2013-01-17 14:01:20 +000061 local_clock = Clock::GetRealTimeClock();
henrike@webrtc.orgf5da4da2012-02-15 23:54:59 +000062 }
pbos@webrtc.org2f446732013-04-08 11:08:41 +000063 uint32_t secs = 0, frac = 0;
stefan@webrtc.org20ed36d2013-01-17 14:01:20 +000064 local_clock->CurrentNtp(secs, frac);
henrike@webrtc.orgf5da4da2012-02-15 23:54:59 +000065 if (use_global_clock) {
66 delete local_clock;
67 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000068 return ConvertNTPTimeToRTP(secs, frac, freq);
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000069}
70
pbos@webrtc.org2f446732013-04-08 11:08:41 +000071uint32_t ConvertNTPTimeToRTP(uint32_t NTPsec, uint32_t NTPfrac, uint32_t freq) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000072 float ftemp = (float)NTPfrac / (float)NTP_FRAC;
pbos@webrtc.org2f446732013-04-08 11:08:41 +000073 uint32_t tmp = (uint32_t)(ftemp * freq);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000074 return NTPsec * freq + tmp;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000075}
76
marpan@webrtc.org57353a32011-12-16 17:21:09 +000077bool OldTimestamp(uint32_t newTimestamp,
78 uint32_t existingTimestamp,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000079 bool* wrapped) {
80 bool tmpWrapped =
81 (newTimestamp < 0x0000ffff && existingTimestamp > 0xffff0000) ||
82 (newTimestamp > 0xffff0000 && existingTimestamp < 0x0000ffff);
83 *wrapped = tmpWrapped;
84 if (existingTimestamp > newTimestamp && !tmpWrapped) {
85 return true;
86 } else if (existingTimestamp <= newTimestamp && !tmpWrapped) {
87 return false;
88 } else if (existingTimestamp < newTimestamp && tmpWrapped) {
89 return true;
90 } else {
91 return false;
92 }
marpan@webrtc.org57353a32011-12-16 17:21:09 +000093}
94
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000095/*
96 * Misc utility routines
97 */
98
pbos@webrtc.org2f446732013-04-08 11:08:41 +000099const uint8_t* GetPayloadData(const WebRtcRTPHeader* rtp_header,
100 const uint8_t* packet) {
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +0000101 return packet + rtp_header->header.headerLength;
102}
103
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000104uint16_t GetPayloadDataLength(const WebRtcRTPHeader* rtp_header,
105 const uint16_t packet_length) {
106 uint16_t length = packet_length - rtp_header->header.paddingLength -
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +0000107 rtp_header->header.headerLength;
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000108 return static_cast<uint16_t>(length);
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +0000109}
110
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000111#if defined(_WIN32)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000112bool StringCompare(const char* str1, const char* str2,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000113 const uint32_t length) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000114 return (_strnicmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000115}
116#elif defined(WEBRTC_LINUX) || defined(WEBRTC_MAC)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000117bool StringCompare(const char* str1, const char* str2,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000118 const uint32_t length) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000119 return (strncasecmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000120}
121#endif
niklase@google.com470e71d2011-07-07 08:21:25 +0000122
123#if !defined(WEBRTC_LITTLE_ENDIAN) && !defined(WEBRTC_BIG_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000124#error Either WEBRTC_LITTLE_ENDIAN or WEBRTC_BIG_ENDIAN must be defined
niklase@google.com470e71d2011-07-07 08:21:25 +0000125#endif
126
127/* for RTP/RTCP
128 All integer fields are carried in network byte order, that is, most
129 significant byte (octet) first. AKA big-endian.
130*/
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000131void AssignUWord32ToBuffer(uint8_t* dataBuffer, uint32_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000132#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000133 dataBuffer[0] = static_cast<uint8_t>(value >> 24);
134 dataBuffer[1] = static_cast<uint8_t>(value >> 16);
135 dataBuffer[2] = static_cast<uint8_t>(value >> 8);
136 dataBuffer[3] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000137#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000138 uint32_t* ptr = reinterpret_cast<uint32_t*>(dataBuffer);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000139 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000140#endif
141}
142
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000143void AssignUWord24ToBuffer(uint8_t* dataBuffer, uint32_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000144#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000145 dataBuffer[0] = static_cast<uint8_t>(value >> 16);
146 dataBuffer[1] = static_cast<uint8_t>(value >> 8);
147 dataBuffer[2] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000148#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000149 dataBuffer[0] = static_cast<uint8_t>(value);
150 dataBuffer[1] = static_cast<uint8_t>(value >> 8);
151 dataBuffer[2] = static_cast<uint8_t>(value >> 16);
niklase@google.com470e71d2011-07-07 08:21:25 +0000152#endif
153}
154
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000155void AssignUWord16ToBuffer(uint8_t* dataBuffer, uint16_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000156#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000157 dataBuffer[0] = static_cast<uint8_t>(value >> 8);
158 dataBuffer[1] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000159#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000160 uint16_t* ptr = reinterpret_cast<uint16_t*>(dataBuffer);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000161 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000162#endif
163}
164
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000165uint16_t BufferToUWord16(const uint8_t* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000166#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000167 return (dataBuffer[0] << 8) + dataBuffer[1];
niklase@google.com470e71d2011-07-07 08:21:25 +0000168#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000169 return *reinterpret_cast<const uint16_t*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000170#endif
171}
172
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000173uint32_t BufferToUWord24(const uint8_t* dataBuffer) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000174 return (dataBuffer[0] << 16) + (dataBuffer[1] << 8) + dataBuffer[2];
niklase@google.com470e71d2011-07-07 08:21:25 +0000175}
176
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000177uint32_t BufferToUWord32(const uint8_t* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000178#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000179 return (dataBuffer[0] << 24) + (dataBuffer[1] << 16) + (dataBuffer[2] << 8) +
180 dataBuffer[3];
niklase@google.com470e71d2011-07-07 08:21:25 +0000181#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000182 return *reinterpret_cast<const uint32_t*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000183#endif
184}
185
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000186uint32_t pow2(uint8_t exp) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000187 return 1 << exp;
niklase@google.com470e71d2011-07-07 08:21:25 +0000188}
189
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000190void RTPPayload::SetType(RtpVideoCodecTypes videoType) {
191 type = videoType;
niklase@google.com470e71d2011-07-07 08:21:25 +0000192
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000193 switch (type) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000194 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000195 break;
196 case kRtpVp8Video: {
197 info.VP8.nonReferenceFrame = false;
198 info.VP8.beginningOfPartition = false;
199 info.VP8.partitionID = 0;
200 info.VP8.hasPictureID = false;
201 info.VP8.hasTl0PicIdx = false;
202 info.VP8.hasTID = false;
203 info.VP8.hasKeyIdx = false;
204 info.VP8.pictureID = -1;
205 info.VP8.tl0PicIdx = -1;
206 info.VP8.tID = -1;
207 info.VP8.layerSync = false;
208 info.VP8.frameWidth = 0;
209 info.VP8.frameHeight = 0;
210 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000211 }
212 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000213 break;
214 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000215}
216
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000217RTPHeaderParser::RTPHeaderParser(const uint8_t* rtpData,
218 const uint32_t rtpDataLength)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000219 : _ptrRTPDataBegin(rtpData),
220 _ptrRTPDataEnd(rtpData ? (rtpData + rtpDataLength) : NULL) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000221}
222
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000223RTPHeaderParser::~RTPHeaderParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000224}
225
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000226bool RTPHeaderParser::RTCP() const {
227 // 72 to 76 is reserved for RTP
228 // 77 to 79 is not reserver but they are not assigned we will block them
229 // for RTCP 200 SR == marker bit + 72
230 // for RTCP 204 APP == marker bit + 76
231 /*
232 * RTCP
233 *
234 * FIR full INTRA-frame request 192 [RFC2032] supported
235 * NACK negative acknowledgement 193 [RFC2032]
236 * IJ Extended inter-arrival jitter report 195 [RFC-ietf-avt-rtp-toff
237 * set-07.txt] http://tools.ietf.org/html/draft-ietf-avt-rtp-toffset-07
238 * SR sender report 200 [RFC3551] supported
239 * RR receiver report 201 [RFC3551] supported
240 * SDES source description 202 [RFC3551] supported
241 * BYE goodbye 203 [RFC3551] supported
242 * APP application-defined 204 [RFC3551] ignored
243 * RTPFB Transport layer FB message 205 [RFC4585] supported
244 * PSFB Payload-specific FB message 206 [RFC4585] supported
245 * XR extended report 207 [RFC3611] supported
246 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000247
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000248 /* 205 RFC 5104
249 * FMT 1 NACK supported
250 * FMT 2 reserved
251 * FMT 3 TMMBR supported
252 * FMT 4 TMMBN supported
253 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000254
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000255 /* 206 RFC 5104
256 * FMT 1: Picture Loss Indication (PLI) supported
257 * FMT 2: Slice Lost Indication (SLI)
258 * FMT 3: Reference Picture Selection Indication (RPSI)
259 * FMT 4: Full Intra Request (FIR) Command supported
260 * FMT 5: Temporal-Spatial Trade-off Request (TSTR)
261 * FMT 6: Temporal-Spatial Trade-off Notification (TSTN)
262 * FMT 7: Video Back Channel Message (VBCM)
263 * FMT 15: Application layer FB message
264 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000265
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +0000266 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
267 if (length < kRtcpMinHeaderLength) {
268 return false;
269 }
270
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000271 const uint8_t V = _ptrRTPDataBegin[0] >> 6;
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +0000272 if (V != kRtcpExpectedVersion) {
273 return false;
274 }
275
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000276 const uint8_t payloadType = _ptrRTPDataBegin[1];
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000277 bool RTCP = false;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000278 switch (payloadType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000279 case 192:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000280 RTCP = true;
281 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000282 case 193:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000283 // not supported
284 // pass through and check for a potential RTP packet
285 break;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000286 case 195:
niklase@google.com470e71d2011-07-07 08:21:25 +0000287 case 200:
288 case 201:
289 case 202:
290 case 203:
291 case 204:
292 case 205:
293 case 206:
294 case 207:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000295 RTCP = true;
296 break;
297 }
298 return RTCP;
niklase@google.com470e71d2011-07-07 08:21:25 +0000299}
300
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000301bool RTPHeaderParser::Parse(WebRtcRTPHeader& parsedPacket,
302 RtpHeaderExtensionMap* ptrExtensionMap) const {
303 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
niklase@google.com470e71d2011-07-07 08:21:25 +0000304
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000305 if (length < 12) {
306 return false;
307 }
308
309 // Version
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000310 const uint8_t V = _ptrRTPDataBegin[0] >> 6;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000311 // Padding
312 const bool P = ((_ptrRTPDataBegin[0] & 0x20) == 0) ? false : true;
313 // eXtension
314 const bool X = ((_ptrRTPDataBegin[0] & 0x10) == 0) ? false : true;
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000315 const uint8_t CC = _ptrRTPDataBegin[0] & 0x0f;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000316 const bool M = ((_ptrRTPDataBegin[1] & 0x80) == 0) ? false : true;
317
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000318 const uint8_t PT = _ptrRTPDataBegin[1] & 0x7f;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000319
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000320 const uint16_t sequenceNumber = (_ptrRTPDataBegin[2] << 8) +
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000321 _ptrRTPDataBegin[3];
322
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000323 const uint8_t* ptr = &_ptrRTPDataBegin[4];
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000324
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000325 uint32_t RTPTimestamp = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000326 RTPTimestamp += *ptr++ << 16;
327 RTPTimestamp += *ptr++ << 8;
328 RTPTimestamp += *ptr++;
329
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000330 uint32_t SSRC = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000331 SSRC += *ptr++ << 16;
332 SSRC += *ptr++ << 8;
333 SSRC += *ptr++;
334
335 if (V != 2) {
336 return false;
337 }
338
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000339 const uint8_t CSRCocts = CC * 4;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000340
341 if ((ptr + CSRCocts) > _ptrRTPDataEnd) {
342 return false;
343 }
344
345 parsedPacket.header.markerBit = M;
346 parsedPacket.header.payloadType = PT;
347 parsedPacket.header.sequenceNumber = sequenceNumber;
348 parsedPacket.header.timestamp = RTPTimestamp;
349 parsedPacket.header.ssrc = SSRC;
350 parsedPacket.header.numCSRCs = CC;
351 parsedPacket.header.paddingLength = P ? *(_ptrRTPDataEnd - 1) : 0;
352
353 for (unsigned int i = 0; i < CC; ++i) {
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000354 uint32_t CSRC = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000355 CSRC += *ptr++ << 16;
356 CSRC += *ptr++ << 8;
357 CSRC += *ptr++;
358 parsedPacket.header.arrOfCSRCs[i] = CSRC;
359 }
360 parsedPacket.type.Audio.numEnergy = parsedPacket.header.numCSRCs;
361
362 parsedPacket.header.headerLength = 12 + CSRCocts;
363
364 // If in effect, MAY be omitted for those packets for which the offset
365 // is zero.
366 parsedPacket.extension.transmissionTimeOffset = 0;
367
368 if (X) {
369 /* RTP header extension, RFC 3550.
370 0 1 2 3
371 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
372 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
373 | defined by profile | length |
374 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
375 | header extension |
376 | .... |
377 */
378 const ptrdiff_t remain = _ptrRTPDataEnd - ptr;
379 if (remain < 4) {
380 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000381 }
382
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000383 parsedPacket.header.headerLength += 4;
niklase@google.com470e71d2011-07-07 08:21:25 +0000384
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000385 uint16_t definedByProfile = *ptr++ << 8;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000386 definedByProfile += *ptr++;
niklase@google.com470e71d2011-07-07 08:21:25 +0000387
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000388 uint16_t XLen = *ptr++ << 8;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000389 XLen += *ptr++; // in 32 bit words
390 XLen *= 4; // in octs
niklase@google.com470e71d2011-07-07 08:21:25 +0000391
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000392 if (remain < (4 + XLen)) {
393 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000394 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000395 if (definedByProfile == RTP_ONE_BYTE_HEADER_EXTENSION) {
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000396 const uint8_t* ptrRTPDataExtensionEnd = ptr + XLen;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000397 ParseOneByteExtensionHeader(parsedPacket,
398 ptrExtensionMap,
399 ptrRTPDataExtensionEnd,
400 ptr);
niklase@google.com470e71d2011-07-07 08:21:25 +0000401 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000402 parsedPacket.header.headerLength += XLen;
403 }
404 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000405}
406
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000407void RTPHeaderParser::ParseOneByteExtensionHeader(
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000408 WebRtcRTPHeader& parsedPacket,
409 const RtpHeaderExtensionMap* ptrExtensionMap,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000410 const uint8_t* ptrRTPDataExtensionEnd,
411 const uint8_t* ptr) const {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000412 if (!ptrExtensionMap) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000413 return;
414 }
415
416 while (ptrRTPDataExtensionEnd - ptr > 0) {
417 // 0
418 // 0 1 2 3 4 5 6 7
419 // +-+-+-+-+-+-+-+-+
420 // | ID | len |
421 // +-+-+-+-+-+-+-+-+
422
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000423 const uint8_t id = (*ptr & 0xf0) >> 4;
424 const uint8_t len = (*ptr & 0x0f);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000425 ptr++;
426
427 if (id == 15) {
428 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
429 "Ext id: 15 encountered, parsing terminated.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000430 return;
431 }
432
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000433 RTPExtensionType type;
434 if (ptrExtensionMap->GetType(id, &type) != 0) {
435 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
436 "Failed to find extension id: %d", id);
437 return;
438 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000439
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000440 switch (type) {
441 case kRtpExtensionTransmissionTimeOffset: {
442 if (len != 2) {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000443 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000444 "Incorrect transmission time offset len: %d", len);
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000445 return;
446 }
447 // 0 1 2 3
448 // 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
449 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
450 // | ID | len=2 | transmission offset |
451 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
452
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000453 int32_t transmissionTimeOffset = *ptr++ << 16;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000454 transmissionTimeOffset += *ptr++ << 8;
455 transmissionTimeOffset += *ptr++;
456 parsedPacket.extension.transmissionTimeOffset = transmissionTimeOffset;
asapersson@webrtc.orgd2e67792012-06-28 07:53:15 +0000457 if (transmissionTimeOffset & 0x800000) {
458 // Negative offset, correct sign for Word24 to Word32.
459 parsedPacket.extension.transmissionTimeOffset |= 0xFF000000;
460 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000461 break;
462 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000463 case kRtpExtensionAudioLevel: {
464 // --- Only used for debugging ---
465 // 0 1 2 3
466 // 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
467 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
468 // | ID | len=0 |V| level | 0x00 | 0x00 |
469 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
470 //
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000471
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000472 // Parse out the fields but only use it for debugging for now.
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000473 // const uint8_t V = (*ptr & 0x80) >> 7;
474 // const uint8_t level = (*ptr & 0x7f);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000475 // DEBUG_PRINT("RTP_AUDIO_LEVEL_UNIQUE_ID: ID=%u, len=%u, V=%u,
476 // level=%u", ID, len, V, level);
pwestin@webrtc.org6c1d4152012-01-04 17:04:51 +0000477 break;
478 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000479 default: {
mflodman@webrtc.orgba853c92012-08-10 14:30:53 +0000480 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000481 "Extension type not implemented.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000482 return;
483 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000484 }
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000485 uint8_t num_bytes = ParsePaddingBytes(ptrRTPDataExtensionEnd, ptr);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000486 ptr += num_bytes;
487 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000488}
489
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000490uint8_t RTPHeaderParser::ParsePaddingBytes(
491 const uint8_t* ptrRTPDataExtensionEnd,
492 const uint8_t* ptr) const {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000493
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000494 uint8_t num_zero_bytes = 0;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000495 while (ptrRTPDataExtensionEnd - ptr > 0) {
496 if (*ptr != 0) {
497 return num_zero_bytes;
498 }
499 ptr++;
500 num_zero_bytes++;
501 }
502 return num_zero_bytes;
503}
504
niklase@google.com470e71d2011-07-07 08:21:25 +0000505// RTP payload parser
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000506RTPPayloadParser::RTPPayloadParser(const RtpVideoCodecTypes videoType,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000507 const uint8_t* payloadData,
508 uint16_t payloadDataLength,
509 int32_t id)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000510 :
511 _id(id),
512 _dataPtr(payloadData),
513 _dataLength(payloadDataLength),
514 _videoType(videoType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000515}
516
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000517RTPPayloadParser::~RTPPayloadParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000518}
519
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000520bool RTPPayloadParser::Parse(RTPPayload& parsedPacket) const {
521 parsedPacket.SetType(_videoType);
niklase@google.com470e71d2011-07-07 08:21:25 +0000522
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000523 switch (_videoType) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000524 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000525 return ParseGeneric(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000526 case kRtpVp8Video:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000527 return ParseVP8(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000528 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000529 return false;
530 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000531}
532
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000533bool RTPPayloadParser::ParseGeneric(RTPPayload& /*parsedPacket*/) const {
534 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000535}
536
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000537//
538// VP8 format:
539//
540// Payload descriptor
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000541// 0 1 2 3 4 5 6 7
542// +-+-+-+-+-+-+-+-+
543// |X|R|N|S|PartID | (REQUIRED)
544// +-+-+-+-+-+-+-+-+
545// X: |I|L|T|K| RSV | (OPTIONAL)
546// +-+-+-+-+-+-+-+-+
547// I: | PictureID | (OPTIONAL)
548// +-+-+-+-+-+-+-+-+
549// L: | TL0PICIDX | (OPTIONAL)
550// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.orgeda86dc2011-12-13 14:11:06 +0000551// T/K: |TID:Y| KEYIDX | (OPTIONAL)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000552// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000553//
554// Payload header (considered part of the actual payload, sent to decoder)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000555// 0 1 2 3 4 5 6 7
556// +-+-+-+-+-+-+-+-+
557// |Size0|H| VER |P|
558// +-+-+-+-+-+-+-+-+
559// | ... |
560// + +
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000561
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000562bool RTPPayloadParser::ParseVP8(RTPPayload& parsedPacket) const {
563 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000564 const uint8_t* dataPtr = _dataPtr;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000565 int dataLength = _dataLength;
niklase@google.com470e71d2011-07-07 08:21:25 +0000566
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000567 // Parse mandatory first byte of payload descriptor
568 bool extension = (*dataPtr & 0x80) ? true : false; // X bit
569 vp8->nonReferenceFrame = (*dataPtr & 0x20) ? true : false; // N bit
570 vp8->beginningOfPartition = (*dataPtr & 0x10) ? true : false; // S bit
571 vp8->partitionID = (*dataPtr & 0x0F); // PartID field
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000572
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000573 if (vp8->partitionID > 8) {
574 // Weak check for corrupt data: PartID MUST NOT be larger than 8.
575 return false;
576 }
andrew@webrtc.org7fe219f2012-02-01 02:40:37 +0000577
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000578 // Advance dataPtr and decrease remaining payload size
579 dataPtr++;
580 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000581
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000582 if (extension) {
583 const int parsedBytes = ParseVP8Extension(vp8, dataPtr, dataLength);
584 if (parsedBytes < 0) return false;
585 dataPtr += parsedBytes;
586 dataLength -= parsedBytes;
587 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000588
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000589 if (dataLength <= 0) {
590 WEBRTC_TRACE(kTraceError, kTraceRtpRtcp, _id,
591 "Error parsing VP8 payload descriptor; payload too short");
592 return false;
593 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000594
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000595 // Read P bit from payload header (only at beginning of first partition)
596 if (dataLength > 0 && vp8->beginningOfPartition && vp8->partitionID == 0) {
597 parsedPacket.frameType = (*dataPtr & 0x01) ? kPFrame : kIFrame;
598 } else {
599 parsedPacket.frameType = kPFrame;
600 }
601 if (0 != ParseVP8FrameSize(parsedPacket, dataPtr, dataLength)) {
602 return false;
603 }
604 parsedPacket.info.VP8.data = dataPtr;
605 parsedPacket.info.VP8.dataLength = dataLength;
606 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000607}
608
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000609int RTPPayloadParser::ParseVP8FrameSize(RTPPayload& parsedPacket,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000610 const uint8_t* dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000611 int dataLength) const {
612 if (parsedPacket.frameType != kIFrame) {
613 // Included in payload header for I-frames.
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000614 return 0;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000615 }
616 if (dataLength < 10) {
617 // For an I-frame we should always have the uncompressed VP8 header
618 // in the beginning of the partition.
619 return -1;
620 }
621 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
622 vp8->frameWidth = ((dataPtr[7] << 8) + dataPtr[6]) & 0x3FFF;
623 vp8->frameHeight = ((dataPtr[9] << 8) + dataPtr[8]) & 0x3FFF;
624 return 0;
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000625}
626
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000627int RTPPayloadParser::ParseVP8Extension(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000628 const uint8_t* dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000629 int dataLength) const {
630 int parsedBytes = 0;
631 if (dataLength <= 0) return -1;
632 // Optional X field is present
633 vp8->hasPictureID = (*dataPtr & 0x80) ? true : false; // I bit
634 vp8->hasTl0PicIdx = (*dataPtr & 0x40) ? true : false; // L bit
635 vp8->hasTID = (*dataPtr & 0x20) ? true : false; // T bit
636 vp8->hasKeyIdx = (*dataPtr & 0x10) ? true : false; // K bit
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000637
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000638 // Advance dataPtr and decrease remaining payload size
639 dataPtr++;
640 parsedBytes++;
641 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000642
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000643 if (vp8->hasPictureID) {
644 if (ParseVP8PictureID(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
645 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000646 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000647 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000648
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000649 if (vp8->hasTl0PicIdx) {
650 if (ParseVP8Tl0PicIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
651 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000652 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000653 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000654
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000655 if (vp8->hasTID || vp8->hasKeyIdx) {
656 if (ParseVP8TIDAndKeyIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
657 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000658 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000659 }
660 return parsedBytes;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000661}
662
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000663int RTPPayloadParser::ParseVP8PictureID(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000664 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000665 int* dataLength,
666 int* parsedBytes) const {
667 if (*dataLength <= 0) return -1;
668 vp8->pictureID = (**dataPtr & 0x7F);
669 if (**dataPtr & 0x80) {
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000670 (*dataPtr)++;
671 (*parsedBytes)++;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000672 if (--(*dataLength) <= 0) return -1;
673 // PictureID is 15 bits
674 vp8->pictureID = (vp8->pictureID << 8) +** dataPtr;
675 }
676 (*dataPtr)++;
677 (*parsedBytes)++;
678 (*dataLength)--;
679 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000680}
681
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000682int RTPPayloadParser::ParseVP8Tl0PicIdx(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000683 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000684 int* dataLength,
685 int* parsedBytes) const {
686 if (*dataLength <= 0) return -1;
687 vp8->tl0PicIdx = **dataPtr;
688 (*dataPtr)++;
689 (*parsedBytes)++;
690 (*dataLength)--;
691 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000692}
693
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000694int RTPPayloadParser::ParseVP8TIDAndKeyIdx(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000695 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000696 int* dataLength,
697 int* parsedBytes) const {
698 if (*dataLength <= 0) return -1;
699 if (vp8->hasTID) {
700 vp8->tID = ((**dataPtr >> 6) & 0x03);
701 vp8->layerSync = (**dataPtr & 0x20) ? true : false; // Y bit
702 }
703 if (vp8->hasKeyIdx) {
704 vp8->keyIdx = (**dataPtr & 0x1F);
705 }
706 (*dataPtr)++;
707 (*parsedBytes)++;
708 (*dataLength)--;
709 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000710}
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000711
712} // namespace ModuleRTPUtility
713
714} // namespace webrtc