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