/****************************************************************************** * * 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 #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; }