1 // Copyright 2023 The Pigweed Authors
2 //
3 // Licensed under the Apache License, Version 2.0 (the "License"); you may not
4 // use this file except in compliance with the License. You may obtain a copy of
5 // the License at
6 //
7 // https://www.apache.org/licenses/LICENSE-2.0
8 //
9 // Unless required by applicable law or agreed to in writing, software
10 // distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
11 // WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
12 // License for the specific language governing permissions and limitations under
13 // the License.
14
15 #include "pw_bluetooth_sapphire/internal/host/sm/packet.h"
16
17 #include <unordered_map>
18
19 #include "pw_bluetooth_sapphire/internal/host/common/log.h"
20 #include "pw_bluetooth_sapphire/internal/host/sm/smp.h"
21 #include "pw_bluetooth_sapphire/internal/host/sm/types.h"
22
23 namespace bt::sm {
24
PacketReader(const ByteBuffer * buffer)25 PacketReader::PacketReader(const ByteBuffer* buffer)
26 : PacketView<Header>(buffer, buffer->size() - sizeof(Header)) {}
27
ValidPacketReader(const ByteBuffer * buffer)28 ValidPacketReader::ValidPacketReader(const ByteBuffer* buffer)
29 : PacketReader(buffer) {}
30
ParseSdu(const ByteBufferPtr & sdu)31 fit::result<ErrorCode, ValidPacketReader> ValidPacketReader::ParseSdu(
32 const ByteBufferPtr& sdu) {
33 PW_CHECK(sdu);
34 size_t length = sdu->size();
35 if (length < sizeof(Header)) {
36 bt_log(DEBUG, "sm", "PDU too short!");
37 return fit::error(ErrorCode::kInvalidParameters);
38 }
39 auto reader = PacketReader(sdu.get());
40 auto expected_payload_size = kCodeToPayloadSize.find(reader.code());
41 if (expected_payload_size == kCodeToPayloadSize.end()) {
42 bt_log(DEBUG, "sm", "smp code not recognized: %#.2X", reader.code());
43 return fit::error(ErrorCode::kCommandNotSupported);
44 }
45 if (reader.payload_size() != expected_payload_size->second) {
46 bt_log(DEBUG, "sm", "malformed packet with code %#.2X", reader.code());
47 return fit::error(ErrorCode::kInvalidParameters);
48 }
49 return fit::ok(ValidPacketReader(sdu.get()));
50 }
51
PacketWriter(Code code,MutableByteBuffer * buffer)52 PacketWriter::PacketWriter(Code code, MutableByteBuffer* buffer)
53 : MutablePacketView<Header>(buffer, buffer->size() - sizeof(Header)) {
54 mutable_header()->code = code;
55 }
56
57 } // namespace bt::sm
58