blob: 86cfe153176b552e35ce54d2a40f6d6b7a14f0e5 [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
stefan@webrtc.org7da34592013-04-09 14:56:29 +000077uint32_t ConvertNTPTimeToMS(uint32_t NTPsec, uint32_t NTPfrac) {
78 int freq = 1000;
79 float ftemp = (float)NTPfrac / (float)NTP_FRAC;
80 uint32_t tmp = (uint32_t)(ftemp * freq);
81 uint32_t MStime = NTPsec * freq + tmp;
82 return MStime;
83}
84
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +000085/*
86 * Misc utility routines
87 */
88
pbos@webrtc.org2f446732013-04-08 11:08:41 +000089const uint8_t* GetPayloadData(const WebRtcRTPHeader* rtp_header,
90 const uint8_t* packet) {
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +000091 return packet + rtp_header->header.headerLength;
92}
93
pbos@webrtc.org2f446732013-04-08 11:08:41 +000094uint16_t GetPayloadDataLength(const WebRtcRTPHeader* rtp_header,
95 const uint16_t packet_length) {
96 uint16_t length = packet_length - rtp_header->header.paddingLength -
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +000097 rtp_header->header.headerLength;
pbos@webrtc.org2f446732013-04-08 11:08:41 +000098 return static_cast<uint16_t>(length);
phoglund@webrtc.org07bf43c2012-12-18 15:40:53 +000099}
100
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000101#if defined(_WIN32)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000102bool StringCompare(const char* str1, const char* str2,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000103 const uint32_t length) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000104 return (_strnicmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000105}
106#elif defined(WEBRTC_LINUX) || defined(WEBRTC_MAC)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000107bool StringCompare(const char* str1, const char* str2,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000108 const uint32_t length) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000109 return (strncasecmp(str1, str2, length) == 0) ? true : false;
pwestin@webrtc.org0644b1d2011-12-01 15:42:31 +0000110}
111#endif
niklase@google.com470e71d2011-07-07 08:21:25 +0000112
113#if !defined(WEBRTC_LITTLE_ENDIAN) && !defined(WEBRTC_BIG_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000114#error Either WEBRTC_LITTLE_ENDIAN or WEBRTC_BIG_ENDIAN must be defined
niklase@google.com470e71d2011-07-07 08:21:25 +0000115#endif
116
117/* for RTP/RTCP
118 All integer fields are carried in network byte order, that is, most
119 significant byte (octet) first. AKA big-endian.
120*/
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000121void AssignUWord32ToBuffer(uint8_t* dataBuffer, uint32_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000122#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000123 dataBuffer[0] = static_cast<uint8_t>(value >> 24);
124 dataBuffer[1] = static_cast<uint8_t>(value >> 16);
125 dataBuffer[2] = static_cast<uint8_t>(value >> 8);
126 dataBuffer[3] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000127#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000128 uint32_t* ptr = reinterpret_cast<uint32_t*>(dataBuffer);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000129 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000130#endif
131}
132
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000133void AssignUWord24ToBuffer(uint8_t* dataBuffer, uint32_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000134#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000135 dataBuffer[0] = static_cast<uint8_t>(value >> 16);
136 dataBuffer[1] = static_cast<uint8_t>(value >> 8);
137 dataBuffer[2] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000138#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000139 dataBuffer[0] = static_cast<uint8_t>(value);
140 dataBuffer[1] = static_cast<uint8_t>(value >> 8);
141 dataBuffer[2] = static_cast<uint8_t>(value >> 16);
niklase@google.com470e71d2011-07-07 08:21:25 +0000142#endif
143}
144
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000145void AssignUWord16ToBuffer(uint8_t* dataBuffer, uint16_t value) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000146#if defined(WEBRTC_LITTLE_ENDIAN)
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000147 dataBuffer[0] = static_cast<uint8_t>(value >> 8);
148 dataBuffer[1] = static_cast<uint8_t>(value);
niklase@google.com470e71d2011-07-07 08:21:25 +0000149#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000150 uint16_t* ptr = reinterpret_cast<uint16_t*>(dataBuffer);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000151 ptr[0] = value;
niklase@google.com470e71d2011-07-07 08:21:25 +0000152#endif
153}
154
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000155uint16_t BufferToUWord16(const uint8_t* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000156#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000157 return (dataBuffer[0] << 8) + dataBuffer[1];
niklase@google.com470e71d2011-07-07 08:21:25 +0000158#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000159 return *reinterpret_cast<const uint16_t*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000160#endif
161}
162
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000163uint32_t BufferToUWord24(const uint8_t* dataBuffer) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000164 return (dataBuffer[0] << 16) + (dataBuffer[1] << 8) + dataBuffer[2];
niklase@google.com470e71d2011-07-07 08:21:25 +0000165}
166
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000167uint32_t BufferToUWord32(const uint8_t* dataBuffer) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000168#if defined(WEBRTC_LITTLE_ENDIAN)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000169 return (dataBuffer[0] << 24) + (dataBuffer[1] << 16) + (dataBuffer[2] << 8) +
170 dataBuffer[3];
niklase@google.com470e71d2011-07-07 08:21:25 +0000171#else
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000172 return *reinterpret_cast<const uint32_t*>(dataBuffer);
niklase@google.com470e71d2011-07-07 08:21:25 +0000173#endif
174}
175
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000176uint32_t pow2(uint8_t exp) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000177 return 1 << exp;
niklase@google.com470e71d2011-07-07 08:21:25 +0000178}
179
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000180void RTPPayload::SetType(RtpVideoCodecTypes videoType) {
181 type = videoType;
niklase@google.com470e71d2011-07-07 08:21:25 +0000182
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000183 switch (type) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000184 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000185 break;
186 case kRtpVp8Video: {
187 info.VP8.nonReferenceFrame = false;
188 info.VP8.beginningOfPartition = false;
189 info.VP8.partitionID = 0;
190 info.VP8.hasPictureID = false;
191 info.VP8.hasTl0PicIdx = false;
192 info.VP8.hasTID = false;
193 info.VP8.hasKeyIdx = false;
194 info.VP8.pictureID = -1;
195 info.VP8.tl0PicIdx = -1;
196 info.VP8.tID = -1;
197 info.VP8.layerSync = false;
198 info.VP8.frameWidth = 0;
199 info.VP8.frameHeight = 0;
200 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000201 }
202 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000203 break;
204 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000205}
206
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000207RTPHeaderParser::RTPHeaderParser(const uint8_t* rtpData,
208 const uint32_t rtpDataLength)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000209 : _ptrRTPDataBegin(rtpData),
210 _ptrRTPDataEnd(rtpData ? (rtpData + rtpDataLength) : NULL) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000211}
212
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000213RTPHeaderParser::~RTPHeaderParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000214}
215
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000216bool RTPHeaderParser::RTCP() const {
217 // 72 to 76 is reserved for RTP
218 // 77 to 79 is not reserver but they are not assigned we will block them
219 // for RTCP 200 SR == marker bit + 72
220 // for RTCP 204 APP == marker bit + 76
221 /*
222 * RTCP
223 *
224 * FIR full INTRA-frame request 192 [RFC2032] supported
225 * NACK negative acknowledgement 193 [RFC2032]
226 * IJ Extended inter-arrival jitter report 195 [RFC-ietf-avt-rtp-toff
227 * set-07.txt] http://tools.ietf.org/html/draft-ietf-avt-rtp-toffset-07
228 * SR sender report 200 [RFC3551] supported
229 * RR receiver report 201 [RFC3551] supported
230 * SDES source description 202 [RFC3551] supported
231 * BYE goodbye 203 [RFC3551] supported
232 * APP application-defined 204 [RFC3551] ignored
233 * RTPFB Transport layer FB message 205 [RFC4585] supported
234 * PSFB Payload-specific FB message 206 [RFC4585] supported
235 * XR extended report 207 [RFC3611] supported
236 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000237
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000238 /* 205 RFC 5104
239 * FMT 1 NACK supported
240 * FMT 2 reserved
241 * FMT 3 TMMBR supported
242 * FMT 4 TMMBN supported
243 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000244
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000245 /* 206 RFC 5104
246 * FMT 1: Picture Loss Indication (PLI) supported
247 * FMT 2: Slice Lost Indication (SLI)
248 * FMT 3: Reference Picture Selection Indication (RPSI)
249 * FMT 4: Full Intra Request (FIR) Command supported
250 * FMT 5: Temporal-Spatial Trade-off Request (TSTR)
251 * FMT 6: Temporal-Spatial Trade-off Notification (TSTN)
252 * FMT 7: Video Back Channel Message (VBCM)
253 * FMT 15: Application layer FB message
254 */
niklase@google.com470e71d2011-07-07 08:21:25 +0000255
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +0000256 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
257 if (length < kRtcpMinHeaderLength) {
258 return false;
259 }
260
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000261 const uint8_t V = _ptrRTPDataBegin[0] >> 6;
solenberg@webrtc.orgd8a6e722013-03-26 14:02:30 +0000262 if (V != kRtcpExpectedVersion) {
263 return false;
264 }
265
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000266 const uint8_t payloadType = _ptrRTPDataBegin[1];
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000267 bool RTCP = false;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000268 switch (payloadType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000269 case 192:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000270 RTCP = true;
271 break;
niklase@google.com470e71d2011-07-07 08:21:25 +0000272 case 193:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000273 // not supported
274 // pass through and check for a potential RTP packet
275 break;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000276 case 195:
niklase@google.com470e71d2011-07-07 08:21:25 +0000277 case 200:
278 case 201:
279 case 202:
280 case 203:
281 case 204:
282 case 205:
283 case 206:
284 case 207:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000285 RTCP = true;
286 break;
287 }
288 return RTCP;
niklase@google.com470e71d2011-07-07 08:21:25 +0000289}
290
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000291bool RTPHeaderParser::Parse(WebRtcRTPHeader& parsedPacket,
292 RtpHeaderExtensionMap* ptrExtensionMap) const {
293 const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin;
niklase@google.com470e71d2011-07-07 08:21:25 +0000294
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000295 if (length < 12) {
296 return false;
297 }
298
299 // Version
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000300 const uint8_t V = _ptrRTPDataBegin[0] >> 6;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000301 // Padding
302 const bool P = ((_ptrRTPDataBegin[0] & 0x20) == 0) ? false : true;
303 // eXtension
304 const bool X = ((_ptrRTPDataBegin[0] & 0x10) == 0) ? false : true;
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000305 const uint8_t CC = _ptrRTPDataBegin[0] & 0x0f;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000306 const bool M = ((_ptrRTPDataBegin[1] & 0x80) == 0) ? false : true;
307
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000308 const uint8_t PT = _ptrRTPDataBegin[1] & 0x7f;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000309
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000310 const uint16_t sequenceNumber = (_ptrRTPDataBegin[2] << 8) +
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000311 _ptrRTPDataBegin[3];
312
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000313 const uint8_t* ptr = &_ptrRTPDataBegin[4];
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000314
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000315 uint32_t RTPTimestamp = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000316 RTPTimestamp += *ptr++ << 16;
317 RTPTimestamp += *ptr++ << 8;
318 RTPTimestamp += *ptr++;
319
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000320 uint32_t SSRC = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000321 SSRC += *ptr++ << 16;
322 SSRC += *ptr++ << 8;
323 SSRC += *ptr++;
324
325 if (V != 2) {
326 return false;
327 }
328
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000329 const uint8_t CSRCocts = CC * 4;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000330
331 if ((ptr + CSRCocts) > _ptrRTPDataEnd) {
332 return false;
333 }
334
335 parsedPacket.header.markerBit = M;
336 parsedPacket.header.payloadType = PT;
337 parsedPacket.header.sequenceNumber = sequenceNumber;
338 parsedPacket.header.timestamp = RTPTimestamp;
339 parsedPacket.header.ssrc = SSRC;
340 parsedPacket.header.numCSRCs = CC;
341 parsedPacket.header.paddingLength = P ? *(_ptrRTPDataEnd - 1) : 0;
342
343 for (unsigned int i = 0; i < CC; ++i) {
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000344 uint32_t CSRC = *ptr++ << 24;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000345 CSRC += *ptr++ << 16;
346 CSRC += *ptr++ << 8;
347 CSRC += *ptr++;
348 parsedPacket.header.arrOfCSRCs[i] = CSRC;
349 }
350 parsedPacket.type.Audio.numEnergy = parsedPacket.header.numCSRCs;
351
352 parsedPacket.header.headerLength = 12 + CSRCocts;
353
354 // If in effect, MAY be omitted for those packets for which the offset
355 // is zero.
356 parsedPacket.extension.transmissionTimeOffset = 0;
357
358 if (X) {
359 /* RTP header extension, RFC 3550.
360 0 1 2 3
361 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
362 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
363 | defined by profile | length |
364 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
365 | header extension |
366 | .... |
367 */
368 const ptrdiff_t remain = _ptrRTPDataEnd - ptr;
369 if (remain < 4) {
370 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000371 }
372
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000373 parsedPacket.header.headerLength += 4;
niklase@google.com470e71d2011-07-07 08:21:25 +0000374
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000375 uint16_t definedByProfile = *ptr++ << 8;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000376 definedByProfile += *ptr++;
niklase@google.com470e71d2011-07-07 08:21:25 +0000377
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000378 uint16_t XLen = *ptr++ << 8;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000379 XLen += *ptr++; // in 32 bit words
380 XLen *= 4; // in octs
niklase@google.com470e71d2011-07-07 08:21:25 +0000381
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000382 if (remain < (4 + XLen)) {
383 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000384 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000385 if (definedByProfile == RTP_ONE_BYTE_HEADER_EXTENSION) {
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000386 const uint8_t* ptrRTPDataExtensionEnd = ptr + XLen;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000387 ParseOneByteExtensionHeader(parsedPacket,
388 ptrExtensionMap,
389 ptrRTPDataExtensionEnd,
390 ptr);
niklase@google.com470e71d2011-07-07 08:21:25 +0000391 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000392 parsedPacket.header.headerLength += XLen;
393 }
394 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000395}
396
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000397void RTPHeaderParser::ParseOneByteExtensionHeader(
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000398 WebRtcRTPHeader& parsedPacket,
399 const RtpHeaderExtensionMap* ptrExtensionMap,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000400 const uint8_t* ptrRTPDataExtensionEnd,
401 const uint8_t* ptr) const {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000402 if (!ptrExtensionMap) {
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000403 return;
404 }
405
406 while (ptrRTPDataExtensionEnd - ptr > 0) {
407 // 0
408 // 0 1 2 3 4 5 6 7
409 // +-+-+-+-+-+-+-+-+
410 // | ID | len |
411 // +-+-+-+-+-+-+-+-+
412
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000413 const uint8_t id = (*ptr & 0xf0) >> 4;
414 const uint8_t len = (*ptr & 0x0f);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000415 ptr++;
416
417 if (id == 15) {
418 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
419 "Ext id: 15 encountered, parsing terminated.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000420 return;
421 }
422
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000423 RTPExtensionType type;
424 if (ptrExtensionMap->GetType(id, &type) != 0) {
425 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
426 "Failed to find extension id: %d", id);
427 return;
428 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000429
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000430 switch (type) {
431 case kRtpExtensionTransmissionTimeOffset: {
432 if (len != 2) {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000433 WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000434 "Incorrect transmission time offset len: %d", len);
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000435 return;
436 }
437 // 0 1 2 3
438 // 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
439 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
440 // | ID | len=2 | transmission offset |
441 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
442
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000443 int32_t transmissionTimeOffset = *ptr++ << 16;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000444 transmissionTimeOffset += *ptr++ << 8;
445 transmissionTimeOffset += *ptr++;
446 parsedPacket.extension.transmissionTimeOffset = transmissionTimeOffset;
asapersson@webrtc.orgd2e67792012-06-28 07:53:15 +0000447 if (transmissionTimeOffset & 0x800000) {
448 // Negative offset, correct sign for Word24 to Word32.
449 parsedPacket.extension.transmissionTimeOffset |= 0xFF000000;
450 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000451 break;
452 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000453 case kRtpExtensionAudioLevel: {
454 // --- Only used for debugging ---
455 // 0 1 2 3
456 // 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
457 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
458 // | ID | len=0 |V| level | 0x00 | 0x00 |
459 // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
460 //
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000461
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000462 // Parse out the fields but only use it for debugging for now.
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000463 // const uint8_t V = (*ptr & 0x80) >> 7;
464 // const uint8_t level = (*ptr & 0x7f);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000465 // DEBUG_PRINT("RTP_AUDIO_LEVEL_UNIQUE_ID: ID=%u, len=%u, V=%u,
466 // level=%u", ID, len, V, level);
pwestin@webrtc.org6c1d4152012-01-04 17:04:51 +0000467 break;
468 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000469 default: {
mflodman@webrtc.orgba853c92012-08-10 14:30:53 +0000470 WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000471 "Extension type not implemented.");
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000472 return;
473 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000474 }
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000475 uint8_t num_bytes = ParsePaddingBytes(ptrRTPDataExtensionEnd, ptr);
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000476 ptr += num_bytes;
477 }
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000478}
479
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000480uint8_t RTPHeaderParser::ParsePaddingBytes(
481 const uint8_t* ptrRTPDataExtensionEnd,
482 const uint8_t* ptr) const {
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000483
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000484 uint8_t num_zero_bytes = 0;
asapersson@webrtc.org5249cc82011-12-16 14:31:37 +0000485 while (ptrRTPDataExtensionEnd - ptr > 0) {
486 if (*ptr != 0) {
487 return num_zero_bytes;
488 }
489 ptr++;
490 num_zero_bytes++;
491 }
492 return num_zero_bytes;
493}
494
niklase@google.com470e71d2011-07-07 08:21:25 +0000495// RTP payload parser
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000496RTPPayloadParser::RTPPayloadParser(const RtpVideoCodecTypes videoType,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000497 const uint8_t* payloadData,
498 uint16_t payloadDataLength,
499 int32_t id)
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000500 :
501 _id(id),
502 _dataPtr(payloadData),
503 _dataLength(payloadDataLength),
504 _videoType(videoType) {
niklase@google.com470e71d2011-07-07 08:21:25 +0000505}
506
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000507RTPPayloadParser::~RTPPayloadParser() {
niklase@google.com470e71d2011-07-07 08:21:25 +0000508}
509
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000510bool RTPPayloadParser::Parse(RTPPayload& parsedPacket) const {
511 parsedPacket.SetType(_videoType);
niklase@google.com470e71d2011-07-07 08:21:25 +0000512
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000513 switch (_videoType) {
pbos@webrtc.org8911ce42013-03-18 16:39:03 +0000514 case kRtpGenericVideo:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000515 return ParseGeneric(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000516 case kRtpVp8Video:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000517 return ParseVP8(parsedPacket);
niklase@google.com470e71d2011-07-07 08:21:25 +0000518 default:
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000519 return false;
520 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000521}
522
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000523bool RTPPayloadParser::ParseGeneric(RTPPayload& /*parsedPacket*/) const {
524 return false;
niklase@google.com470e71d2011-07-07 08:21:25 +0000525}
526
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000527//
528// VP8 format:
529//
530// Payload descriptor
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000531// 0 1 2 3 4 5 6 7
532// +-+-+-+-+-+-+-+-+
533// |X|R|N|S|PartID | (REQUIRED)
534// +-+-+-+-+-+-+-+-+
535// X: |I|L|T|K| RSV | (OPTIONAL)
536// +-+-+-+-+-+-+-+-+
537// I: | PictureID | (OPTIONAL)
538// +-+-+-+-+-+-+-+-+
539// L: | TL0PICIDX | (OPTIONAL)
540// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.orgeda86dc2011-12-13 14:11:06 +0000541// T/K: |TID:Y| KEYIDX | (OPTIONAL)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000542// +-+-+-+-+-+-+-+-+
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000543//
544// Payload header (considered part of the actual payload, sent to decoder)
henrik.lundin@webrtc.org6f2c0162011-11-24 12:52:40 +0000545// 0 1 2 3 4 5 6 7
546// +-+-+-+-+-+-+-+-+
547// |Size0|H| VER |P|
548// +-+-+-+-+-+-+-+-+
549// | ... |
550// + +
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000551
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000552bool RTPPayloadParser::ParseVP8(RTPPayload& parsedPacket) const {
553 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000554 const uint8_t* dataPtr = _dataPtr;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000555 int dataLength = _dataLength;
niklase@google.com470e71d2011-07-07 08:21:25 +0000556
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000557 // Parse mandatory first byte of payload descriptor
558 bool extension = (*dataPtr & 0x80) ? true : false; // X bit
559 vp8->nonReferenceFrame = (*dataPtr & 0x20) ? true : false; // N bit
560 vp8->beginningOfPartition = (*dataPtr & 0x10) ? true : false; // S bit
561 vp8->partitionID = (*dataPtr & 0x0F); // PartID field
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000562
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000563 if (vp8->partitionID > 8) {
564 // Weak check for corrupt data: PartID MUST NOT be larger than 8.
565 return false;
566 }
andrew@webrtc.org7fe219f2012-02-01 02:40:37 +0000567
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000568 // Advance dataPtr and decrease remaining payload size
569 dataPtr++;
570 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000571
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000572 if (extension) {
573 const int parsedBytes = ParseVP8Extension(vp8, dataPtr, dataLength);
574 if (parsedBytes < 0) return false;
575 dataPtr += parsedBytes;
576 dataLength -= parsedBytes;
577 }
niklase@google.com470e71d2011-07-07 08:21:25 +0000578
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000579 if (dataLength <= 0) {
580 WEBRTC_TRACE(kTraceError, kTraceRtpRtcp, _id,
581 "Error parsing VP8 payload descriptor; payload too short");
582 return false;
583 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000584
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000585 // Read P bit from payload header (only at beginning of first partition)
586 if (dataLength > 0 && vp8->beginningOfPartition && vp8->partitionID == 0) {
587 parsedPacket.frameType = (*dataPtr & 0x01) ? kPFrame : kIFrame;
588 } else {
589 parsedPacket.frameType = kPFrame;
590 }
591 if (0 != ParseVP8FrameSize(parsedPacket, dataPtr, dataLength)) {
592 return false;
593 }
594 parsedPacket.info.VP8.data = dataPtr;
595 parsedPacket.info.VP8.dataLength = dataLength;
596 return true;
niklase@google.com470e71d2011-07-07 08:21:25 +0000597}
598
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000599int RTPPayloadParser::ParseVP8FrameSize(RTPPayload& parsedPacket,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000600 const uint8_t* dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000601 int dataLength) const {
602 if (parsedPacket.frameType != kIFrame) {
603 // Included in payload header for I-frames.
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000604 return 0;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000605 }
606 if (dataLength < 10) {
607 // For an I-frame we should always have the uncompressed VP8 header
608 // in the beginning of the partition.
609 return -1;
610 }
611 RTPPayloadVP8* vp8 = &parsedPacket.info.VP8;
612 vp8->frameWidth = ((dataPtr[7] << 8) + dataPtr[6]) & 0x3FFF;
613 vp8->frameHeight = ((dataPtr[9] << 8) + dataPtr[8]) & 0x3FFF;
614 return 0;
pwestin@webrtc.org075e91f2011-11-02 23:14:58 +0000615}
616
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000617int RTPPayloadParser::ParseVP8Extension(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000618 const uint8_t* dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000619 int dataLength) const {
620 int parsedBytes = 0;
621 if (dataLength <= 0) return -1;
622 // Optional X field is present
623 vp8->hasPictureID = (*dataPtr & 0x80) ? true : false; // I bit
624 vp8->hasTl0PicIdx = (*dataPtr & 0x40) ? true : false; // L bit
625 vp8->hasTID = (*dataPtr & 0x20) ? true : false; // T bit
626 vp8->hasKeyIdx = (*dataPtr & 0x10) ? true : false; // K bit
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000627
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000628 // Advance dataPtr and decrease remaining payload size
629 dataPtr++;
630 parsedBytes++;
631 dataLength--;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000632
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000633 if (vp8->hasPictureID) {
634 if (ParseVP8PictureID(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
635 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000636 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000637 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000638
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000639 if (vp8->hasTl0PicIdx) {
640 if (ParseVP8Tl0PicIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
641 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000642 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000643 }
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000644
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000645 if (vp8->hasTID || vp8->hasKeyIdx) {
646 if (ParseVP8TIDAndKeyIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) {
647 return -1;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000648 }
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000649 }
650 return parsedBytes;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000651}
652
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000653int RTPPayloadParser::ParseVP8PictureID(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000654 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000655 int* dataLength,
656 int* parsedBytes) const {
657 if (*dataLength <= 0) return -1;
658 vp8->pictureID = (**dataPtr & 0x7F);
659 if (**dataPtr & 0x80) {
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000660 (*dataPtr)++;
661 (*parsedBytes)++;
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000662 if (--(*dataLength) <= 0) return -1;
663 // PictureID is 15 bits
664 vp8->pictureID = (vp8->pictureID << 8) +** dataPtr;
665 }
666 (*dataPtr)++;
667 (*parsedBytes)++;
668 (*dataLength)--;
669 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000670}
671
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000672int RTPPayloadParser::ParseVP8Tl0PicIdx(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000673 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000674 int* dataLength,
675 int* parsedBytes) const {
676 if (*dataLength <= 0) return -1;
677 vp8->tl0PicIdx = **dataPtr;
678 (*dataPtr)++;
679 (*parsedBytes)++;
680 (*dataLength)--;
681 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000682}
683
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000684int RTPPayloadParser::ParseVP8TIDAndKeyIdx(RTPPayloadVP8* vp8,
pbos@webrtc.org2f446732013-04-08 11:08:41 +0000685 const uint8_t** dataPtr,
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000686 int* dataLength,
687 int* parsedBytes) const {
688 if (*dataLength <= 0) return -1;
689 if (vp8->hasTID) {
690 vp8->tID = ((**dataPtr >> 6) & 0x03);
691 vp8->layerSync = (**dataPtr & 0x20) ? true : false; // Y bit
692 }
693 if (vp8->hasKeyIdx) {
694 vp8->keyIdx = (**dataPtr & 0x1F);
695 }
696 (*dataPtr)++;
697 (*parsedBytes)++;
698 (*dataLength)--;
699 return 0;
henrik.lundin@webrtc.org8571af72011-08-29 15:37:12 +0000700}
henrike@webrtc.orgd5657c22012-02-08 23:41:49 +0000701
702} // namespace ModuleRTPUtility
703
704} // namespace webrtc