Blame android/hal-bluetooth.c

Packit 34410b
/*
Packit 34410b
 * Copyright (C) 2013 Intel Corporation
Packit 34410b
 *
Packit 34410b
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit 34410b
 * you may not use this file except in compliance with the License.
Packit 34410b
 * You may obtain a copy of the License at
Packit 34410b
 *
Packit 34410b
 *      http://www.apache.org/licenses/LICENSE-2.0
Packit 34410b
 *
Packit 34410b
 * Unless required by applicable law or agreed to in writing, software
Packit 34410b
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit 34410b
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit 34410b
 * See the License for the specific language governing permissions and
Packit 34410b
 * limitations under the License.
Packit 34410b
 *
Packit 34410b
 */
Packit 34410b
Packit 34410b
#define _GNU_SOURCE
Packit 34410b
#include <stdio.h>
Packit 34410b
#include <stdlib.h>
Packit 34410b
#include <stdbool.h>
Packit 34410b
#include <string.h>
Packit 34410b
#include <errno.h>
Packit 34410b
Packit 34410b
#include <cutils/properties.h>
Packit 34410b
Packit 34410b
#include "hal-log.h"
Packit 34410b
#include "hal.h"
Packit 34410b
#include "hal-msg.h"
Packit 34410b
#include "ipc-common.h"
Packit 34410b
#include "hal-ipc.h"
Packit 34410b
#include "hal-utils.h"
Packit 34410b
Packit 34410b
static const bt_callbacks_t *bt_hal_cbacks = NULL;
Packit 34410b
Packit 34410b
#define enum_prop_to_hal(prop, hal_prop, type) do { \
Packit 34410b
	static type e; \
Packit 34410b
	prop.val = &e; \
Packit 34410b
	prop.len = sizeof(e); \
Packit 34410b
	e = *((uint8_t *) (hal_prop->val)); \
Packit 34410b
} while (0)
Packit 34410b
Packit 34410b
#define enum_prop_from_hal(prop, hal_len, hal_val, enum_type) do { \
Packit 34410b
	enum_type e; \
Packit 34410b
	if (prop->len != sizeof(e)) { \
Packit 34410b
		error("invalid HAL property %u (%u vs %zu), aborting ", \
Packit 34410b
					prop->type, prop->len, sizeof(e)); \
Packit 34410b
		exit(EXIT_FAILURE); \
Packit 34410b
	} \
Packit 34410b
	memcpy(&e, prop->val, sizeof(e)); \
Packit 34410b
	*((uint8_t *) hal_val) = e; /* enums are mapped to 1 byte */ \
Packit 34410b
	*hal_len = 1; \
Packit 34410b
} while (0)
Packit 34410b
Packit 34410b
static void handle_adapter_state_changed(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_adapter_state_changed *ev = buf;
Packit 34410b
Packit 34410b
	DBG("state: %s", bt_state_t2str(ev->state));
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->adapter_state_changed_cb)
Packit 34410b
		bt_hal_cbacks->adapter_state_changed_cb(ev->state);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void adapter_props_to_hal(bt_property_t *send_props,
Packit 34410b
					struct hal_property *prop,
Packit 34410b
					uint8_t num_props, uint16_t len)
