1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
|
/*
* Copyright 2018 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <base/logging.h>
#include <iomanip>
#include <sstream>
#include <type_traits>
#include "avrcp_packet.h"
namespace bluetooth {
namespace avrcp {
std::unique_ptr<PacketBuilder> PacketBuilder::MakeBuilder(
CType type, uint8_t subunit_type, uint8_t subunit_id, Opcode opcode,
std::unique_ptr<::bluetooth::PacketBuilder> payload) {
std::unique_ptr<PacketBuilder> builder = std::unique_ptr<PacketBuilder>(
new PacketBuilder(type, subunit_type, subunit_id, opcode));
builder->payload_ = std::move(payload);
return builder;
}
size_t PacketBuilder::size() const {
// The size of the header for an Packet is 3
return payload_->size() + Packet::kMinSize();
}
bool PacketBuilder::Serialize(const std::shared_ptr<::bluetooth::Packet>& pkt) {
ReserveSpace(pkt, size());
// Push the header for the packet
PushHeader(pkt);
// Push the payload for the packet
return payload_->Serialize(pkt);
}
void PacketBuilder::PushHeader(
const std::shared_ptr<::bluetooth::Packet>& pkt) {
AddPayloadOctets1(pkt, static_cast<uint8_t>(c_type_));
AddPayloadOctets1(pkt, (subunit_type_ << 3) | subunit_id_);
AddPayloadOctets1(pkt, static_cast<uint8_t>(opcode_));
}
bool PacketBuilder::PushCompanyId(
const std::shared_ptr<::bluetooth::Packet>& pkt, uint32_t company_id) {
company_id = base::ByteSwap(company_id);
for (int i = 0; i < 3; i++) {
company_id >>= 8;
AddPayloadOctets1(pkt, company_id & 0xFF);
}
return true;
}
std::shared_ptr<Packet> Packet::Parse(
std::shared_ptr<::bluetooth::Packet> pkt) {
return std::shared_ptr<Packet>(new Packet(pkt));
}
CType Packet::GetCType() const {
auto value = *begin() & 0x0F;
return static_cast<CType>(value);
}
uint8_t Packet::GetSubunitType() const {
return *(begin() + static_cast<size_t>(1)) >> 3;
}
uint8_t Packet::GetSubunitId() const {
return *(begin() + static_cast<size_t>(1)) & 0b00000111;
}
Opcode Packet::GetOpcode() const {
auto value = *(begin() + static_cast<size_t>(2));
return static_cast<Opcode>(value);
}
bool Packet::IsValid() const { return size() >= kMinSize(); }
std::string Packet::ToString() const {
std::stringstream ss;
ss << "avrcp::Packet: " << std::endl;
ss << " └ cType = " << GetCType() << std::endl;
ss << " └ Subunit Type = " << loghex(GetSubunitType()) << std::endl;
ss << " └ Subunit ID = " << loghex(GetSubunitId()) << std::endl;
ss << " └ OpCode = " << GetOpcode() << std::endl;
ss << " └ Payload =";
for (auto it = begin() + static_cast<size_t>(3); it != end(); it++) {
ss << " " << loghex(*it);
}
ss << std::endl;
return ss.str();
}
std::pair<size_t, size_t> Packet::GetPayloadIndecies() const {
return std::pair<size_t, size_t>(packet_start_index_ + 3, packet_end_index_);
}
} // namespace avrcp
} // namespace bluetooth
|
