blob: 08743b3b2aff3c8dfc027f0cf6f4e7f17427f838 [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
stefan@webrtc.org20ed36d2013-01-17 14:01:20 +000057WebRtc_UWord32 GetCurrentRTP(Clock* clock, WebRtc_UWord32 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 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000063 WebRtc_UWord32 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
71WebRtc_UWord32 ConvertNTPTimeToRTP(WebRtc_UWord32 NTPsec,
72 WebRtc_UWord32 NTPfrac,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000073 WebRtc_UWord32 freq) {
74 float ftemp = (float)NTPfrac / (float)NTP_FRAC;
75 WebRtc_UWord32 tmp = (WebRtc_UWord32)(ftemp * freq);
76 return NTPsec * freq + tmp;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000077}
78
79WebRtc_UWord32 ConvertNTPTimeToMS(WebRtc_UWord32 NTPsec,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000080 WebRtc_UWord32 NTPfrac) {
81 int freq = 1000;
82 float ftemp = (float)NTPfrac / (float)NTP_FRAC;
83 WebRtc_UWord32 tmp = (WebRtc_UWord32)(ftemp * freq);
84 WebRtc_UWord32 MStime = NTPsec * freq + tmp;
85 return MStime;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000086}
87
marpan@webrtc.org57353a32011-12-16 17:21:09 +000088bool OldTimestamp(uint32_t newTimestamp,
89 uint32_t existingTimestamp,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +000090 bool* wrapped) {
91 bool tmpWrapped =
92 (newTimestamp < 0x0000ffff && existingTimestamp > 0xffff0000) ||
93 (newTimestamp > 0xffff0000 && existingTimestamp < 0x0000ffff);
94 *wrapped = tmpWrapped;
95 if (existingTimestamp > newTimestamp && !tmpWrapped) {
96 return true;
97 } else if (existingTimestamp <= newTimestamp && !tmpWrapped) {
98 return false;
99 } else if (existingTimestamp < newTimestamp && tmpWrapped) {
100 return true;
101 } else {
102 return false;
103 }
marpan@webrtc.org57353a32011-12-16 17:21:09 +0000104}
105
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000106/*
107 * Misc utility routines
108 */
109
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +0000110const WebRtc_UWord8* GetPayloadData(const WebRtcRTPHeader* rtp_header,
111 const WebRtc_UWord8* packet) {
112 return packet + rtp_header->header.headerLength;
113}
114
115WebRtc_UWord16 GetPayloadDataLength(const WebRtcRTPHeader* rtp_header,
116 const WebRtc_UWord16 packet_length) {
117 WebRtc_UWord16 length = packet_length - rtp_header->header.paddingLength -
118 rtp_header->header.headerLength;
119 return static_cast<WebRtc_UWord16>(length);
120}
121
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000122#if defined(_WIN32)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000123bool StringCompare(const char* str1, const char* str2,
124 const WebRtc_UWord32 length) {
125 return (_strnicmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000126}
127#elif defined(WEBRTC_LINUX) || defined(WEBRTC_MAC)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000128bool StringCompare(const char* str1, const char* str2,
129 const WebRtc_UWord32 length) {
130 return (strncasecmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000131}
132#endif
niklase@google.com470e71d2011-07-07 08:21:25 +0000133
134#if !defined(WEBRTC_LITTLE_ENDIAN) && !defined(WEBRTC_BIG_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000135#error Either WEBRTC_LITTLE_ENDIAN or WEBRTC_BIG_ENDIAN must be defined
niklase@google.com470e71d2011-07-07 08:21:25 +0000136#endif
137
138/* for RTP/RTCP
139 All integer fields are carried in network byte order, that is, most
140 significant byte (octet) first. AKA big-endian.
141*/
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000142void AssignUWord32ToBuffer(WebRtc_UWord8* dataBuffer, WebRtc_UWord32 value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000143#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000144 dataBuffer[0] = static_cast<WebRtc_UWord8>(value >> 24);
145 dataBuffer[1] = static_cast<WebRtc_UWord8>(value >> 16);
146 dataBuffer[2] = static_cast<WebRtc_UWord8>(value >> 8);
147 dataBuffer[3] = static_cast<WebRtc_UWord8>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000148#else
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000149 WebRtc_UWord32* ptr = reinterpret_cast<WebRtc_UWord32*>(dataBuffer);
150 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000151#endif
152}
153
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000154void AssignUWord24ToBuffer(WebRtc_UWord8* dataBuffer, WebRtc_UWord32 value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000155#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000156 dataBuffer[0] = static_cast<WebRtc_UWord8>(value >> 16);
157 dataBuffer[1] = static_cast<WebRtc_UWord8>(value >> 8);
158 dataBuffer[2] = static_cast<WebRtc_UWord8>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000159#else
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000160 dataBuffer[0] = static_cast<WebRtc_UWord8>(value);
161 dataBuffer[1] = static_cast<WebRtc_UWord8>(value >> 8);
162 dataBuffer[2] = static_cast<WebRtc_UWord8>(value >> 16);
niklase@google.com470e71d2011-07-07 08:21:25 +0000163#endif
164}
165
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000166void AssignUWord16ToBuffer(WebRtc_UWord8* dataBuffer, WebRtc_UWord16 value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000167#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000168 dataBuffer[0] = static_cast<WebRtc_UWord8>(value >> 8);
169 dataBuffer[1] = static_cast<WebRtc_UWord8>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000170#else
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000171 WebRtc_UWord16* ptr = reinterpret_cast<WebRtc_UWord16*>(dataBuffer);
172 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000173#endif
174}
175
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000176WebRtc_UWord16 BufferToUWord16(const WebRtc_UWord8* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000177#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000178 return (dataBuffer[0] << 8) + dataBuffer[1];
niklase@google.com470e71d2011-07-07 08:21:25 +0000179#else
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000180 return *reinterpret_cast<const WebRtc_UWord16*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000181#endif
182}
183
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000184WebRtc_UWord32 BufferToUWord24(const WebRtc_UWord8* dataBuffer) {
185 return (dataBuffer[0] << 16) + (dataBuffer[1] << 8) + dataBuffer[2];
niklase@google.com470e71d2011-07-07 08:21:25 +0000186}
187
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000188WebRtc_UWord32 BufferToUWord32(const WebRtc_UWord8* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000189#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000190 return (dataBuffer[0] << 24) + (dataBuffer[1] << 16) + (dataBuffer[2] << 8) +
191 dataBuffer[3];
niklase@google.com470e71d2011-07-07 08:21:25 +0000192#else
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000193 return *reinterpret_cast<const WebRtc_UWord32*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000194#endif
195}
196
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000197WebRtc_UWord32 pow2(WebRtc_UWord8 exp) {
198 return 1 << exp;
niklase@google.com470e71d2011-07-07 08:21:25 +0000199}
200
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000201void RTPPayload::SetType(RtpVideoCodecTypes videoType) {
202 type = videoType;
niklase@google.com470e71d2011-07-07 08:21:25 +0000203
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000204 switch (type) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000205 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000206 break;
207 case kRtpVp8Video: {
208 info.VP8.nonReferenceFrame = false;
209 info.VP8.beginningOfPartition = false;
210 info.VP8.partitionID = 0;
211 info.VP8.hasPictureID = false;
212 info.VP8.hasTl0PicIdx = false;
213 info.VP8.hasTID = false;
214 info.VP8.hasKeyIdx = false;
215 info.VP8.pictureID = -1;
216 info.VP8.tl0PicIdx = -1;
217 info.VP8.tID = -1;
218 info.VP8.layerSync = false;
219 info.VP8.frameWidth = 0;
220 info.VP8.frameHeight = 0;
221 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000222 }
223 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000224 break;
225 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000226}
227
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000228RTPHeaderParser::RTPHeaderParser(const WebRtc_UWord8* rtpData,
229 const WebRtc_UWord32 rtpDataLength)
230 : _ptrRTPDataBegin(rtpData),
231 _ptrRTPDataEnd(rtpData ? (rtpData + rtpDataLength) : NULL) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000232}
233
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000234RTPHeaderParser::~RTPHeaderParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000235}
236
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000237bool RTPHeaderParser::RTCP() const {
238 // 72 to 76 is reserved for RTP
239 // 77 to 79 is not reserver but they are not assigned we will block them
240 // for RTCP 200 SR == marker bit + 72
241 // for RTCP 204 APP == marker bit + 76
242 /*
243 * RTCP
244 *
245 * FIR full INTRA-frame request 192 [RFC2032] supported
246 * NACK negative acknowledgement 193 [RFC2032]
247 * IJ Extended inter-arrival jitter report 195 [RFC-ietf-avt-rtp-toff
248 * set-07.txt] http://tools.ietf.org/html/draft-ietf-avt-rtp-toffset-07
249 * SR sender report 200 [RFC3551] supported
250 * RR receiver report 201 [RFC3551] supported
251 * SDES source description 202 [RFC3551] supported
252 * BYE goodbye 203 [RFC3551] supported
253 * APP application-defined 204 [RFC3551] ignored
254 * RTPFB Transport layer FB message 205 [RFC4585] supported
255 * PSFB Payload-specific FB message 206 [RFC4585] supported
256 * XR extended report 207 [RFC3611] supported
257 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000258
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000259 /* 205 RFC 5104
260 * FMT 1 NACK supported
261 * FMT 2 reserved
262 * FMT 3 TMMBR supported
263 * FMT 4 TMMBN supported
264 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000265
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000266 /* 206 RFC 5104
267 * FMT 1: Picture Loss Indication (PLI) supported
268 * FMT 2: Slice Lost Indication (SLI)
269 * FMT 3: Reference Picture Selection Indication (RPSI)
270 * FMT 4: Full Intra Request (FIR) Command supported
271 * FMT 5: Temporal-Spatial Trade-off Request (TSTR)
272 * FMT 6: Temporal-Spatial Trade-off Notification (TSTN)
273 * FMT 7: Video Back Channel Message (VBCM)
274 * FMT 15: Application layer FB message
275 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000276
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +0000277 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
278 if (length < kRtcpMinHeaderLength) {
279 return false;
280 }
281
282 const WebRtc_UWord8 V = _ptrRTPDataBegin[0] >> 6;
283 if (V != kRtcpExpectedVersion) {
284 return false;
285 }
286
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000287 const WebRtc_UWord8 payloadType = _ptrRTPDataBegin[1];
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000288 bool RTCP = false;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000289 switch (payloadType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000290 case 192:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000291 RTCP = true;
292 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000293 case 193:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000294 // not supported
295 // pass through and check for a potential RTP packet
296 break;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000297 case 195:
niklase@google.com470e71d2011-07-07 08:21:25 +0000298 case 200:
299 case 201:
300 case 202:
301 case 203:
302 case 204:
303 case 205:
304 case 206:
305 case 207:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000306 RTCP = true;
307 break;
308 }
309 return RTCP;
niklase@google.com470e71d2011-07-07 08:21:25 +0000310}
311
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000312bool RTPHeaderParser::Parse(WebRtcRTPHeader& parsedPacket,
313 RtpHeaderExtensionMap* ptrExtensionMap) const {
314 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
niklase@google.com470e71d2011-07-07 08:21:25 +0000315
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000316 if (length < 12) {
317 return false;
318 }
319
320 // Version
321 const WebRtc_UWord8 V = _ptrRTPDataBegin[0] >> 6;
322 // Padding
323 const bool P = ((_ptrRTPDataBegin[0] & 0x20) == 0) ? false : true;
324 // eXtension
325 const bool X = ((_ptrRTPDataBegin[0] & 0x10) == 0) ? false : true;
326 const WebRtc_UWord8 CC = _ptrRTPDataBegin[0] & 0x0f;
327 const bool M = ((_ptrRTPDataBegin[1] & 0x80) == 0) ? false : true;
328
329 const WebRtc_UWord8 PT = _ptrRTPDataBegin[1] & 0x7f;
330
331 const WebRtc_UWord16 sequenceNumber = (_ptrRTPDataBegin[2] << 8) +
332 _ptrRTPDataBegin[3];
333
334 const WebRtc_UWord8* ptr = &_ptrRTPDataBegin[4];
335
336 WebRtc_UWord32 RTPTimestamp = *ptr++ << 24;
337 RTPTimestamp += *ptr++ << 16;
338 RTPTimestamp += *ptr++ << 8;
339 RTPTimestamp += *ptr++;
340
341 WebRtc_UWord32 SSRC = *ptr++ << 24;
342 SSRC += *ptr++ << 16;
343 SSRC += *ptr++ << 8;
344 SSRC += *ptr++;
345
346 if (V != 2) {
347 return false;
348 }
349
350 const WebRtc_UWord8 CSRCocts = CC * 4;
351
352 if ((ptr + CSRCocts) > _ptrRTPDataEnd) {
353 return false;
354 }
355
356 parsedPacket.header.markerBit = M;
357 parsedPacket.header.payloadType = PT;
358 parsedPacket.header.sequenceNumber = sequenceNumber;
359 parsedPacket.header.timestamp = RTPTimestamp;
360 parsedPacket.header.ssrc = SSRC;
361 parsedPacket.header.numCSRCs = CC;
362 parsedPacket.header.paddingLength = P ? *(_ptrRTPDataEnd - 1) : 0;
363
364 for (unsigned int i = 0; i < CC; ++i) {
365 WebRtc_UWord32 CSRC = *ptr++ << 24;
366 CSRC += *ptr++ << 16;
367 CSRC += *ptr++ << 8;
368 CSRC += *ptr++;
369 parsedPacket.header.arrOfCSRCs[i] = CSRC;
370 }
371 parsedPacket.type.Audio.numEnergy = parsedPacket.header.numCSRCs;
372
373 parsedPacket.header.headerLength = 12 + CSRCocts;
374
375 // If in effect, MAY be omitted for those packets for which the offset
376 // is zero.
377 parsedPacket.extension.transmissionTimeOffset = 0;
378
379 if (X) {
380 /* RTP header extension, RFC 3550.
381 0 1 2 3
382 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
383 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
384 | defined by profile | length |
385 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
386 | header extension |
387 | .... |
388 */
389 const ptrdiff_t remain = _ptrRTPDataEnd - ptr;
390 if (remain < 4) {
391 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000392 }
393
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000394 parsedPacket.header.headerLength += 4;
niklase@google.com470e71d2011-07-07 08:21:25 +0000395
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000396 WebRtc_UWord16 definedByProfile = *ptr++ << 8;
397 definedByProfile += *ptr++;
niklase@google.com470e71d2011-07-07 08:21:25 +0000398
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000399 WebRtc_UWord16 XLen = *ptr++ << 8;
400 XLen += *ptr++; // in 32 bit words
401 XLen *= 4; // in octs
niklase@google.com470e71d2011-07-07 08:21:25 +0000402
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000403 if (remain < (4 + XLen)) {
404 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000405 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000406 if (definedByProfile == RTP_ONE_BYTE_HEADER_EXTENSION) {
407 const WebRtc_UWord8* ptrRTPDataExtensionEnd = ptr + XLen;
408 ParseOneByteExtensionHeader(parsedPacket,
409 ptrExtensionMap,
410 ptrRTPDataExtensionEnd,
411 ptr);
niklase@google.com470e71d2011-07-07 08:21:25 +0000412 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000413 parsedPacket.header.headerLength += XLen;
414 }
415 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000416}
417
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000418void RTPHeaderParser::ParseOneByteExtensionHeader(
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000419 WebRtcRTPHeader& parsedPacket,
420 const RtpHeaderExtensionMap* ptrExtensionMap,
421 const WebRtc_UWord8* ptrRTPDataExtensionEnd,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000422 const WebRtc_UWord8* ptr) const {
423 if (!ptrExtensionMap) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000424 return;
425 }
426
427 while (ptrRTPDataExtensionEnd - ptr > 0) {
428 // 0
429 // 0 1 2 3 4 5 6 7
430 // +-+-+-+-+-+-+-+-+
431 // | ID | len |
432 // +-+-+-+-+-+-+-+-+
433
434 const WebRtc_UWord8 id = (*ptr & 0xf0) >> 4;
435 const WebRtc_UWord8 len = (*ptr & 0x0f);
436 ptr++;
437
438 if (id == 15) {
439 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
440 "Ext id: 15 encountered, parsing terminated.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000441 return;
442 }
443
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000444 RTPExtensionType type;
445 if (ptrExtensionMap->GetType(id, &type) != 0) {
446 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
447 "Failed to find extension id: %d", id);
448 return;
449 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000450
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000451 switch (type) {
452 case kRtpExtensionTransmissionTimeOffset: {
453 if (len != 2) {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000454 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000455 "Incorrect transmission time offset len: %d", len);
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000456 return;
457 }
458 // 0 1 2 3
459 // 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
460 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
461 // | ID | len=2 | transmission offset |
462 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
463
464 WebRtc_Word32 transmissionTimeOffset = *ptr++ << 16;
465 transmissionTimeOffset += *ptr++ << 8;
466 transmissionTimeOffset += *ptr++;
467 parsedPacket.extension.transmissionTimeOffset = transmissionTimeOffset;
asapersson@webrtc.orgd2e67792012-06-28 07:53:15 +0000468 if (transmissionTimeOffset & 0x800000) {
469 // Negative offset, correct sign for Word24 to Word32.
470 parsedPacket.extension.transmissionTimeOffset |= 0xFF000000;
471 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000472 break;
473 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000474 case kRtpExtensionAudioLevel: {
475 // --- Only used for debugging ---
476 // 0 1 2 3
477 // 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
478 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
479 // | ID | len=0 |V| level | 0x00 | 0x00 |
480 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
481 //
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000482
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000483 // Parse out the fields but only use it for debugging for now.
484 // const WebRtc_UWord8 V = (*ptr & 0x80) >> 7;
485 // const WebRtc_UWord8 level = (*ptr & 0x7f);
486 // DEBUG_PRINT("RTP_AUDIO_LEVEL_UNIQUE_ID: ID=%u, len=%u, V=%u,
487 // level=%u", ID, len, V, level);
pwestin@webrtc.org6c1d4152012-01-04 17:04:51 +0000488 break;
489 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000490 default: {
mflodman@webrtc.orgba853c92012-08-10 14:30:53 +0000491 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000492 "Extension type not implemented.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000493 return;
494 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000495 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000496 WebRtc_UWord8 num_bytes = ParsePaddingBytes(ptrRTPDataExtensionEnd, ptr);
497 ptr += num_bytes;
498 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000499}
500
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000501WebRtc_UWord8 RTPHeaderParser::ParsePaddingBytes(
502 const WebRtc_UWord8* ptrRTPDataExtensionEnd,
503 const WebRtc_UWord8* ptr) const {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000504
505 WebRtc_UWord8 num_zero_bytes = 0;
506 while (ptrRTPDataExtensionEnd - ptr > 0) {
507 if (*ptr != 0) {
508 return num_zero_bytes;
509 }
510 ptr++;
511 num_zero_bytes++;
512 }
513 return num_zero_bytes;
514}
515
niklase@google.com470e71d2011-07-07 08:21:25 +0000516// RTP payload parser
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000517RTPPayloadParser::RTPPayloadParser(const RtpVideoCodecTypes videoType,
518 const WebRtc_UWord8* payloadData,
519 WebRtc_UWord16 payloadDataLength,
520 WebRtc_Word32 id)
521 :
522 _id(id),
523 _dataPtr(payloadData),
524 _dataLength(payloadDataLength),
525 _videoType(videoType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000526}
527
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000528RTPPayloadParser::~RTPPayloadParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000529}
530
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000531bool RTPPayloadParser::Parse(RTPPayload& parsedPacket) const {
532 parsedPacket.SetType(_videoType);
niklase@google.com470e71d2011-07-07 08:21:25 +0000533
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000534 switch (_videoType) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000535 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000536 return ParseGeneric(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000537 case kRtpVp8Video:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000538 return ParseVP8(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000539 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000540 return false;
541 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000542}
543
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000544bool RTPPayloadParser::ParseGeneric(RTPPayload& /*parsedPacket*/) const {
545 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000546}
547
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000548//
549// VP8 format:
550//
551// Payload descriptor
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000552// 0 1 2 3 4 5 6 7
553// +-+-+-+-+-+-+-+-+
554// |X|R|N|S|PartID | (REQUIRED)
555// +-+-+-+-+-+-+-+-+
556// X: |I|L|T|K| RSV | (OPTIONAL)
557// +-+-+-+-+-+-+-+-+
558// I: | PictureID | (OPTIONAL)
559// +-+-+-+-+-+-+-+-+
560// L: | TL0PICIDX | (OPTIONAL)
561// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.orgeda86dc2011-12-13 14:11:06 +0000562// T/K: |TID:Y| KEYIDX | (OPTIONAL)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000563// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000564//
565// Payload header (considered part of the actual payload, sent to decoder)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000566// 0 1 2 3 4 5 6 7
567// +-+-+-+-+-+-+-+-+
568// |Size0|H| VER |P|
569// +-+-+-+-+-+-+-+-+
570// | ... |
571// + +
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000572
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000573bool RTPPayloadParser::ParseVP8(RTPPayload& parsedPacket) const {
574 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
575 const WebRtc_UWord8* dataPtr = _dataPtr;
576 int dataLength = _dataLength;
niklase@google.com470e71d2011-07-07 08:21:25 +0000577
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000578 // Parse mandatory first byte of payload descriptor
579 bool extension = (*dataPtr & 0x80) ? true : false; // X bit
580 vp8->nonReferenceFrame = (*dataPtr & 0x20) ? true : false; // N bit
581 vp8->beginningOfPartition = (*dataPtr & 0x10) ? true : false; // S bit
582 vp8->partitionID = (*dataPtr & 0x0F); // PartID field
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000583
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000584 if (vp8->partitionID > 8) {
585 // Weak check for corrupt data: PartID MUST NOT be larger than 8.
586 return false;
587 }
andrew@webrtc.org7fe219f2012-02-01 02:40:37 +0000588
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000589 // Advance dataPtr and decrease remaining payload size
590 dataPtr++;
591 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000592
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000593 if (extension) {
594 const int parsedBytes = ParseVP8Extension(vp8, dataPtr, dataLength);
595 if (parsedBytes < 0) return false;
596 dataPtr += parsedBytes;
597 dataLength -= parsedBytes;
598 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000599
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000600 if (dataLength <= 0) {
601 WEBRTC_TRACE(kTraceError, kTraceRtpRtcp, _id,
602 "Error parsing VP8 payload descriptor; payload too short");
603 return false;
604 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000605
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000606 // Read P bit from payload header (only at beginning of first partition)
607 if (dataLength > 0 && vp8->beginningOfPartition && vp8->partitionID == 0) {
608 parsedPacket.frameType = (*dataPtr & 0x01) ? kPFrame : kIFrame;
609 } else {
610 parsedPacket.frameType = kPFrame;
611 }
612 if (0 != ParseVP8FrameSize(parsedPacket, dataPtr, dataLength)) {
613 return false;
614 }
615 parsedPacket.info.VP8.data = dataPtr;
616 parsedPacket.info.VP8.dataLength = dataLength;
617 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000618}
619
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000620int RTPPayloadParser::ParseVP8FrameSize(RTPPayload& parsedPacket,
621 const WebRtc_UWord8* dataPtr,
622 int dataLength) const {
623 if (parsedPacket.frameType != kIFrame) {
624 // Included in payload header for I-frames.
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000625 return 0;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000626 }
627 if (dataLength < 10) {
628 // For an I-frame we should always have the uncompressed VP8 header
629 // in the beginning of the partition.
630 return -1;
631 }
632 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
633 vp8->frameWidth = ((dataPtr[7] << 8) + dataPtr[6]) & 0x3FFF;
634 vp8->frameHeight = ((dataPtr[9] << 8) + dataPtr[8]) & 0x3FFF;
635 return 0;
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000636}
637
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000638int RTPPayloadParser::ParseVP8Extension(RTPPayloadVP8* vp8,
639 const WebRtc_UWord8* dataPtr,
640 int dataLength) const {
641 int parsedBytes = 0;
642 if (dataLength <= 0) return -1;
643 // Optional X field is present
644 vp8->hasPictureID = (*dataPtr & 0x80) ? true : false; // I bit
645 vp8->hasTl0PicIdx = (*dataPtr & 0x40) ? true : false; // L bit
646 vp8->hasTID = (*dataPtr & 0x20) ? true : false; // T bit
647 vp8->hasKeyIdx = (*dataPtr & 0x10) ? true : false; // K bit
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000648
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000649 // Advance dataPtr and decrease remaining payload size
650 dataPtr++;
651 parsedBytes++;
652 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000653
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000654 if (vp8->hasPictureID) {
655 if (ParseVP8PictureID(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
656 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000657 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000658 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000659
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000660 if (vp8->hasTl0PicIdx) {
661 if (ParseVP8Tl0PicIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
662 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000663 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000664 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000665
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000666 if (vp8->hasTID || vp8->hasKeyIdx) {
667 if (ParseVP8TIDAndKeyIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
668 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000669 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000670 }
671 return parsedBytes;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000672}
673
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000674int RTPPayloadParser::ParseVP8PictureID(RTPPayloadVP8* vp8,
675 const WebRtc_UWord8** dataPtr,
676 int* dataLength,
677 int* parsedBytes) const {
678 if (*dataLength <= 0) return -1;
679 vp8->pictureID = (**dataPtr & 0x7F);
680 if (**dataPtr & 0x80) {
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000681 (*dataPtr)++;
682 (*parsedBytes)++;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000683 if (--(*dataLength) <= 0) return -1;
684 // PictureID is 15 bits
685 vp8->pictureID = (vp8->pictureID << 8) +** dataPtr;
686 }
687 (*dataPtr)++;
688 (*parsedBytes)++;
689 (*dataLength)--;
690 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000691}
692
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000693int RTPPayloadParser::ParseVP8Tl0PicIdx(RTPPayloadVP8* vp8,
694 const WebRtc_UWord8** dataPtr,
695 int* dataLength,
696 int* parsedBytes) const {
697 if (*dataLength <= 0) return -1;
698 vp8->tl0PicIdx = **dataPtr;
699 (*dataPtr)++;
700 (*parsedBytes)++;
701 (*dataLength)--;
702 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000703}
704
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000705int RTPPayloadParser::ParseVP8TIDAndKeyIdx(RTPPayloadVP8* vp8,
706 const WebRtc_UWord8** dataPtr,
707 int* dataLength,
708 int* parsedBytes) const {
709 if (*dataLength <= 0) return -1;
710 if (vp8->hasTID) {
711 vp8->tID = ((**dataPtr >> 6) & 0x03);
712 vp8->layerSync = (**dataPtr & 0x20) ? true : false; // Y bit
713 }
714 if (vp8->hasKeyIdx) {
715 vp8->keyIdx = (**dataPtr & 0x1F);
716 }
717 (*dataPtr)++;
718 (*parsedBytes)++;
719 (*dataLength)--;
720 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000721}
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000722
723} // namespace ModuleRTPUtility
724
725} // namespace webrtc