hci/src/hci_packet_factory.cc

/******************************************************************************
 *
 *  Copyright 2014 Google, Inc.
 *
 *  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 "bt_types.h"
#include "buffer_allocator.h"
#include "hci_internals.h"
#include "hci_layer.h"
#include "hci_packet_factory.h"
#include "hcidefs.h"
#include "hcimsgs.h"
#include "osi/include/allocator.h"

static const allocator_t* buffer_allocator;

static BT_HDR* make_packet(size_t data_size);
static BT_HDR* make_command_no_params(uint16_t opcode);
static BT_HDR* make_command(uint16_t opcode, size_t parameter_size,
                            uint8_t** stream_out);

// Interface functions

static BT_HDR* make_reset(void) { return make_command_no_params(HCI_RESET); }

static BT_HDR* make_read_buffer_size(void) {
  return make_command_no_params(HCI_READ_BUFFER_SIZE);
}

static BT_HDR* make_host_buffer_size(uint16_t acl_size, uint8_t sco_size,
                                     uint16_t acl_count, uint16_t sco_count) {
  uint8_t* stream;
  const uint8_t parameter_size = 2 + 1 + 2 + 2;  // from each of the parameters
  BT_HDR* packet = make_command(HCI_HOST_BUFFER_SIZE, parameter_size, &stream);

  UINT16_TO_STREAM(stream, acl_size);
  UINT8_TO_STREAM(stream, sco_size);
  UINT16_TO_STREAM(stream, acl_count);
  UINT16_TO_STREAM(stream, sco_count);
  return packet;
}

static BT_HDR* make_read_local_version_info(void) {
  return make_command_no_params(HCI_READ_LOCAL_VERSION_INFO);
}

static BT_HDR* make_read_bd_addr(void) {
  return make_command_no_params(HCI_READ_BD_ADDR);
}

static BT_HDR* make_read_local_supported_commands(void) {
  return make_command_no_params(HCI_READ_LOCAL_SUPPORTED_CMDS);
}

static BT_HDR* make_read_local_extended_features(uint8_t page_number) {
  uint8_t* stream;
  const uint8_t parameter_size = 1;
  BT_HDR* packet =
      make_command(HCI_READ_LOCAL_EXT_FEATURES, parameter_size, &stream);

  UINT8_TO_STREAM(stream, page_number);
  return packet;
}

static BT_HDR* make_write_simple_pairing_mode(uint8_t mode) {
  uint8_t* stream;
  const uint8_t parameter_size = 1;
  BT_HDR* packet =
      make_command(HCI_WRITE_SIMPLE_PAIRING_MODE, parameter_size, &stream);

  UINT8_TO_STREAM(stream, mode);
  return packet;
}

static BT_HDR* make_write_secure_connections_host_support(uint8_t mode) {
  uint8_t* stream;
  const uint8_t parameter_size = 1;
  BT_HDR* packet =
      make_command(HCI_WRITE_SECURE_CONNS_SUPPORT, parameter_size, &stream);

  UINT8_TO_STREAM(stream, mode);
  return packet;
}

static BT_HDR* make_set_event_mask(const bt_event_mask_t* event_mask) {
  uint8_t* stream;
  uint8_t parameter_size = sizeof(bt_event_mask_t);
  BT_HDR* packet = make_command(HCI_SET_EVENT_MASK, parameter_size, &stream);

  ARRAY8_TO_STREAM(stream, event_mask->as_array);
  return packet;
}

static BT_HDR* make_ble_write_host_support(uint8_t supported_host,
                                           uint8_t simultaneous_host) {
  uint8_t* stream;
  const uint8_t parameter_size = 1 + 1;
  BT_HDR* packet =
      make_command(HCI_WRITE_LE_HOST_SUPPORT, parameter_size, &stream);

  UINT8_TO_STREAM(stream, supported_host);
  UINT8_TO_STREAM(stream, simultaneous_host);
  return packet;
}

static BT_HDR* make_ble_read_acceptlist_size(void) {
  return make_command_no_params(HCI_BLE_READ_ACCEPTLIST_SIZE);
}

static BT_HDR* make_ble_read_buffer_size(void) {
  return make_command_no_params(HCI_BLE_READ_BUFFER_SIZE);
}

static BT_HDR* make_ble_read_buffer_size_v2(void) {
  return make_command_no_params(HCI_BLE_READ_BUFFER_SIZE_V2);
}

static BT_HDR* make_ble_read_supported_states(void) {
  return make_command_no_params(HCI_BLE_READ_SUPPORTED_STATES);
}

static BT_HDR* make_ble_read_local_supported_features(void) {
  return make_command_no_params(HCI_BLE_READ_LOCAL_SPT_FEAT);
}

static BT_HDR* make_ble_read_resolving_list_size(void) {
  return make_command_no_params(HCI_BLE_READ_RESOLVING_LIST_SIZE);
}

static BT_HDR* make_ble_read_suggested_default_data_length(void) {
  return make_command_no_params(HCI_BLE_READ_DEFAULT_DATA_LENGTH);
}

static BT_HDR* make_ble_read_maximum_data_length(void) {
  return make_command_no_params(HCI_BLE_READ_MAXIMUM_DATA_LENGTH);
}

static BT_HDR* make_ble_read_maximum_advertising_data_length(void) {
  return make_command_no_params(HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH);
}

static BT_HDR* make_ble_read_number_of_supported_advertising_sets(void) {
  return make_command_no_params(
      HCI_LE_READ_NUMBER_OF_SUPPORTED_ADVERTISING_SETS);
}

static BT_HDR* make_ble_read_periodic_advertiser_list_size(void) {
  return make_command_no_params(HCI_BLE_READ_PERIODIC_ADVERTISER_LIST_SIZE);
}

static BT_HDR* make_read_local_supported_codecs(void) {
  return make_command_no_params(HCI_READ_LOCAL_SUPPORTED_CODECS);
}

static BT_HDR* make_ble_set_event_mask(const bt_event_mask_t* event_mask) {
  uint8_t* stream;
  uint8_t parameter_size = sizeof(bt_event_mask_t);
  BT_HDR* packet =
      make_command(HCI_BLE_SET_EVENT_MASK, parameter_size, &stream);

  ARRAY8_TO_STREAM(stream, event_mask->as_array);
  return packet;
}

static BT_HDR* make_ble_set_host_features(uint8_t bit_number,
                                          uint8_t bit_value) {
  uint8_t* stream;
  uint8_t parameter_size = sizeof(bit_number) + sizeof(bit_value);
  BT_HDR* packet =
      make_command(HCI_LE_SET_HOST_FEATURE, parameter_size, &stream);

  UINT8_TO_STREAM(stream, bit_number);
  UINT8_TO_STREAM(stream, bit_value);

  return packet;
}

// Internal functions

static BT_HDR* make_command_no_params(uint16_t opcode) {
  return make_command(opcode, 0, NULL);
}

static BT_HDR* make_command(uint16_t opcode, size_t parameter_size,
                            uint8_t** stream_out) {
  BT_HDR* packet = make_packet(HCI_COMMAND_PREAMBLE_SIZE + parameter_size);

  uint8_t* stream = packet->data;
  UINT16_TO_STREAM(stream, opcode);
  UINT8_TO_STREAM(stream, parameter_size);

  if (stream_out != NULL) *stream_out = stream;

  return packet;
}

static BT_HDR* make_packet(size_t data_size) {
  BT_HDR* ret = (BT_HDR*)buffer_allocator->alloc(sizeof(BT_HDR) + data_size);
  CHECK(ret);
  ret->event = 0;
  ret->offset = 0;
  ret->layer_specific = 0;
  ret->len = data_size;
  return ret;
}

static const hci_packet_factory_t interface = {
    make_reset,
    make_read_buffer_size,
    make_host_buffer_size,
    make_read_local_version_info,
    make_read_bd_addr,
    make_read_local_supported_commands,
    make_read_local_extended_features,
    make_write_simple_pairing_mode,
    make_write_secure_connections_host_support,
    make_set_event_mask,
    make_ble_write_host_support,
    make_ble_read_acceptlist_size,
    make_ble_read_buffer_size,
    make_ble_read_buffer_size_v2,
    make_ble_read_supported_states,
    make_ble_read_local_supported_features,
    make_ble_read_resolving_list_size,
    make_ble_read_suggested_default_data_length,
    make_ble_read_maximum_data_length,
    make_ble_read_maximum_advertising_data_length,
    make_ble_read_number_of_supported_advertising_sets,
    make_ble_read_periodic_advertiser_list_size,
    make_ble_set_event_mask,
    make_ble_set_host_features,
    make_read_local_supported_codecs};

const hci_packet_factory_t* hci_packet_factory_get_interface() {
  buffer_allocator = buffer_allocator_get_interface();
  return &interface;
}