1e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org/*
2e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  Copyright (c) 2014 The WebRTC project authors. All Rights Reserved.
3e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *
4e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  Use of this source code is governed by a BSD-style license
5e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  that can be found in the LICENSE file in the root of the source
6e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  tree. An additional intellectual property rights grant can be found
7e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  in the file PATENTS.  All contributing project authors may
8e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org *  be found in the AUTHORS file in the root of the source tree.
9e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org */
10e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
11e5abc854f3dc47de16067c2a41476c39b7626722henrik.lundin@webrtc.org#include "webrtc/modules/audio_coding/neteq/tools/packet.h"
12e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org#include "webrtc/modules/rtp_rtcp/interface/rtp_header_parser.h"
13e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
14e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgnamespace webrtc {
15e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgnamespace test {
16e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
17e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgPacket::Packet(uint8_t* packet_memory,
18e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               size_t allocated_bytes,
19e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               double time_ms,
20e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               const RtpHeaderParser& parser)
21e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    : payload_memory_(packet_memory),
22e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_(NULL),
23e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      packet_length_bytes_(allocated_bytes),
24e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_length_bytes_(0),
25e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_packet_length_bytes_(allocated_bytes),
26e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_payload_length_bytes_(0),
27e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      time_ms_(time_ms) {
28e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  valid_header_ = ParseHeader(parser);
29e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
30e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
31e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgPacket::Packet(uint8_t* packet_memory,
32e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               size_t allocated_bytes,
33e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               size_t virtual_packet_length_bytes,
34e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               double time_ms,
35e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               const RtpHeaderParser& parser)
36e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    : payload_memory_(packet_memory),
37e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_(NULL),
38e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      packet_length_bytes_(allocated_bytes),
39e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_length_bytes_(0),
40e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_packet_length_bytes_(virtual_packet_length_bytes),
41e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_payload_length_bytes_(0),
42e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      time_ms_(time_ms) {
43e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  valid_header_ = ParseHeader(parser);
44e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
45e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
46e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgPacket::Packet(uint8_t* packet_memory, size_t allocated_bytes, double time_ms)
47e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    : payload_memory_(packet_memory),
48e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_(NULL),
49e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      packet_length_bytes_(allocated_bytes),
50e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_length_bytes_(0),
51e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_packet_length_bytes_(allocated_bytes),
52e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_payload_length_bytes_(0),
53e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      time_ms_(time_ms) {
54e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  scoped_ptr<RtpHeaderParser> parser(RtpHeaderParser::Create());
55e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  valid_header_ = ParseHeader(*parser);
56e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
57e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
58e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgPacket::Packet(uint8_t* packet_memory,
59e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               size_t allocated_bytes,
60e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               size_t virtual_packet_length_bytes,
61e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org               double time_ms)
62e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    : payload_memory_(packet_memory),
63e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_(NULL),
64e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      packet_length_bytes_(allocated_bytes),
65e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_length_bytes_(0),
66e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_packet_length_bytes_(virtual_packet_length_bytes),
67e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_payload_length_bytes_(0),
68e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      time_ms_(time_ms) {
69e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  scoped_ptr<RtpHeaderParser> parser(RtpHeaderParser::Create());
70e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  valid_header_ = ParseHeader(*parser);
71e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
72e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
73e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgbool Packet::ExtractRedHeaders(std::list<RTPHeader*>* headers) const {
74e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  //
75e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  //  0                   1                    2                   3
76e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  //  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
77e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
78e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // |1|   block PT  |  timestamp offset         |   block length    |
79e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
80e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // |1|    ...                                                      |
81e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
82e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // |0|   block PT  |
83e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // +-+-+-+-+-+-+-+-+
84e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  //
85e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
86e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(payload_);
87e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  const uint8_t* payload_ptr = payload_;
88e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  const uint8_t* payload_end_ptr = payload_ptr + payload_length_bytes_;
89e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
90e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // Find all RED headers with the extension bit set to 1. That is, all headers
91e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // but the last one.
92e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  while ((payload_ptr < payload_end_ptr) && (*payload_ptr & 0x80)) {
93e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    RTPHeader* header = new RTPHeader;
94e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    CopyToHeader(header);
95e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    header->payloadType = payload_ptr[0] & 0x7F;
96e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    uint32_t offset = (payload_ptr[1] << 6) + ((payload_ptr[2] & 0xFC) >> 2);
97e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    header->timestamp -= offset;
98e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    headers->push_front(header);
99e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    payload_ptr += 4;
100e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  }
101e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  // Last header.
102e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(payload_ptr < payload_end_ptr);
103e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  if (payload_ptr >= payload_end_ptr) {
104e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    return false;  // Payload too short.
105e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  }
106e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  RTPHeader* header = new RTPHeader;
107e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  CopyToHeader(header);
108e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  header->payloadType = payload_ptr[0] & 0x7F;
109e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  headers->push_front(header);
110e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  return true;
111e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
112e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
113e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgvoid Packet::DeleteRedHeaders(std::list<RTPHeader*>* headers) {
114e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  while (!headers->empty()) {
115e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    delete headers->front();
116e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    headers->pop_front();
117e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  }
118e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
119e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
120e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgbool Packet::ParseHeader(const RtpHeaderParser& parser) {
121e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  bool valid_header = parser.Parse(
122e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      payload_memory_.get(), static_cast<int>(packet_length_bytes_), &header_);
123e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(valid_header);
124e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  if (!valid_header) {
125e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org    return false;
126e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  }
127e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(header_.headerLength <= packet_length_bytes_);
128e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  payload_ = &payload_memory_[header_.headerLength];
129e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(packet_length_bytes_ >= header_.headerLength);
130e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  payload_length_bytes_ = packet_length_bytes_ - header_.headerLength;
131e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  assert(virtual_packet_length_bytes_ >= header_.headerLength);
132e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  virtual_payload_length_bytes_ =
133e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      virtual_packet_length_bytes_ - header_.headerLength;
134e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  return true;
135e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
136e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
137e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.orgvoid Packet::CopyToHeader(RTPHeader* destination) const {
138e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->markerBit = header_.markerBit;
139e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->payloadType = header_.payloadType;
140e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->sequenceNumber = header_.sequenceNumber;
141e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->timestamp = header_.timestamp;
142e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->ssrc = header_.ssrc;
143e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->numCSRCs = header_.numCSRCs;
144e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->paddingLength = header_.paddingLength;
145e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->headerLength = header_.headerLength;
146e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  destination->payload_type_frequency = header_.payload_type_frequency;
147e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  memcpy(&destination->arrOfCSRCs,
148e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org         &header_.arrOfCSRCs,
149e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org         sizeof(header_.arrOfCSRCs));
150e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org  memcpy(
151e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org      &destination->extension, &header_.extension, sizeof(header_.extension));
152e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}
153e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org
154e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}  // namespace test
155e7d9de31cd13fb915c858c54a84ab39f788c3c69henrik.lundin@webrtc.org}  // namespace webrtc
156