vendor_libs/test_vendor_lib/src/acl_packet.cc

//
// Copyright 2017 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.
//

#define LOG_TAG "acl_packet"

#include "acl_packet.h"

#include "base/logging.h"
#include "osi/include/log.h"
#include "stack/include/hcidefs.h"

using std::vector;

namespace test_vendor_lib {

AclPacket::AclPacket(uint16_t channel,
                     AclPacket::PacketBoundaryFlags packet_boundary,
                     AclPacket::BroadcastFlags broadcast)
    : raw_packet_({static_cast<uint8_t>(channel & 0xff),
                   static_cast<uint8_t>(((channel >> 8) & 0x0f) |
                                        ((packet_boundary & 0x3) << 4) |
                                        (broadcast & 0x3) << 6),
                   0x00, 0x00}) {}

void AclPacket::AddPayloadOctets(size_t octets, const vector<uint8_t>& bytes) {
  CHECK(bytes.size() == octets);

  raw_packet_.insert(raw_packet_.end(), bytes.begin(), bytes.end());

  raw_packet_[2] =
      static_cast<uint8_t>((raw_packet_.size() - kHeaderSize) & 0xff);
  raw_packet_[3] =
      static_cast<uint8_t>(((raw_packet_.size() - kHeaderSize) >> 8) & 0xff);
}

void AclPacket::AddPayloadOctets(size_t octets, uint64_t value) {
  vector<uint8_t> val_vector;

  uint64_t v = value;

  CHECK(octets <= sizeof(uint64_t));

  for (size_t i = 0; i < octets; i++) {
    val_vector.push_back(v & 0xff);
    v = v >> 8;
  }

  CHECK(v == 0);

  AddPayloadOctets(octets, val_vector);
}

size_t AclPacket::GetPacketSize() const { return raw_packet_.size(); }

const std::vector<uint8_t>& AclPacket::GetPacket() const { return raw_packet_; }

}  // namespace test_vendor_lib