niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 1 | /* |
tina.legrand@webrtc.org | 16b6b90 | 2012-04-12 11:02:38 +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 "RTPFile.h" |
kjellander@webrtc.org | 543c3ea | 2011-11-23 12:20:35 +0000 | [diff] [blame] | 12 | |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 13 | #include <stdlib.h> |
pkasting@chromium.org | 4591fbd | 2014-11-20 22:28:14 +0000 | [diff] [blame] | 14 | #include <limits> |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 15 | |
| 16 | #ifdef WIN32 |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 17 | #include <Winsock2.h> |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 18 | #else |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 19 | #include <arpa/inet.h> |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 20 | #endif |
| 21 | |
Fredrik Solenberg | bbf21a3 | 2018-04-12 22:44:09 +0200 | [diff] [blame] | 22 | #include "modules/include/module_common_types.h" |
kjellander@webrtc.org | 3c0aae1 | 2014-09-04 09:55:40 +0000 | [diff] [blame] | 23 | // TODO(tlegrand): Consider removing usage of gtest. |
Mirko Bonadei | 92ea95e | 2017-09-15 06:47:31 +0200 | [diff] [blame] | 24 | #include "test/gtest.h" |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 25 | |
tina.legrand@webrtc.org | 554ae1a | 2011-12-16 10:09:04 +0000 | [diff] [blame] | 26 | namespace webrtc { |
| 27 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 28 | void RTPStream::ParseRTPHeader(WebRtcRTPHeader* rtpInfo, |
| 29 | const uint8_t* rtpHeader) { |
| 30 | rtpInfo->header.payloadType = rtpHeader[1]; |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 31 | rtpInfo->header.sequenceNumber = |
| 32 | (static_cast<uint16_t>(rtpHeader[2]) << 8) | rtpHeader[3]; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 33 | rtpInfo->header.timestamp = (static_cast<uint32_t>(rtpHeader[4]) << 24) | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 34 | (static_cast<uint32_t>(rtpHeader[5]) << 16) | |
| 35 | (static_cast<uint32_t>(rtpHeader[6]) << 8) | |
| 36 | rtpHeader[7]; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 37 | rtpInfo->header.ssrc = (static_cast<uint32_t>(rtpHeader[8]) << 24) | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 38 | (static_cast<uint32_t>(rtpHeader[9]) << 16) | |
| 39 | (static_cast<uint32_t>(rtpHeader[10]) << 8) | |
| 40 | rtpHeader[11]; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 41 | } |
| 42 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 43 | void RTPStream::MakeRTPheader(uint8_t* rtpHeader, |
| 44 | uint8_t payloadType, |
| 45 | int16_t seqNo, |
| 46 | uint32_t timeStamp, |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 47 | uint32_t ssrc) { |
pkasting@chromium.org | d324546 | 2015-02-23 21:28:22 +0000 | [diff] [blame] | 48 | rtpHeader[0] = 0x80; |
| 49 | rtpHeader[1] = payloadType; |
| 50 | rtpHeader[2] = (seqNo >> 8) & 0xFF; |
| 51 | rtpHeader[3] = seqNo & 0xFF; |
| 52 | rtpHeader[4] = timeStamp >> 24; |
| 53 | rtpHeader[5] = (timeStamp >> 16) & 0xFF; |
| 54 | rtpHeader[6] = (timeStamp >> 8) & 0xFF; |
| 55 | rtpHeader[7] = timeStamp & 0xFF; |
| 56 | rtpHeader[8] = ssrc >> 24; |
| 57 | rtpHeader[9] = (ssrc >> 16) & 0xFF; |
| 58 | rtpHeader[10] = (ssrc >> 8) & 0xFF; |
| 59 | rtpHeader[11] = ssrc & 0xFF; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 60 | } |
| 61 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 62 | RTPPacket::RTPPacket(uint8_t payloadType, |
| 63 | uint32_t timeStamp, |
| 64 | int16_t seqNo, |
| 65 | const uint8_t* payloadData, |
| 66 | size_t payloadSize, |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 67 | uint32_t frequency) |
| 68 | : payloadType(payloadType), |
| 69 | timeStamp(timeStamp), |
| 70 | seqNo(seqNo), |
| 71 | payloadSize(payloadSize), |
| 72 | frequency(frequency) { |
| 73 | if (payloadSize > 0) { |
| 74 | this->payloadData = new uint8_t[payloadSize]; |
| 75 | memcpy(this->payloadData, payloadData, payloadSize); |
| 76 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 77 | } |
| 78 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 79 | RTPPacket::~RTPPacket() { |
| 80 | delete[] payloadData; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 81 | } |
| 82 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 83 | RTPBuffer::RTPBuffer() { |
| 84 | _queueRWLock = RWLockWrapper::CreateRWLock(); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 85 | } |
| 86 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 87 | RTPBuffer::~RTPBuffer() { |
| 88 | delete _queueRWLock; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 89 | } |
| 90 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 91 | void RTPBuffer::Write(const uint8_t payloadType, |
| 92 | const uint32_t timeStamp, |
| 93 | const int16_t seqNo, |
| 94 | const uint8_t* payloadData, |
| 95 | const size_t payloadSize, |
| 96 | uint32_t frequency) { |
| 97 | RTPPacket* packet = new RTPPacket(payloadType, timeStamp, seqNo, payloadData, |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 98 | payloadSize, frequency); |
| 99 | _queueRWLock->AcquireLockExclusive(); |
| 100 | _rtpQueue.push(packet); |
| 101 | _queueRWLock->ReleaseLockExclusive(); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 102 | } |
| 103 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 104 | size_t RTPBuffer::Read(WebRtcRTPHeader* rtpInfo, |
| 105 | uint8_t* payloadData, |
| 106 | size_t payloadSize, |
| 107 | uint32_t* offset) { |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 108 | _queueRWLock->AcquireLockShared(); |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 109 | RTPPacket* packet = _rtpQueue.front(); |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 110 | _rtpQueue.pop(); |
| 111 | _queueRWLock->ReleaseLockShared(); |
| 112 | rtpInfo->header.markerBit = 1; |
| 113 | rtpInfo->header.payloadType = packet->payloadType; |
| 114 | rtpInfo->header.sequenceNumber = packet->seqNo; |
| 115 | rtpInfo->header.ssrc = 0; |
| 116 | rtpInfo->header.timestamp = packet->timeStamp; |
| 117 | if (packet->payloadSize > 0 && payloadSize >= packet->payloadSize) { |
| 118 | memcpy(payloadData, packet->payloadData, packet->payloadSize); |
| 119 | } else { |
henrik.lundin@webrtc.org | 741711a | 2014-09-25 07:38:14 +0000 | [diff] [blame] | 120 | return 0; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 121 | } |
| 122 | *offset = (packet->timeStamp / (packet->frequency / 1000)); |
tina.legrand@webrtc.org | 554ae1a | 2011-12-16 10:09:04 +0000 | [diff] [blame] | 123 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 124 | return packet->payloadSize; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 125 | } |
| 126 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 127 | bool RTPBuffer::EndOfFile() const { |
| 128 | _queueRWLock->AcquireLockShared(); |
| 129 | bool eof = _rtpQueue.empty(); |
| 130 | _queueRWLock->ReleaseLockShared(); |
| 131 | return eof; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 132 | } |
| 133 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 134 | void RTPFile::Open(const char* filename, const char* mode) { |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 135 | if ((_rtpFile = fopen(filename, mode)) == NULL) { |
| 136 | printf("Cannot write file %s.\n", filename); |
| 137 | ADD_FAILURE() << "Unable to write file"; |
| 138 | exit(1); |
| 139 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 140 | } |
| 141 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 142 | void RTPFile::Close() { |
| 143 | if (_rtpFile != NULL) { |
| 144 | fclose(_rtpFile); |
| 145 | _rtpFile = NULL; |
| 146 | } |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 147 | } |
| 148 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 149 | void RTPFile::WriteHeader() { |
| 150 | // Write data in a format that NetEQ and RTP Play can parse |
| 151 | fprintf(_rtpFile, "#!RTPencode%s\n", "1.0"); |
| 152 | uint32_t dummy_variable = 0; |
| 153 | // should be converted to network endian format, but does not matter when 0 |
pkasting@chromium.org | 4591fbd | 2014-11-20 22:28:14 +0000 | [diff] [blame] | 154 | EXPECT_EQ(1u, fwrite(&dummy_variable, 4, 1, _rtpFile)); |
| 155 | EXPECT_EQ(1u, fwrite(&dummy_variable, 4, 1, _rtpFile)); |
| 156 | EXPECT_EQ(1u, fwrite(&dummy_variable, 4, 1, _rtpFile)); |
| 157 | EXPECT_EQ(1u, fwrite(&dummy_variable, 2, 1, _rtpFile)); |
| 158 | EXPECT_EQ(1u, fwrite(&dummy_variable, 2, 1, _rtpFile)); |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 159 | fflush(_rtpFile); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 160 | } |
| 161 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 162 | void RTPFile::ReadHeader() { |
| 163 | uint32_t start_sec, start_usec, source; |
| 164 | uint16_t port, padding; |
| 165 | char fileHeader[40]; |
| 166 | EXPECT_TRUE(fgets(fileHeader, 40, _rtpFile) != 0); |
| 167 | EXPECT_EQ(1u, fread(&start_sec, 4, 1, _rtpFile)); |
| 168 | start_sec = ntohl(start_sec); |
| 169 | EXPECT_EQ(1u, fread(&start_usec, 4, 1, _rtpFile)); |
| 170 | start_usec = ntohl(start_usec); |
| 171 | EXPECT_EQ(1u, fread(&source, 4, 1, _rtpFile)); |
| 172 | source = ntohl(source); |
| 173 | EXPECT_EQ(1u, fread(&port, 2, 1, _rtpFile)); |
| 174 | port = ntohs(port); |
| 175 | EXPECT_EQ(1u, fread(&padding, 2, 1, _rtpFile)); |
| 176 | padding = ntohs(padding); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 177 | } |
| 178 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 179 | void RTPFile::Write(const uint8_t payloadType, |
| 180 | const uint32_t timeStamp, |
| 181 | const int16_t seqNo, |
| 182 | const uint8_t* payloadData, |
| 183 | const size_t payloadSize, |
| 184 | uint32_t frequency) { |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 185 | /* write RTP packet to file */ |
| 186 | uint8_t rtpHeader[12]; |
| 187 | MakeRTPheader(rtpHeader, payloadType, seqNo, timeStamp, 0); |
pkasting@chromium.org | 4591fbd | 2014-11-20 22:28:14 +0000 | [diff] [blame] | 188 | ASSERT_LE(12 + payloadSize + 8, std::numeric_limits<u_short>::max()); |
| 189 | uint16_t lengthBytes = htons(static_cast<u_short>(12 + payloadSize + 8)); |
| 190 | uint16_t plen = htons(static_cast<u_short>(12 + payloadSize)); |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 191 | uint32_t offsetMs; |
tina.legrand@webrtc.org | 554ae1a | 2011-12-16 10:09:04 +0000 | [diff] [blame] | 192 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 193 | offsetMs = (timeStamp / (frequency / 1000)); |
| 194 | offsetMs = htonl(offsetMs); |
pkasting@chromium.org | 4591fbd | 2014-11-20 22:28:14 +0000 | [diff] [blame] | 195 | EXPECT_EQ(1u, fwrite(&lengthBytes, 2, 1, _rtpFile)); |
| 196 | EXPECT_EQ(1u, fwrite(&plen, 2, 1, _rtpFile)); |
| 197 | EXPECT_EQ(1u, fwrite(&offsetMs, 4, 1, _rtpFile)); |
| 198 | EXPECT_EQ(1u, fwrite(&rtpHeader, 12, 1, _rtpFile)); |
| 199 | EXPECT_EQ(payloadSize, fwrite(payloadData, 1, payloadSize, _rtpFile)); |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 200 | } |
| 201 | |
Yves Gerey | 665174f | 2018-06-19 15:03:05 +0200 | [diff] [blame] | 202 | size_t RTPFile::Read(WebRtcRTPHeader* rtpInfo, |
| 203 | uint8_t* payloadData, |
| 204 | size_t payloadSize, |
| 205 | uint32_t* offset) { |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 206 | uint16_t lengthBytes; |
| 207 | uint16_t plen; |
| 208 | uint8_t rtpHeader[12]; |
| 209 | size_t read_len = fread(&lengthBytes, 2, 1, _rtpFile); |
| 210 | /* Check if we have reached end of file. */ |
| 211 | if ((read_len == 0) && feof(_rtpFile)) { |
| 212 | _rtpEOF = true; |
henrik.lundin@webrtc.org | 741711a | 2014-09-25 07:38:14 +0000 | [diff] [blame] | 213 | return 0; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 214 | } |
| 215 | EXPECT_EQ(1u, fread(&plen, 2, 1, _rtpFile)); |
| 216 | EXPECT_EQ(1u, fread(offset, 4, 1, _rtpFile)); |
| 217 | lengthBytes = ntohs(lengthBytes); |
| 218 | plen = ntohs(plen); |
| 219 | *offset = ntohl(*offset); |
| 220 | EXPECT_GT(plen, 11); |
tina.legrand@webrtc.org | 554ae1a | 2011-12-16 10:09:04 +0000 | [diff] [blame] | 221 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 222 | EXPECT_EQ(1u, fread(rtpHeader, 12, 1, _rtpFile)); |
| 223 | ParseRTPHeader(rtpInfo, rtpHeader); |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 224 | EXPECT_EQ(lengthBytes, plen + 8); |
tina.legrand@webrtc.org | 554ae1a | 2011-12-16 10:09:04 +0000 | [diff] [blame] | 225 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 226 | if (plen == 0) { |
henrik.lundin@webrtc.org | 741711a | 2014-09-25 07:38:14 +0000 | [diff] [blame] | 227 | return 0; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 228 | } |
| 229 | if (lengthBytes < 20) { |
henrik.lundin@webrtc.org | 741711a | 2014-09-25 07:38:14 +0000 | [diff] [blame] | 230 | return 0; |
| 231 | } |
pkasting@chromium.org | 4591fbd | 2014-11-20 22:28:14 +0000 | [diff] [blame] | 232 | if (payloadSize < static_cast<size_t>((lengthBytes - 20))) { |
henrik.lundin@webrtc.org | 741711a | 2014-09-25 07:38:14 +0000 | [diff] [blame] | 233 | return 0; |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 234 | } |
| 235 | lengthBytes -= 20; |
| 236 | EXPECT_EQ(lengthBytes, fread(payloadData, 1, lengthBytes, _rtpFile)); |
| 237 | return lengthBytes; |
niklase@google.com | 470e71d | 2011-07-07 08:21:25 +0000 | [diff] [blame] | 238 | } |
| 239 | |
tina.legrand@webrtc.org | d5726a1 | 2013-05-03 07:34:12 +0000 | [diff] [blame] | 240 | } // namespace webrtc |