niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 1 | /* |
pwestin@webrtc.org | f6bb77a | 2012-01-24 17:16:59 +0000 | [diff] [blame] | 2 | * Copyright (c) 2012 The WebRTC project authors. All Rights Reserved. |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 3 | * |
| 4 | * Use of this source code is governed by a BSD-style license |
| 5 | * that can be found in the LICENSE file in the root of the source |
| 6 | * tree. An additional intellectual property rights grant can be found |
| 7 | * in the file PATENTS. All contributing project authors may |
| 8 | * be found in the AUTHORS file in the root of the source tree. |
| 9 | */ |
| 10 | |
| 11 | #include "rtp_utility.h" |
| 12 | |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 13 | #include <cassert> |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 14 | #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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 28 | |
pwestin@webrtc.org | 1853005 | 2012-07-03 10:41:54 +0000 | [diff] [blame] | 29 | #include "system_wrappers/interface/tick_util.h" |
| 30 | #include "system_wrappers/interface/trace.h" |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 31 | |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 32 | #if (defined(_DEBUG) && defined(_WIN32) && (_MSC_VER >= 1400)) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 33 | #define DEBUG_PRINT(...) \ |
| 34 | { \ |
| 35 | char msg[256]; \ |
| 36 | sprintf(msg, __VA_ARGS__); \ |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 37 | OutputDebugString(msg); \ |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 38 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 39 | #else |
| 40 | // special fix for visual 2003 |
| 41 | #define DEBUG_PRINT(exp) ((void)0) |
| 42 | #endif // defined(_DEBUG) && defined(_WIN32) |
| 43 | |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 44 | namespace webrtc { |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 45 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 46 | namespace ModuleRTPUtility { |
| 47 | |
solenberg@webrtc.org | d8a6e72 | 2013-03-26 14:02:30 +0000 | [diff] [blame] | 48 | enum { |
| 49 | kRtcpMinHeaderLength = 4, |
| 50 | kRtcpExpectedVersion = 2 |
| 51 | }; |
| 52 | |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 53 | /* |
| 54 | * Time routines. |
| 55 | */ |
| 56 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 57 | uint32_t GetCurrentRTP(Clock* clock, uint32_t freq) { |
henrike@webrtc.org | f5da4da | 2012-02-15 23:54:59 +0000 | [diff] [blame] | 58 | const bool use_global_clock = (clock == NULL); |
stefan@webrtc.org | 20ed36d | 2013-01-17 14:01:20 +0000 | [diff] [blame] | 59 | Clock* local_clock = clock; |
henrike@webrtc.org | f5da4da | 2012-02-15 23:54:59 +0000 | [diff] [blame] | 60 | if (use_global_clock) { |
stefan@webrtc.org | 20ed36d | 2013-01-17 14:01:20 +0000 | [diff] [blame] | 61 | local_clock = Clock::GetRealTimeClock(); |
henrike@webrtc.org | f5da4da | 2012-02-15 23:54:59 +0000 | [diff] [blame] | 62 | } |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 63 | uint32_t secs = 0, frac = 0; |
stefan@webrtc.org | 20ed36d | 2013-01-17 14:01:20 +0000 | [diff] [blame] | 64 | local_clock->CurrentNtp(secs, frac); |
henrike@webrtc.org | f5da4da | 2012-02-15 23:54:59 +0000 | [diff] [blame] | 65 | if (use_global_clock) { |
| 66 | delete local_clock; |
| 67 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 68 | return ConvertNTPTimeToRTP(secs, frac, freq); |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 69 | } |
| 70 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 71 | uint32_t ConvertNTPTimeToRTP(uint32_t NTPsec, uint32_t NTPfrac, uint32_t freq) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 72 | float ftemp = (float)NTPfrac / (float)NTP_FRAC; |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 73 | uint32_t tmp = (uint32_t)(ftemp * freq); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 74 | return NTPsec * freq + tmp; |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 75 | } |
| 76 | |
stefan@webrtc.org | 7da3459 | 2013-04-09 14:56:29 +0000 | [diff] [blame] | 77 | uint32_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.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 85 | /* |
| 86 | * Misc utility routines |
| 87 | */ |
| 88 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 89 | const uint8_t* GetPayloadData(const RTPHeader& rtp_header, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 90 | const uint8_t* packet) { |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 91 | return packet + rtp_header.headerLength; |
phoglund@webrtc.org | 07bf43c | 2012-12-18 15:40:53 +0000 | [diff] [blame] | 92 | } |
| 93 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 94 | uint16_t GetPayloadDataLength(const RTPHeader& rtp_header, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 95 | const uint16_t packet_length) { |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 96 | uint16_t length = packet_length - rtp_header.paddingLength - |
| 97 | rtp_header.headerLength; |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 98 | return static_cast<uint16_t>(length); |
phoglund@webrtc.org | 07bf43c | 2012-12-18 15:40:53 +0000 | [diff] [blame] | 99 | } |
| 100 | |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 101 | #if defined(_WIN32) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 102 | bool StringCompare(const char* str1, const char* str2, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 103 | const uint32_t length) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 104 | return (_strnicmp(str1, str2, length) == 0) ? true : false; |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 105 | } |
| 106 | #elif defined(WEBRTC_LINUX) || defined(WEBRTC_MAC) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 107 | bool StringCompare(const char* str1, const char* str2, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 108 | const uint32_t length) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 109 | return (strncasecmp(str1, str2, length) == 0) ? true : false; |
pwestin@webrtc.org | 0644b1d | 2011-12-01 15:42:31 +0000 | [diff] [blame] | 110 | } |
| 111 | #endif |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 112 | |
| 113 | #if !defined(WEBRTC_LITTLE_ENDIAN) && !defined(WEBRTC_BIG_ENDIAN) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 114 | #error Either WEBRTC_LITTLE_ENDIAN or WEBRTC_BIG_ENDIAN must be defined |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 115 | #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.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 121 | void AssignUWord32ToBuffer(uint8_t* dataBuffer, uint32_t value) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 122 | #if defined(WEBRTC_LITTLE_ENDIAN) |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 123 | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 127 | #else |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 128 | uint32_t* ptr = reinterpret_cast<uint32_t*>(dataBuffer); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 129 | ptr[0] = value; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 130 | #endif |
| 131 | } |
| 132 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 133 | void AssignUWord24ToBuffer(uint8_t* dataBuffer, uint32_t value) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 134 | #if defined(WEBRTC_LITTLE_ENDIAN) |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 135 | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 138 | #else |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 139 | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 142 | #endif |
| 143 | } |
| 144 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 145 | void AssignUWord16ToBuffer(uint8_t* dataBuffer, uint16_t value) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 146 | #if defined(WEBRTC_LITTLE_ENDIAN) |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 147 | dataBuffer[0] = static_cast<uint8_t>(value >> 8); |
| 148 | dataBuffer[1] = static_cast<uint8_t>(value); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 149 | #else |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 150 | uint16_t* ptr = reinterpret_cast<uint16_t*>(dataBuffer); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 151 | ptr[0] = value; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 152 | #endif |
| 153 | } |
| 154 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 155 | uint16_t BufferToUWord16(const uint8_t* dataBuffer) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 156 | #if defined(WEBRTC_LITTLE_ENDIAN) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 157 | return (dataBuffer[0] << 8) + dataBuffer[1]; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 158 | #else |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 159 | return *reinterpret_cast<const uint16_t*>(dataBuffer); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 160 | #endif |
| 161 | } |
| 162 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 163 | uint32_t BufferToUWord24(const uint8_t* dataBuffer) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 164 | return (dataBuffer[0] << 16) + (dataBuffer[1] << 8) + dataBuffer[2]; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 165 | } |
| 166 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 167 | uint32_t BufferToUWord32(const uint8_t* dataBuffer) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 168 | #if defined(WEBRTC_LITTLE_ENDIAN) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 169 | return (dataBuffer[0] << 24) + (dataBuffer[1] << 16) + (dataBuffer[2] << 8) + |
| 170 | dataBuffer[3]; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 171 | #else |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 172 | return *reinterpret_cast<const uint32_t*>(dataBuffer); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 173 | #endif |
| 174 | } |
| 175 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 176 | uint32_t pow2(uint8_t exp) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 177 | return 1 << exp; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 178 | } |
| 179 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 180 | void RTPPayload::SetType(RtpVideoCodecTypes videoType) { |
| 181 | type = videoType; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 182 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 183 | switch (type) { |
pbos@webrtc.org | 8911ce4 | 2013-03-18 16:39:03 +0000 | [diff] [blame] | 184 | case kRtpGenericVideo: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 185 | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 201 | } |
| 202 | default: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 203 | break; |
| 204 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 205 | } |
| 206 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 207 | RTPHeaderParser::RTPHeaderParser(const uint8_t* rtpData, |
| 208 | const uint32_t rtpDataLength) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 209 | : _ptrRTPDataBegin(rtpData), |
| 210 | _ptrRTPDataEnd(rtpData ? (rtpData + rtpDataLength) : NULL) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 211 | } |
| 212 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 213 | RTPHeaderParser::~RTPHeaderParser() { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 214 | } |
| 215 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 216 | bool 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 237 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 238 | /* 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 244 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 245 | /* 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 255 | |
solenberg@webrtc.org | d8a6e72 | 2013-03-26 14:02:30 +0000 | [diff] [blame] | 256 | const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin; |
| 257 | if (length < kRtcpMinHeaderLength) { |
| 258 | return false; |
| 259 | } |
| 260 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 261 | const uint8_t V = _ptrRTPDataBegin[0] >> 6; |
solenberg@webrtc.org | d8a6e72 | 2013-03-26 14:02:30 +0000 | [diff] [blame] | 262 | if (V != kRtcpExpectedVersion) { |
| 263 | return false; |
| 264 | } |
| 265 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 266 | const uint8_t payloadType = _ptrRTPDataBegin[1]; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 267 | bool RTCP = false; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 268 | switch (payloadType) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 269 | case 192: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 270 | RTCP = true; |
| 271 | break; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 272 | case 193: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 273 | // not supported |
| 274 | // pass through and check for a potential RTP packet |
| 275 | break; |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 276 | case 195: |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 277 | 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.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 285 | RTCP = true; |
| 286 | break; |
| 287 | } |
| 288 | return RTCP; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 289 | } |
| 290 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 291 | bool RTPHeaderParser::Parse(RTPHeader& header, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 292 | RtpHeaderExtensionMap* ptrExtensionMap) const { |
| 293 | const ptrdiff_t length = _ptrRTPDataEnd - _ptrRTPDataBegin; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 294 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 295 | if (length < 12) { |
| 296 | return false; |
| 297 | } |
| 298 | |
| 299 | // Version |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 300 | const uint8_t V = _ptrRTPDataBegin[0] >> 6; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 301 | // 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.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 305 | const uint8_t CC = _ptrRTPDataBegin[0] & 0x0f; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 306 | const bool M = ((_ptrRTPDataBegin[1] & 0x80) == 0) ? false : true; |
| 307 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 308 | const uint8_t PT = _ptrRTPDataBegin[1] & 0x7f; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 309 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 310 | const uint16_t sequenceNumber = (_ptrRTPDataBegin[2] << 8) + |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 311 | _ptrRTPDataBegin[3]; |
| 312 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 313 | const uint8_t* ptr = &_ptrRTPDataBegin[4]; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 314 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 315 | uint32_t RTPTimestamp = *ptr++ << 24; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 316 | RTPTimestamp += *ptr++ << 16; |
| 317 | RTPTimestamp += *ptr++ << 8; |
| 318 | RTPTimestamp += *ptr++; |
| 319 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 320 | uint32_t SSRC = *ptr++ << 24; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 321 | SSRC += *ptr++ << 16; |
| 322 | SSRC += *ptr++ << 8; |
| 323 | SSRC += *ptr++; |
| 324 | |
| 325 | if (V != 2) { |
| 326 | return false; |
| 327 | } |
| 328 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 329 | const uint8_t CSRCocts = CC * 4; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 330 | |
| 331 | if ((ptr + CSRCocts) > _ptrRTPDataEnd) { |
| 332 | return false; |
| 333 | } |
| 334 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 335 | header.markerBit = M; |
| 336 | header.payloadType = PT; |
| 337 | header.sequenceNumber = sequenceNumber; |
| 338 | header.timestamp = RTPTimestamp; |
| 339 | header.ssrc = SSRC; |
| 340 | header.numCSRCs = CC; |
| 341 | header.paddingLength = P ? *(_ptrRTPDataEnd - 1) : 0; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 342 | |
| 343 | for (unsigned int i = 0; i < CC; ++i) { |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 344 | uint32_t CSRC = *ptr++ << 24; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 345 | CSRC += *ptr++ << 16; |
| 346 | CSRC += *ptr++ << 8; |
| 347 | CSRC += *ptr++; |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 348 | header.arrOfCSRCs[i] = CSRC; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 349 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 350 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 351 | header.headerLength = 12 + CSRCocts; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 352 | |
| 353 | // If in effect, MAY be omitted for those packets for which the offset |
| 354 | // is zero. |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 355 | header.extension.transmissionTimeOffset = 0; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 356 | |
solenberg@webrtc.org | 7ebbea1 | 2013-05-16 11:10:31 +0000 | [diff] [blame] | 357 | // May not be present in packet. |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 358 | header.extension.absoluteSendTime = 0; |
solenberg@webrtc.org | 7ebbea1 | 2013-05-16 11:10:31 +0000 | [diff] [blame] | 359 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 360 | if (X) { |
| 361 | /* RTP header extension, RFC 3550. |
| 362 | 0 1 2 3 |
| 363 | 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 |
| 364 | +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 365 | | defined by profile | length | |
| 366 | +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 367 | | header extension | |
| 368 | | .... | |
| 369 | */ |
| 370 | const ptrdiff_t remain = _ptrRTPDataEnd - ptr; |
| 371 | if (remain < 4) { |
| 372 | return false; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 373 | } |
| 374 | |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 375 | header.headerLength += 4; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 376 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 377 | uint16_t definedByProfile = *ptr++ << 8; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 378 | definedByProfile += *ptr++; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 379 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 380 | uint16_t XLen = *ptr++ << 8; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 381 | XLen += *ptr++; // in 32 bit words |
| 382 | XLen *= 4; // in octs |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 383 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 384 | if (remain < (4 + XLen)) { |
| 385 | return false; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 386 | } |
pbos@webrtc.org | 3004c79 | 2013-05-07 12:36:21 +0000 | [diff] [blame] | 387 | if (definedByProfile == kRtpOneByteHeaderExtensionId) { |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 388 | const uint8_t* ptrRTPDataExtensionEnd = ptr + XLen; |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 389 | ParseOneByteExtensionHeader(header, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 390 | ptrExtensionMap, |
| 391 | ptrRTPDataExtensionEnd, |
| 392 | ptr); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 393 | } |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 394 | header.headerLength += XLen; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 395 | } |
| 396 | return true; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 397 | } |
| 398 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 399 | void RTPHeaderParser::ParseOneByteExtensionHeader( |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 400 | RTPHeader& header, |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 401 | const RtpHeaderExtensionMap* ptrExtensionMap, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 402 | const uint8_t* ptrRTPDataExtensionEnd, |
| 403 | const uint8_t* ptr) const { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 404 | if (!ptrExtensionMap) { |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 405 | return; |
| 406 | } |
| 407 | |
| 408 | while (ptrRTPDataExtensionEnd - ptr > 0) { |
| 409 | // 0 |
| 410 | // 0 1 2 3 4 5 6 7 |
| 411 | // +-+-+-+-+-+-+-+-+ |
| 412 | // | ID | len | |
| 413 | // +-+-+-+-+-+-+-+-+ |
| 414 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 415 | const uint8_t id = (*ptr & 0xf0) >> 4; |
| 416 | const uint8_t len = (*ptr & 0x0f); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 417 | ptr++; |
| 418 | |
| 419 | if (id == 15) { |
| 420 | WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1, |
| 421 | "Ext id: 15 encountered, parsing terminated."); |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 422 | return; |
| 423 | } |
| 424 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 425 | RTPExtensionType type; |
| 426 | if (ptrExtensionMap->GetType(id, &type) != 0) { |
| 427 | WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1, |
| 428 | "Failed to find extension id: %d", id); |
| 429 | return; |
| 430 | } |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 431 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 432 | switch (type) { |
| 433 | case kRtpExtensionTransmissionTimeOffset: { |
| 434 | if (len != 2) { |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 435 | WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 436 | "Incorrect transmission time offset len: %d", len); |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 437 | return; |
| 438 | } |
| 439 | // 0 1 2 3 |
| 440 | // 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 |
| 441 | // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 442 | // | ID | len=2 | transmission offset | |
| 443 | // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 444 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 445 | int32_t transmissionTimeOffset = *ptr++ << 16; |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 446 | transmissionTimeOffset += *ptr++ << 8; |
| 447 | transmissionTimeOffset += *ptr++; |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 448 | header.extension.transmissionTimeOffset = |
| 449 | transmissionTimeOffset; |
asapersson@webrtc.org | d2e6779 | 2012-06-28 07:53:15 +0000 | [diff] [blame] | 450 | if (transmissionTimeOffset & 0x800000) { |
| 451 | // Negative offset, correct sign for Word24 to Word32. |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 452 | header.extension.transmissionTimeOffset |= 0xFF000000; |
asapersson@webrtc.org | d2e6779 | 2012-06-28 07:53:15 +0000 | [diff] [blame] | 453 | } |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 454 | break; |
| 455 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 456 | case kRtpExtensionAudioLevel: { |
| 457 | // --- Only used for debugging --- |
| 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=0 |V| level | 0x00 | 0x00 | |
| 462 | // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 463 | // |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 464 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 465 | // Parse out the fields but only use it for debugging for now. |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 466 | // const uint8_t V = (*ptr & 0x80) >> 7; |
| 467 | // const uint8_t level = (*ptr & 0x7f); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 468 | // DEBUG_PRINT("RTP_AUDIO_LEVEL_UNIQUE_ID: ID=%u, len=%u, V=%u, |
| 469 | // level=%u", ID, len, V, level); |
pwestin@webrtc.org | 6c1d415 | 2012-01-04 17:04:51 +0000 | [diff] [blame] | 470 | break; |
| 471 | } |
solenberg@webrtc.org | 7ebbea1 | 2013-05-16 11:10:31 +0000 | [diff] [blame] | 472 | case kRtpExtensionAbsoluteSendTime: { |
| 473 | if (len != 2) { |
| 474 | WEBRTC_TRACE(kTraceWarning, kTraceRtpRtcp, -1, |
| 475 | "Incorrect absolute send time len: %d", len); |
| 476 | return; |
| 477 | } |
| 478 | // 0 1 2 3 |
| 479 | // 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 |
| 480 | // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 481 | // | ID | len=2 | absolute send time | |
| 482 | // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 483 | |
| 484 | uint32_t absoluteSendTime = *ptr++ << 16; |
| 485 | absoluteSendTime += *ptr++ << 8; |
| 486 | absoluteSendTime += *ptr++; |
stefan@webrtc.org | a5cb98c | 2013-05-29 12:12:51 +0000 | [diff] [blame^] | 487 | header.extension.absoluteSendTime = absoluteSendTime; |
solenberg@webrtc.org | 7ebbea1 | 2013-05-16 11:10:31 +0000 | [diff] [blame] | 488 | break; |
| 489 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 490 | default: { |
mflodman@webrtc.org | ba853c9 | 2012-08-10 14:30:53 +0000 | [diff] [blame] | 491 | WEBRTC_TRACE(kTraceStream, kTraceRtpRtcp, -1, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 492 | "Extension type not implemented."); |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 493 | return; |
| 494 | } |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 495 | } |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 496 | uint8_t num_bytes = ParsePaddingBytes(ptrRTPDataExtensionEnd, ptr); |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 497 | ptr += num_bytes; |
| 498 | } |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 499 | } |
| 500 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 501 | uint8_t RTPHeaderParser::ParsePaddingBytes( |
| 502 | const uint8_t* ptrRTPDataExtensionEnd, |
| 503 | const uint8_t* ptr) const { |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 504 | |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 505 | uint8_t num_zero_bytes = 0; |
asapersson@webrtc.org | 5249cc8 | 2011-12-16 14:31:37 +0000 | [diff] [blame] | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 516 | // RTP payload parser |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 517 | RTPPayloadParser::RTPPayloadParser(const RtpVideoCodecTypes videoType, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 518 | const uint8_t* payloadData, |
| 519 | uint16_t payloadDataLength, |
| 520 | int32_t id) |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 521 | : |
| 522 | _id(id), |
| 523 | _dataPtr(payloadData), |
| 524 | _dataLength(payloadDataLength), |
| 525 | _videoType(videoType) { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 526 | } |
| 527 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 528 | RTPPayloadParser::~RTPPayloadParser() { |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 529 | } |
| 530 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 531 | bool RTPPayloadParser::Parse(RTPPayload& parsedPacket) const { |
| 532 | parsedPacket.SetType(_videoType); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 533 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 534 | switch (_videoType) { |
pbos@webrtc.org | 8911ce4 | 2013-03-18 16:39:03 +0000 | [diff] [blame] | 535 | case kRtpGenericVideo: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 536 | return ParseGeneric(parsedPacket); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 537 | case kRtpVp8Video: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 538 | return ParseVP8(parsedPacket); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 539 | default: |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 540 | return false; |
| 541 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 542 | } |
| 543 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 544 | bool RTPPayloadParser::ParseGeneric(RTPPayload& /*parsedPacket*/) const { |
| 545 | return false; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 546 | } |
| 547 | |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 548 | // |
| 549 | // VP8 format: |
| 550 | // |
| 551 | // Payload descriptor |
henrik.lundin@webrtc.org | 6f2c016 | 2011-11-24 12:52:40 +0000 | [diff] [blame] | 552 | // 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.org | eda86dc | 2011-12-13 14:11:06 +0000 | [diff] [blame] | 562 | // T/K: |TID:Y| KEYIDX | (OPTIONAL) |
henrik.lundin@webrtc.org | 6f2c016 | 2011-11-24 12:52:40 +0000 | [diff] [blame] | 563 | // +-+-+-+-+-+-+-+-+ |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 564 | // |
| 565 | // Payload header (considered part of the actual payload, sent to decoder) |
henrik.lundin@webrtc.org | 6f2c016 | 2011-11-24 12:52:40 +0000 | [diff] [blame] | 566 | // 0 1 2 3 4 5 6 7 |
| 567 | // +-+-+-+-+-+-+-+-+ |
| 568 | // |Size0|H| VER |P| |
| 569 | // +-+-+-+-+-+-+-+-+ |
| 570 | // | ... | |
| 571 | // + + |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 572 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 573 | bool RTPPayloadParser::ParseVP8(RTPPayload& parsedPacket) const { |
| 574 | RTPPayloadVP8* vp8 = &parsedPacket.info.VP8; |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 575 | const uint8_t* dataPtr = _dataPtr; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 576 | int dataLength = _dataLength; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 577 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 578 | // 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 583 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 584 | if (vp8->partitionID > 8) { |
| 585 | // Weak check for corrupt data: PartID MUST NOT be larger than 8. |
| 586 | return false; |
| 587 | } |
andrew@webrtc.org | 7fe219f | 2012-02-01 02:40:37 +0000 | [diff] [blame] | 588 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 589 | // Advance dataPtr and decrease remaining payload size |
| 590 | dataPtr++; |
| 591 | dataLength--; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 592 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 593 | 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 599 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 600 | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 605 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 606 | // 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.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 618 | } |
| 619 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 620 | int RTPPayloadParser::ParseVP8FrameSize(RTPPayload& parsedPacket, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 621 | const uint8_t* dataPtr, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 622 | int dataLength) const { |
| 623 | if (parsedPacket.frameType != kIFrame) { |
| 624 | // Included in payload header for I-frames. |
pwestin@webrtc.org | 075e91f | 2011-11-02 23:14:58 +0000 | [diff] [blame] | 625 | return 0; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 626 | } |
| 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.org | 075e91f | 2011-11-02 23:14:58 +0000 | [diff] [blame] | 636 | } |
| 637 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 638 | int RTPPayloadParser::ParseVP8Extension(RTPPayloadVP8* vp8, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 639 | const uint8_t* dataPtr, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 648 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 649 | // Advance dataPtr and decrease remaining payload size |
| 650 | dataPtr++; |
| 651 | parsedBytes++; |
| 652 | dataLength--; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 653 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 654 | if (vp8->hasPictureID) { |
| 655 | if (ParseVP8PictureID(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) { |
| 656 | return -1; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 657 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 658 | } |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 659 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 660 | if (vp8->hasTl0PicIdx) { |
| 661 | if (ParseVP8Tl0PicIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) { |
| 662 | return -1; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 663 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 664 | } |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 665 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 666 | if (vp8->hasTID || vp8->hasKeyIdx) { |
| 667 | if (ParseVP8TIDAndKeyIdx(vp8, &dataPtr, &dataLength, &parsedBytes) != 0) { |
| 668 | return -1; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 669 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 670 | } |
| 671 | return parsedBytes; |
henrik.lundin@webrtc.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 672 | } |
| 673 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 674 | int RTPPayloadParser::ParseVP8PictureID(RTPPayloadVP8* vp8, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 675 | const uint8_t** dataPtr, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 681 | (*dataPtr)++; |
| 682 | (*parsedBytes)++; |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 683 | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 691 | } |
| 692 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 693 | int RTPPayloadParser::ParseVP8Tl0PicIdx(RTPPayloadVP8* vp8, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 694 | const uint8_t** dataPtr, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 703 | } |
| 704 | |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 705 | int RTPPayloadParser::ParseVP8TIDAndKeyIdx(RTPPayloadVP8* vp8, |
pbos@webrtc.org | 2f44673 | 2013-04-08 11:08:41 +0000 | [diff] [blame] | 706 | const uint8_t** dataPtr, |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 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.org | 8571af7 | 2011-08-29 15:37:12 +0000 | [diff] [blame] | 721 | } |
henrike@webrtc.org | d5657c2 | 2012-02-08 23:41:49 +0000 | [diff] [blame] | 722 | |
| 723 | } // namespace ModuleRTPUtility |
| 724 | |
| 725 | } // namespace webrtc |