Packit 34410b
{
Packit 34410b
	void *buf = prop;
Packit 34410b
	uint8_t i;
Packit 34410b
Packit 34410b
	for (i = 0; i < num_props; i++) {
Packit 34410b
		if (sizeof(*prop) + prop->len > len) {
Packit 34410b
			error("invalid adapter properties(%zu > %u), aborting",
Packit 34410b
					sizeof(*prop) + prop->len, len);
Packit 34410b
			exit(EXIT_FAILURE);
Packit 34410b
		}
Packit 34410b
Packit 34410b
		send_props[i].type = prop->type;
Packit 34410b
Packit 34410b
		switch (prop->type) {
Packit 34410b
		case HAL_PROP_ADAPTER_TYPE:
Packit 34410b
			enum_prop_to_hal(send_props[i], prop,
Packit 34410b
							bt_device_type_t);
Packit 34410b
			break;
Packit 34410b
		case HAL_PROP_ADAPTER_SCAN_MODE:
Packit 34410b
			enum_prop_to_hal(send_props[i], prop,
Packit 34410b
							bt_scan_mode_t);
Packit 34410b
			break;
Packit 34410b
		case HAL_PROP_ADAPTER_SERVICE_REC:
Packit 34410b
		default:
Packit 34410b
			send_props[i].len = prop->len;
Packit 34410b
			send_props[i].val = prop->val;
Packit 34410b
			break;
Packit 34410b
		}
Packit 34410b
Packit 34410b
		DBG("prop[%d]: %s", i, btproperty2str(&send_props[i]));
Packit 34410b
Packit 34410b
		len -= sizeof(*prop) + prop->len;
Packit 34410b
		buf += sizeof(*prop) + prop->len;
Packit 34410b
		prop = buf;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (!len)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	error("invalid adapter properties (%u bytes left), aborting", len);
Packit 34410b
	exit(EXIT_FAILURE);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void adapter_prop_from_hal(const bt_property_t *property, uint8_t *type,
Packit 34410b
						uint16_t *len, void *val)
Packit 34410b
{
Packit 34410b
	/* type match IPC type */
Packit 34410b
	*type = property->type;
Packit 34410b
Packit 34410b
	switch (property->type) {
Packit 34410b
	case HAL_PROP_ADAPTER_SCAN_MODE:
Packit 34410b
		enum_prop_from_hal(property, len, val, bt_scan_mode_t);
Packit 34410b
		break;
Packit 34410b
	case BT_PROPERTY_BDNAME:
Packit 34410b
	case BT_PROPERTY_BDADDR:
Packit 34410b
	case BT_PROPERTY_UUIDS:
Packit 34410b
	case BT_PROPERTY_CLASS_OF_DEVICE:
Packit 34410b
	case BT_PROPERTY_TYPE_OF_DEVICE:
Packit 34410b
	case BT_PROPERTY_SERVICE_RECORD:
Packit 34410b
	case BT_PROPERTY_ADAPTER_BONDED_DEVICES:
Packit 34410b
	case BT_PROPERTY_ADAPTER_DISCOVERY_TIMEOUT:
Packit 34410b
	case BT_PROPERTY_REMOTE_FRIENDLY_NAME:
Packit 34410b
	case BT_PROPERTY_REMOTE_RSSI:
Packit 34410b
	case BT_PROPERTY_REMOTE_VERSION_INFO:
Packit 34410b
	case BT_PROPERTY_REMOTE_DEVICE_TIMESTAMP:
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
	case BT_PROPERTY_LOCAL_LE_FEATURES:
Packit 34410b
#endif
Packit 34410b
	default:
Packit 34410b
		*len = property->len;
Packit 34410b
		memcpy(val, property->val, property->len);
Packit 34410b
		break;
Packit 34410b
	}
Packit 34410b
}
Packit 34410b
Packit 34410b
static void device_props_to_hal(bt_property_t *send_props,
Packit 34410b
				struct hal_property *prop, uint8_t num_props,
Packit 34410b
				uint16_t len)
Packit 34410b
{
Packit 34410b
	void *buf = prop;
Packit 34410b
	uint8_t i;
Packit 34410b
Packit 34410b
	for (i = 0; i < num_props; i++) {
Packit 34410b
		if (sizeof(*prop) + prop->len > len) {
Packit 34410b
			error("invalid device properties (%zu > %u), aborting",
Packit 34410b
					sizeof(*prop) + prop->len, len);
Packit 34410b
			exit(EXIT_FAILURE);
Packit 34410b
		}
Packit 34410b
Packit 34410b
		send_props[i].type = prop->type;
Packit 34410b
Packit 34410b
		switch (prop->type) {
Packit 34410b
		case HAL_PROP_DEVICE_TYPE:
Packit 34410b
			enum_prop_to_hal(send_props[i], prop,
Packit 34410b
							bt_device_type_t);
Packit 34410b
			break;
Packit 34410b
		case HAL_PROP_DEVICE_VERSION_INFO:
Packit 34410b
		{
Packit 34410b
			static bt_remote_version_t e;
Packit 34410b
			const struct hal_prop_device_info *p;
Packit 34410b
Packit 34410b
			send_props[i].val = &e;
Packit 34410b
			send_props[i].len = sizeof(e);
Packit 34410b
Packit 34410b
			p = (struct hal_prop_device_info *) prop->val;
Packit 34410b
Packit 34410b
			e.manufacturer = p->manufacturer;
Packit 34410b
			e.sub_ver = p->sub_version;
Packit 34410b
			e.version = p->version;
Packit 34410b
		}
Packit 34410b
			break;
Packit 34410b
		case HAL_PROP_DEVICE_SERVICE_REC:
Packit 34410b
		{
Packit 34410b
			static bt_service_record_t e;
Packit 34410b
			const struct hal_prop_device_service_rec *p;
Packit 34410b
Packit 34410b
			send_props[i].val = &e;
Packit 34410b
			send_props[i].len = sizeof(e);
Packit 34410b
Packit 34410b
			p = (struct hal_prop_device_service_rec *) prop->val;
Packit 34410b
Packit 34410b
			memset(&e, 0, sizeof(e));
Packit 34410b
			memcpy(&e.channel, &p->channel, sizeof(e.channel));
Packit 34410b
			memcpy(e.uuid.uu, p->uuid, sizeof(e.uuid.uu));
Packit 34410b
			memcpy(e.name, p->name, p->name_len);
Packit 34410b
		}
Packit 34410b
			break;
Packit 34410b
		default:
Packit 34410b
			send_props[i].len = prop->len;
Packit 34410b
			send_props[i].val = prop->val;
Packit 34410b
			break;
Packit 34410b
		}
Packit 34410b
Packit 34410b
		len -= sizeof(*prop) + prop->len;
Packit 34410b
		buf += sizeof(*prop) + prop->len;
Packit 34410b
		prop = buf;
Packit 34410b
Packit 34410b
		DBG("prop[%d]: %s", i, btproperty2str(&send_props[i]));
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (!len)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	error("invalid device properties (%u bytes left), aborting", len);
Packit 34410b
	exit(EXIT_FAILURE);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_adapter_props_changed(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_adapter_props_changed *ev = buf;
Packit 34410b
	bt_property_t props[ev->num_props];
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!bt_hal_cbacks->adapter_properties_cb)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	len -= sizeof(*ev);
Packit 34410b
	adapter_props_to_hal(props, ev->props, ev->num_props, len);
Packit 34410b
Packit 34410b
	bt_hal_cbacks->adapter_properties_cb(ev->status, ev->num_props, props);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_bond_state_change(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_bond_state_changed *ev = buf;
Packit 34410b
	bt_bdaddr_t *addr = (bt_bdaddr_t *) ev->bdaddr;
Packit 34410b
Packit 34410b
	DBG("state %u", ev->state);
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->bond_state_changed_cb)
Packit 34410b
		bt_hal_cbacks->bond_state_changed_cb(ev->status, addr,
Packit 34410b
								ev->state);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_pin_request(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_pin_request *ev = buf;
Packit 34410b
	/* Those are declared as packed, so it's safe to assign pointers */
Packit 34410b
	bt_bdaddr_t *addr = (bt_bdaddr_t *) ev->bdaddr;
Packit 34410b
	bt_bdname_t *name = (bt_bdname_t *) ev->name;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->pin_request_cb)
Packit 34410b
		bt_hal_cbacks->pin_request_cb(addr, name, ev->class_of_dev);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_ssp_request(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_ssp_request *ev = buf;
Packit 34410b
	/* Those are declared as packed, so it's safe to assign pointers */
Packit 34410b
	bt_bdaddr_t *addr = (bt_bdaddr_t *) ev->bdaddr;
Packit 34410b
	bt_bdname_t *name = (bt_bdname_t *) ev->name;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->ssp_request_cb)
Packit 34410b
		bt_hal_cbacks->ssp_request_cb(addr, name, ev->class_of_dev,
Packit 34410b
							ev->pairing_variant,
Packit 34410b
							ev->passkey);
Packit 34410b
}
Packit 34410b
Packit 34410b
void bt_thread_associate(void)
Packit 34410b
{
Packit 34410b
	if (bt_hal_cbacks->thread_evt_cb)
Packit 34410b
		bt_hal_cbacks->thread_evt_cb(ASSOCIATE_JVM);
Packit 34410b
}
Packit 34410b
Packit 34410b
void bt_thread_disassociate(void)
Packit 34410b
{
Packit 34410b
	if (bt_hal_cbacks->thread_evt_cb)
Packit 34410b
		bt_hal_cbacks->thread_evt_cb(DISASSOCIATE_JVM);
Packit 34410b
}
Packit 34410b
Packit 34410b
static bool interface_ready(void)
Packit 34410b
{
Packit 34410b
	return bt_hal_cbacks != NULL;
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_discovery_state_changed(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_discovery_state_changed *ev = buf;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->discovery_state_changed_cb)
Packit 34410b
		bt_hal_cbacks->discovery_state_changed_cb(ev->state);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_device_found(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_device_found *ev = buf;
Packit 34410b
	bt_property_t props[ev->num_props];
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!bt_hal_cbacks->device_found_cb)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	len -= sizeof(*ev);
Packit 34410b
	device_props_to_hal(props, ev->props, ev->num_props, len);
Packit 34410b
Packit 34410b
	bt_hal_cbacks->device_found_cb(ev->num_props, props);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_device_state_changed(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_remote_device_props *ev = buf;
Packit 34410b
	bt_property_t props[ev->num_props];
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!bt_hal_cbacks->remote_device_properties_cb)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	len -= sizeof(*ev);
Packit 34410b
	device_props_to_hal(props, ev->props, ev->num_props, len);
Packit 34410b
Packit 34410b
	bt_hal_cbacks->remote_device_properties_cb(ev->status,
Packit 34410b
						(bt_bdaddr_t *)ev->bdaddr,
Packit 34410b
						ev->num_props, props);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_acl_state_changed(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_acl_state_changed *ev = buf;
Packit 34410b
	bt_bdaddr_t *addr = (bt_bdaddr_t *) ev->bdaddr;
Packit 34410b
Packit 34410b
	DBG("state %u", ev->state);
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->acl_state_changed_cb)
Packit 34410b
		bt_hal_cbacks->acl_state_changed_cb(ev->status, addr,
Packit 34410b
								ev->state);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_dut_mode_receive(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_dut_mode_receive *ev = buf;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (len != sizeof(*ev) + ev->len) {
Packit 34410b
		error("invalid dut mode receive event (%u), aborting", len);
Packit 34410b
		exit(EXIT_FAILURE);
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->dut_mode_recv_cb)
Packit 34410b
		bt_hal_cbacks->dut_mode_recv_cb(ev->opcode, ev->data, ev->len);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_le_test_mode(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
	struct hal_ev_le_test_mode *ev = buf;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->le_test_mode_cb)
Packit 34410b
		bt_hal_cbacks->le_test_mode_cb(ev->status, ev->num_packets);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void handle_energy_info(void *buf, uint16_t len, int fd)
Packit 34410b
{
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
	struct hal_ev_energy_info *ev = buf;
Packit 34410b
	bt_activity_energy_info info;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	info.ctrl_state = ev->ctrl_state;
Packit 34410b
	info.energy_used = ev->energy_used;
Packit 34410b
	info.idle_time = ev->idle_time;
Packit 34410b
	info.rx_time = ev->rx_time;
Packit 34410b
	info.status = ev->status;
Packit 34410b
	info.tx_time = ev->status;
Packit 34410b
Packit 34410b
	if (bt_hal_cbacks->energy_info_cb)
Packit 34410b
		bt_hal_cbacks->energy_info_cb(&info;;
Packit 34410b
#endif
Packit 34410b
}
Packit 34410b
Packit 34410b
/*
Packit 34410b
 * handlers will be called from notification thread context,
Packit 34410b
 * index in table equals to 'opcode - HAL_MINIMUM_EVENT'
Packit 34410b
 */
Packit 34410b
static const struct hal_ipc_handler ev_handlers[] = {
Packit 34410b
	/* HAL_EV_ADAPTER_STATE_CHANGED */
Packit 34410b
	{ handle_adapter_state_changed, false,
Packit 34410b
				sizeof(struct hal_ev_adapter_state_changed) },
Packit 34410b
	/* HAL_EV_ADAPTER_PROPS_CHANGED */
Packit 34410b
	{ handle_adapter_props_changed, true,
Packit 34410b
				sizeof(struct hal_ev_adapter_props_changed) +
Packit 34410b
				sizeof(struct hal_property) },
Packit 34410b
	/* HAL_EV_REMOTE_DEVICE_PROPS */
Packit 34410b
	{ handle_device_state_changed, true,
Packit 34410b
				sizeof(struct hal_ev_remote_device_props) +
Packit 34410b
				sizeof(struct hal_property) },
Packit 34410b
	/* HAL_EV_DEVICE_FOUND */
Packit 34410b
	{ handle_device_found, true, sizeof(struct hal_ev_device_found) +
Packit 34410b
				sizeof(struct hal_property) },
Packit 34410b
	/* HAL_EV_DISCOVERY_STATE_CHANGED */
Packit 34410b
	{ handle_discovery_state_changed, false,
Packit 34410b
				sizeof(struct hal_ev_discovery_state_changed) },
Packit 34410b
	/* HAL_EV_PIN_REQUEST */
Packit 34410b
	{ handle_pin_request, false, sizeof(struct hal_ev_pin_request) },
Packit 34410b
	/* HAL_EV_SSP_REQUEST */
Packit 34410b
	{ handle_ssp_request, false, sizeof(struct hal_ev_ssp_request) },
Packit 34410b
	/* HAL_EV_BOND_STATE_CHANGED */
Packit 34410b
	{ handle_bond_state_change, false,
Packit 34410b
				sizeof(struct hal_ev_bond_state_changed) },
Packit 34410b
	/* HAL_EV_ACL_STATE_CHANGED */
Packit 34410b
	{ handle_acl_state_changed, false,
Packit 34410b
				sizeof(struct hal_ev_acl_state_changed) },
Packit 34410b
	/* HAL_EV_DUT_MODE_RECEIVE */
Packit 34410b
	{ handle_dut_mode_receive, true,
Packit 34410b
				sizeof(struct hal_ev_dut_mode_receive) },
Packit 34410b
	/* HAL_EV_LE_TEST_MODE */
Packit 34410b
	{ handle_le_test_mode, false, sizeof(struct hal_ev_le_test_mode) },
Packit 34410b
	/* HAL_EV_ENERGY_INFO */
Packit 34410b
	{ handle_energy_info, false, sizeof(struct hal_ev_energy_info) },
Packit 34410b
};
Packit 34410b
Packit 34410b
static uint8_t get_mode(void)
Packit 34410b
{
Packit 34410b
	char value[PROPERTY_VALUE_MAX];
Packit 34410b
Packit 34410b
	if (get_config("mode", value, NULL) > 0) {
Packit 34410b
		if (!strcasecmp(value, "bredr"))
Packit 34410b
			return HAL_MODE_BREDR;
Packit 34410b
Packit 34410b
		if (!strcasecmp(value, "le"))
Packit 34410b
			return HAL_MODE_LE;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return HAL_MODE_DEFAULT;
Packit 34410b
}
Packit 34410b
Packit 34410b
static uint16_t add_prop(const char *prop, uint8_t type, void *buf)
Packit 34410b
{
Packit 34410b
	struct hal_config_prop *hal_prop = buf;
Packit 34410b
Packit 34410b
	hal_prop->type = type;
Packit 34410b
	hal_prop->len = strlen(prop) + 1;
Packit 34410b
	memcpy(hal_prop->val, prop, hal_prop->len);
Packit 34410b
Packit 34410b
	return sizeof(*hal_prop) + hal_prop->len;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int send_configuration(void)
Packit 34410b
{
Packit 34410b
	char buf[IPC_MTU];
Packit 34410b
	struct hal_cmd_configuration *cmd = (void *) buf;
Packit 34410b
	char prop[PROPERTY_VALUE_MAX];
Packit 34410b
	uint16_t len = sizeof(*cmd);
Packit 34410b
Packit 34410b
	cmd->num = 0;
Packit 34410b
Packit 34410b
	if (get_config("vendor", prop, "ro.product.manufacturer") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_VENDOR, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("name", prop, "ro.product.name") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_NAME, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("model", prop, "ro.product.model") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_MODEL, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("serialno", prop, "ro.serialno") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_SERIAL_NUMBER, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("systemid", prop, NULL) > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_SYSTEM_ID, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("pnpid", prop, NULL) > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_PNP_ID, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("fwrev", prop, "ro.build.version.release") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_FW_REV, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (get_config("hwrev", prop, "ro.board.platform") > 0) {
Packit 34410b
		len += add_prop(prop, HAL_CONFIG_HW_REV, buf + len);
Packit 34410b
		cmd->num++;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_CONFIGURATION, len, cmd,
Packit 34410b
							NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int init(bt_callbacks_t *callbacks)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_register_module cmd;
Packit 34410b
	int status;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (interface_ready())
Packit 34410b
		return BT_STATUS_DONE;
Packit 34410b
Packit 34410b
	hal_ipc_register(HAL_SERVICE_ID_BLUETOOTH, ev_handlers,
Packit 34410b
				sizeof(ev_handlers)/sizeof(ev_handlers[0]));
Packit 34410b
Packit 34410b
	if (!hal_ipc_init(BLUEZ_HAL_SK_PATH, sizeof(BLUEZ_HAL_SK_PATH)))
Packit 34410b
		return BT_STATUS_FAIL;
Packit 34410b
Packit 34410b
	bt_hal_cbacks = callbacks;
Packit 34410b
Packit 34410b
	/* Start Android Bluetooth daemon service */
Packit 34410b
	if (property_set("bluetooth.start", "daemon") < 0) {
Packit 34410b
		error("Failed to set bluetooth.start=daemon");
Packit 34410b
		hal_ipc_cleanup();
Packit 34410b
		bt_hal_cbacks = NULL;
Packit 34410b
		return BT_STATUS_FAIL;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (!hal_ipc_accept()) {
Packit 34410b
		hal_ipc_cleanup();
Packit 34410b
		bt_hal_cbacks = NULL;
Packit 34410b
		return BT_STATUS_FAIL;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	status = send_configuration();
Packit 34410b
	if (status != BT_STATUS_SUCCESS) {
Packit 34410b
		error("Failed to send configuration");
Packit 34410b
		goto fail;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	cmd.service_id = HAL_SERVICE_ID_BLUETOOTH;
Packit 34410b
	cmd.mode = get_mode();
Packit 34410b
	cmd.max_clients = 1;
Packit 34410b
Packit 34410b
	status = hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_REGISTER_MODULE,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
	if (status != BT_STATUS_SUCCESS) {
Packit 34410b
		error("Failed to register 'bluetooth' service");
Packit 34410b
		goto fail;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	cmd.service_id = HAL_SERVICE_ID_SOCKET;
Packit 34410b
	cmd.max_clients = 1;
Packit 34410b
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
	cmd.mode = HAL_MODE_SOCKET_DYNAMIC_MAP;
Packit 34410b
#else
Packit 34410b
	cmd.mode = HAL_MODE_DEFAULT;
Packit 34410b
#endif
Packit 34410b
Packit 34410b
	status = hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_REGISTER_MODULE,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
	if (status != BT_STATUS_SUCCESS) {
Packit 34410b
		error("Failed to register 'socket' service");
Packit 34410b
		goto fail;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return status;
Packit 34410b
Packit 34410b
fail:
Packit 34410b
	hal_ipc_cleanup();
Packit 34410b
	bt_hal_cbacks = NULL;
Packit 34410b
Packit 34410b
	hal_ipc_unregister(HAL_SERVICE_ID_BLUETOOTH);
Packit 34410b
Packit 34410b
	return status;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int enable(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_ENABLE, 0, NULL,
Packit 34410b
							NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int disable(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_DISABLE, 0, NULL,
Packit 34410b
							NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void cleanup(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	hal_ipc_cleanup();
Packit 34410b
Packit 34410b
	hal_ipc_unregister(HAL_SERVICE_ID_BLUETOOTH);
Packit 34410b
Packit 34410b
	bt_hal_cbacks = NULL;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_adapter_properties(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_GET_ADAPTER_PROPS,
Packit 34410b
						0, NULL, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_adapter_property(bt_property_type_t type)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_adapter_prop cmd;
Packit 34410b
Packit 34410b
	DBG("prop: %s (%d)", bt_property_type_t2str(type), type);
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	/* type match IPC type */
Packit 34410b
	cmd.type = type;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_GET_ADAPTER_PROP,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int set_adapter_property(const bt_property_t *property)
Packit 34410b
{
Packit 34410b
	char buf[IPC_MTU];
Packit 34410b
	struct hal_cmd_set_adapter_prop *cmd = (void *) buf;
Packit 34410b
	uint16_t len_ret;
Packit 34410b
	size_t len;
Packit 34410b
Packit 34410b
	DBG("prop: %s", btproperty2str(property));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	adapter_prop_from_hal(property, &cmd->type, &len_ret, cmd->val);
Packit 34410b
Packit 34410b
	cmd->len = len_ret;
Packit 34410b
	len = sizeof(*cmd) + cmd->len;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_SET_ADAPTER_PROP,
Packit 34410b
						len, cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_remote_device_properties(bt_bdaddr_t *remote_addr)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_remote_device_props cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(remote_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, remote_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH,
Packit 34410b
					HAL_OP_GET_REMOTE_DEVICE_PROPS,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_remote_device_property(bt_bdaddr_t *remote_addr,
Packit 34410b
						bt_property_type_t type)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_remote_device_prop cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s prop: %s", bdaddr2str(remote_addr),
Packit 34410b
						bt_property_type_t2str(type));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, remote_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	/* type match IPC type */
Packit 34410b
	cmd.type = type;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH,
Packit 34410b
					HAL_OP_GET_REMOTE_DEVICE_PROP,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int set_remote_device_property(bt_bdaddr_t *remote_addr,
Packit 34410b
						const bt_property_t *property)
Packit 34410b
{
Packit 34410b
	char buf[IPC_MTU];
Packit 34410b
	struct hal_cmd_set_remote_device_prop *cmd = (void *) buf;
Packit 34410b
	size_t len;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s prop: %s", bdaddr2str(remote_addr),
Packit 34410b
				bt_property_type_t2str(property->type));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd->bdaddr, remote_addr, sizeof(cmd->bdaddr));
Packit 34410b
Packit 34410b
	/* type match IPC type */
Packit 34410b
	cmd->type = property->type;
Packit 34410b
	cmd->len = property->len;
Packit 34410b
	memcpy(cmd->val, property->val, property->len);
Packit 34410b
Packit 34410b
	len = sizeof(*cmd) + cmd->len;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH,
Packit 34410b
					HAL_OP_SET_REMOTE_DEVICE_PROP,
Packit 34410b
					len, cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_remote_service_record(bt_bdaddr_t *remote_addr, bt_uuid_t *uuid)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_remote_service_rec cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(remote_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, remote_addr, sizeof(cmd.bdaddr));
Packit 34410b
	memcpy(cmd.uuid, uuid, sizeof(cmd.uuid));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH,
Packit 34410b
					HAL_OP_GET_REMOTE_SERVICE_REC,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int get_remote_services(bt_bdaddr_t *remote_addr)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_remote_services cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(remote_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, remote_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_GET_REMOTE_SERVICES,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int start_discovery(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_START_DISCOVERY, 0,
Packit 34410b
						NULL, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int cancel_discovery(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_CANCEL_DISCOVERY, 0,
Packit 34410b
						NULL, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int create_bond_real(const bt_bdaddr_t *bd_addr, int transport)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_create_bond cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	cmd.transport = transport;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_CREATE_BOND,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
static int create_bond(const bt_bdaddr_t *bd_addr, int transport)
Packit 34410b
{
Packit 34410b
	return create_bond_real(bd_addr, transport);
Packit 34410b
}
Packit 34410b
#else
Packit 34410b
static int create_bond(const bt_bdaddr_t *bd_addr)
Packit 34410b
{
Packit 34410b
	return create_bond_real(bd_addr, BT_TRANSPORT_UNKNOWN);
Packit 34410b
}
Packit 34410b
#endif
Packit 34410b
Packit 34410b
static int cancel_bond(const bt_bdaddr_t *bd_addr)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_cancel_bond cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_CANCEL_BOND,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int remove_bond(const bt_bdaddr_t *bd_addr)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_remove_bond cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_REMOVE_BOND,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int pin_reply(const bt_bdaddr_t *bd_addr, uint8_t accept,
Packit 34410b
				uint8_t pin_len, bt_pin_code_t *pin_code)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_pin_reply cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
	cmd.accept = accept;
Packit 34410b
	cmd.pin_len = pin_len;
Packit 34410b
	memcpy(cmd.pin_code, pin_code, sizeof(cmd.pin_code));
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_PIN_REPLY,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int ssp_reply(const bt_bdaddr_t *bd_addr, bt_ssp_variant_t variant,
Packit 34410b
					uint8_t accept, uint32_t passkey)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_ssp_reply cmd;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
	/* type match IPC type */
Packit 34410b
	cmd.ssp_variant = variant;
Packit 34410b
	cmd.accept = accept;
Packit 34410b
	cmd.passkey = passkey;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_SSP_REPLY,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static const void *get_profile_interface(const char *profile_id)
Packit 34410b
{
Packit 34410b
	DBG("%s", profile_id);
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return NULL;
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_SOCKETS_ID))
Packit 34410b
		return bt_get_socket_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_HIDHOST_ID))
Packit 34410b
		return bt_get_hidhost_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_PAN_ID))
Packit 34410b
		return bt_get_pan_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_ADVANCED_AUDIO_ID))
Packit 34410b
		return bt_get_a2dp_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_AV_RC_ID))
Packit 34410b
		return bt_get_avrcp_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_HANDSFREE_ID))
Packit 34410b
		return bt_get_handsfree_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_GATT_ID))
Packit 34410b
		return bt_get_gatt_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_HEALTH_ID))
Packit 34410b
		return bt_get_health_interface();
Packit 34410b
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_AV_RC_CTRL_ID))
Packit 34410b
		return bt_get_avrcp_ctrl_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_HANDSFREE_CLIENT_ID))
Packit 34410b
		return bt_get_hf_client_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_MAP_CLIENT_ID))
Packit 34410b
		return bt_get_map_client_interface();
Packit 34410b
Packit 34410b
	if (!strcmp(profile_id, BT_PROFILE_ADVANCED_AUDIO_SINK_ID))
Packit 34410b
		return bt_get_a2dp_sink_interface();
Packit 34410b
#endif
Packit 34410b
Packit 34410b
	return NULL;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int dut_mode_configure(uint8_t enable)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_dut_mode_conf cmd;
Packit 34410b
Packit 34410b
	DBG("enable %u", enable);
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	cmd.enable = enable;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_DUT_MODE_CONF,
Packit 34410b
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int dut_mode_send(uint16_t opcode, uint8_t *buf, uint8_t buf_len)
Packit 34410b
{
Packit 34410b
	char cmd_buf[IPC_MTU];
Packit 34410b
	struct hal_cmd_dut_mode_send *cmd = (void *) cmd_buf;
Packit 34410b
	size_t len;
Packit 34410b
Packit 34410b
	DBG("opcode %u len %u", opcode, buf_len);
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	cmd->opcode = opcode;
Packit 34410b
	cmd->len = buf_len;
Packit 34410b
	memcpy(cmd->data, buf, cmd->len);
Packit 34410b
Packit 34410b
	len = sizeof(*cmd) + cmd->len;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_DUT_MODE_SEND,
Packit 34410b
						len, cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int le_test_mode(uint16_t opcode, uint8_t *buf, uint8_t buf_len)
Packit 34410b
{
Packit 34410b
	char cmd_buf[IPC_MTU];
Packit 34410b
	struct hal_cmd_le_test_mode *cmd = (void *) cmd_buf;
Packit 34410b
	size_t len;
Packit 34410b
Packit 34410b
	DBG("opcode %u len %u", opcode, buf_len);
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	cmd->opcode = opcode;
Packit 34410b
	cmd->len = buf_len;
Packit 34410b
	memcpy(cmd->data, buf, cmd->len);
Packit 34410b
Packit 34410b
	len = sizeof(*cmd) + cmd->len;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_LE_TEST_MODE,
Packit 34410b
						len, cmd, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
Packit 34410b
static int config_hci_snoop_log(uint8_t enable)
Packit 34410b
{
Packit 34410b
	const char *property;
Packit 34410b
Packit 34410b
	DBG("enable %u", enable);
Packit 34410b
Packit 34410b
	property = enable ? "bluetooth.start" : "bluetooth.stop";
Packit 34410b
Packit 34410b
	if (property_set(property, "snoop") < 0) {
Packit 34410b
		error("Failed to set %s=snoop", property);
Packit 34410b
		return BT_STATUS_FAIL;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return BT_STATUS_SUCCESS;
Packit 34410b
}
Packit 34410b
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
static int get_connection_state(const bt_bdaddr_t *bd_addr)
Packit 34410b
{
Packit 34410b
	struct hal_cmd_get_connection_state cmd;
Packit 34410b
	struct hal_rsp_get_connection_state rsp;
Packit 34410b
	size_t rsp_len = sizeof(rsp);
Packit 34410b
	bt_status_t status;
Packit 34410b
Packit 34410b
	DBG("bdaddr: %s", bdaddr2str(bd_addr));
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return 0;
Packit 34410b
Packit 34410b
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit 34410b
Packit 34410b
	status = hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH,
Packit 34410b
			HAL_OP_GET_CONNECTION_STATE, sizeof(cmd), &cmd,
Packit 34410b
			&rsp_len, &rsp, NULL);
Packit 34410b
Packit 34410b
	if (status != BT_STATUS_SUCCESS)
Packit 34410b
		return 0;
Packit 34410b
Packit 34410b
	return rsp.connection_state;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int set_os_callouts(bt_os_callouts_t *callouts)
Packit 34410b
{
Packit 34410b
	DBG("callouts: %p", callouts);
Packit 34410b
Packit 34410b
	/* TODO: implement */
Packit 34410b
Packit 34410b
	return BT_STATUS_SUCCESS;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int read_energy_info(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!interface_ready())
Packit 34410b
		return BT_STATUS_NOT_READY;
Packit 34410b
Packit 34410b
	return hal_ipc_cmd(HAL_SERVICE_ID_BLUETOOTH, HAL_OP_READ_ENERGY_INFO, 0,
Packit 34410b
							NULL, NULL, NULL, NULL);
Packit 34410b
}
Packit 34410b
#endif
Packit 34410b
Packit 34410b
static const bt_interface_t bluetooth_if = {
Packit 34410b
	.size = sizeof(bt_interface_t),
Packit 34410b
	.init = init,
Packit 34410b
	.enable = enable,
Packit 34410b
	.disable = disable,
Packit 34410b
	.cleanup = cleanup,
Packit 34410b
	.get_adapter_properties = get_adapter_properties,
Packit 34410b
	.get_adapter_property = get_adapter_property,
Packit 34410b
	.set_adapter_property = set_adapter_property,
Packit 34410b
	.get_remote_device_properties = get_remote_device_properties,
Packit 34410b
	.get_remote_device_property = get_remote_device_property,
Packit 34410b
	.set_remote_device_property = set_remote_device_property,
Packit 34410b
	.get_remote_service_record = get_remote_service_record,
Packit 34410b
	.get_remote_services = get_remote_services,
Packit 34410b
	.start_discovery = start_discovery,
Packit 34410b
	.cancel_discovery = cancel_discovery,
Packit 34410b
	.create_bond = create_bond,
Packit 34410b
	.remove_bond = remove_bond,
Packit 34410b
	.cancel_bond = cancel_bond,
Packit 34410b
	.pin_reply = pin_reply,
Packit 34410b
	.ssp_reply = ssp_reply,
Packit 34410b
	.get_profile_interface = get_profile_interface,
Packit 34410b
	.dut_mode_configure = dut_mode_configure,
Packit 34410b
	.dut_mode_send = dut_mode_send,
Packit 34410b
	.le_test_mode = le_test_mode,
Packit 34410b
	.config_hci_snoop_log = config_hci_snoop_log,
Packit 34410b
#if ANDROID_VERSION >= PLATFORM_VER(5, 0, 0)
Packit 34410b
	.get_connection_state = get_connection_state,
Packit 34410b
	.set_os_callouts = set_os_callouts,
Packit 34410b
	.read_energy_info = read_energy_info,
Packit 34410b
#endif
Packit 34410b
};
Packit 34410b
Packit 34410b
static const bt_interface_t *get_bluetooth_interface(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	return &bluetooth_if;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int close_bluetooth(struct hw_device_t *device)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	cleanup();
Packit 34410b
Packit 34410b
	free(device);
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int open_bluetooth(const struct hw_module_t *module, char const *name,
Packit 34410b
					struct hw_device_t **device)
Packit 34410b
{
Packit 34410b
	bluetooth_device_t *dev = malloc(sizeof(bluetooth_device_t));
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (!dev) {
Packit 34410b
		error("Failed to allocate memory for device");
Packit 34410b
		return -ENOMEM;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	memset(dev, 0, sizeof(bluetooth_device_t));
Packit 34410b
	dev->common.tag = HARDWARE_DEVICE_TAG;
Packit 34410b
	dev->common.version = 0;
Packit 34410b
	dev->common.module = (struct hw_module_t *) module;
Packit 34410b
	dev->common.close = close_bluetooth;
Packit 34410b
	dev->get_bluetooth_interface = get_bluetooth_interface;
Packit 34410b
Packit 34410b
	*device = (struct hw_device_t *) dev;
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static struct hw_module_methods_t bluetooth_module_methods = {
Packit 34410b
	.open = open_bluetooth,
Packit 34410b
};
Packit 34410b
Packit 34410b
struct hw_module_t HAL_MODULE_INFO_SYM = {
Packit 34410b
	.tag = HARDWARE_MODULE_TAG,
Packit 34410b
	.version_major = 1,
Packit 34410b
	.version_minor = 0,
Packit 34410b
	.id = BT_HARDWARE_MODULE_ID,
Packit 34410b
	.name = "BlueZ Bluetooth stack",
Packit 34410b
	.author = "Intel Corporation",
Packit 34410b
	.methods = &bluetooth_module_methods
Packit 34410b
};