Blame android/hal-health.c

Packit Service 8264ee
/*
Packit Service 8264ee
 * Copyright (C) 2014 Intel Corporation
Packit Service 8264ee
 *
Packit Service 8264ee
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit Service 8264ee
 * you may not use this file except in compliance with the License.
Packit Service 8264ee
 * You may obtain a copy of the License at
Packit Service 8264ee
 *
Packit Service 8264ee
 *      http://www.apache.org/licenses/LICENSE-2.0
Packit Service 8264ee
 *
Packit Service 8264ee
 * Unless required by applicable law or agreed to in writing, software
Packit Service 8264ee
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit Service 8264ee
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit Service 8264ee
 * See the License for the specific language governing permissions and
Packit Service 8264ee
 * limitations under the License.
Packit Service 8264ee
 *
Packit Service 8264ee
 */
Packit Service 8264ee
Packit Service 8264ee
#include <stdbool.h>
Packit Service 8264ee
#include <stddef.h>
Packit Service 8264ee
#include <string.h>
Packit Service 8264ee
#include <stdlib.h>
Packit Service 8264ee
#include <fcntl.h>
Packit Service 8264ee
#include <unistd.h>
Packit Service 8264ee
#include <errno.h>
Packit Service 8264ee
Packit Service 8264ee
#include "hal-log.h"
Packit Service 8264ee
#include "hal.h"
Packit Service 8264ee
#include "hal-msg.h"
Packit Service 8264ee
#include "ipc-common.h"
Packit Service 8264ee
#include "hal-ipc.h"
Packit Service 8264ee
Packit Service 8264ee
static const bthl_callbacks_t *cbacks = NULL;
Packit Service 8264ee
Packit Service 8264ee
static bool interface_ready(void)
Packit Service 8264ee
{
Packit Service 8264ee
	return cbacks != NULL;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void handle_app_registration_state(void *buf, uint16_t len, int fd)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_ev_health_app_reg_state *ev = buf;
Packit Service 8264ee
Packit Service 8264ee
	if (cbacks->app_reg_state_cb)
Packit Service 8264ee
		cbacks->app_reg_state_cb(ev->id, ev->state);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void handle_channel_state(void *buf, uint16_t len, int fd)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_ev_health_channel_state *ev = buf;
Packit Service 8264ee
	int flags;
Packit Service 8264ee
Packit Service 8264ee
	if (fd < 0)
Packit Service 8264ee
		goto end;
Packit Service 8264ee
Packit Service 8264ee
	flags = fcntl(fd, F_GETFL, 0);
Packit Service 8264ee
	if (flags < 0) {
Packit Service 8264ee
		error("health: fcntl GETFL error: %s", strerror(errno));
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	/* Clean O_NONBLOCK fd flag as Android Java layer expects */
Packit Service 8264ee
	if (fcntl(fd, F_SETFL, flags & ~O_NONBLOCK) < 0) {
Packit Service 8264ee
		error("health: fcntl SETFL error: %s", strerror(errno));
Packit Service 8264ee
		return;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
end:
Packit Service 8264ee
	if (cbacks->channel_state_cb)
Packit Service 8264ee
		cbacks->channel_state_cb(ev->app_id, (bt_bdaddr_t *) ev->bdaddr,
Packit Service 8264ee
						ev->mdep_index, ev->channel_id,
Packit Service 8264ee
						ev->channel_state, fd);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
/*
Packit Service 8264ee
 * handlers will be called from notification thread context,
Packit Service 8264ee
 * index in table equals to 'opcode - HAL_MINIMUM_EVENT'
Packit Service 8264ee
 */
Packit Service 8264ee
static const struct hal_ipc_handler ev_handlers[] = {
Packit Service 8264ee
	/* HAL_EV_HEALTH_APP_REG_STATE */
Packit Service 8264ee
	{ handle_app_registration_state, false,
Packit Service 8264ee
				sizeof(struct hal_ev_health_app_reg_state) },
Packit Service 8264ee
	/* HAL_EV_HEALTH_CHANNEL_STATE */
Packit Service 8264ee
	{ handle_channel_state, false,
Packit Service 8264ee
				sizeof(struct hal_ev_health_channel_state) },
Packit Service 8264ee
};
Packit Service 8264ee
Packit Service 8264ee
static bt_status_t register_application(bthl_reg_param_t *reg, int *app_id)
Packit Service 8264ee
{
Packit Service 8264ee
	uint8_t buf[IPC_MTU];
Packit Service 8264ee
	struct hal_cmd_health_reg_app *cmd = (void *) buf;
Packit Service 8264ee
	struct hal_rsp_health_reg_app rsp;
Packit Service 8264ee
	size_t rsp_len = sizeof(rsp);
Packit Service 8264ee
	bt_status_t status;
Packit Service 8264ee
	uint16_t off, len;
Packit Service 8264ee
	int i;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (!interface_ready())
Packit Service 8264ee
		return BT_STATUS_NOT_READY;
Packit Service 8264ee
Packit Service 8264ee
	if (!reg || !app_id || !reg->application_name)
Packit Service 8264ee
		return BT_STATUS_PARM_INVALID;
Packit Service 8264ee
Packit Service 8264ee
	*app_id = -1;
Packit Service 8264ee
	memset(buf, 0, IPC_MTU);
Packit Service 8264ee
Packit Service 8264ee
	cmd->num_of_mdep = reg->number_of_mdeps;
Packit Service 8264ee
Packit Service 8264ee
	off = 0;
Packit Service 8264ee
	cmd->app_name_off = off;
Packit Service 8264ee
	len = strlen(reg->application_name) + 1;
Packit Service 8264ee
	memcpy(cmd->data, reg->application_name, len);
Packit Service 8264ee
	off += len;
Packit Service 8264ee
Packit Service 8264ee
	cmd->provider_name_off = off;
Packit Service 8264ee
	if (reg->provider_name) {
Packit Service 8264ee
		len = strlen(reg->provider_name) + 1;
Packit Service 8264ee
		memcpy(cmd->data + off, reg->provider_name, len);
Packit Service 8264ee
		off += len;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	cmd->service_name_off = off;
Packit Service 8264ee
	if (reg->srv_name) {
Packit Service 8264ee
		len = strlen(reg->srv_name) + 1;
Packit Service 8264ee
		memcpy(cmd->data + off, reg->srv_name, len);
Packit Service 8264ee
		off += len;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	cmd->service_descr_off = off;
Packit Service 8264ee
	if (reg->srv_desp) {
Packit Service 8264ee
		len = strlen(reg->srv_desp) + 1;
Packit Service 8264ee
		memcpy(cmd->data + off, reg->srv_desp, len);
Packit Service 8264ee
		off += len;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	cmd->len = off;
Packit Service 8264ee
	status = hal_ipc_cmd(HAL_SERVICE_ID_HEALTH, HAL_OP_HEALTH_REG_APP,
Packit Service 8264ee
						sizeof(*cmd) + cmd->len, buf,
Packit Service 8264ee
						&rsp_len, &rsp, NULL);
Packit Service 8264ee
	if (status != BT_STATUS_SUCCESS)
Packit Service 8264ee
		return status;
Packit Service 8264ee
Packit Service 8264ee
	for (i = 0; i < reg->number_of_mdeps; i++) {
Packit Service 8264ee
		struct hal_cmd_health_mdep *mdep = (void *) buf;
Packit Service 8264ee
Packit Service 8264ee
		memset(buf, 0, IPC_MTU);
Packit Service 8264ee
		mdep->app_id = rsp.app_id;
Packit Service 8264ee
		mdep->role = reg->mdep_cfg[i].mdep_role;
Packit Service 8264ee
		mdep->data_type = reg->mdep_cfg[i].data_type;
Packit Service 8264ee
		mdep->channel_type = reg->mdep_cfg[i].channel_type;
Packit Service 8264ee
Packit Service 8264ee
		if (reg->mdep_cfg[i].mdep_description) {
Packit Service 8264ee
			mdep->descr_len =
Packit Service 8264ee
				strlen(reg->mdep_cfg[i].mdep_description) + 1;
Packit Service 8264ee
			memcpy(mdep->descr, reg->mdep_cfg[i].mdep_description,
Packit Service 8264ee
							mdep->descr_len);
Packit Service 8264ee
		}
Packit Service 8264ee
Packit Service 8264ee
		status = hal_ipc_cmd(HAL_SERVICE_ID_HEALTH, HAL_OP_HEALTH_MDEP,
Packit Service 8264ee
						sizeof(*mdep) + mdep->descr_len,
Packit Service 8264ee
						buf, NULL, NULL, NULL);
Packit Service 8264ee
Packit Service 8264ee
		if (status != BT_STATUS_SUCCESS)
Packit Service 8264ee
			return status;
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	*app_id = rsp.app_id;
Packit Service 8264ee
Packit Service 8264ee
	return status;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static bt_status_t unregister_application(int app_id)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_cmd_health_unreg_app cmd;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (!interface_ready())
Packit Service 8264ee
		return BT_STATUS_NOT_READY;
Packit Service 8264ee
Packit Service 8264ee
	cmd.app_id = app_id;
Packit Service 8264ee
Packit Service 8264ee
	return hal_ipc_cmd(HAL_SERVICE_ID_HEALTH, HAL_OP_HEALTH_UNREG_APP,
Packit Service 8264ee
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static bt_status_t connect_channel(int app_id, bt_bdaddr_t *bd_addr,
Packit Service 8264ee
					int mdep_cfg_index, int *channel_id)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_cmd_health_connect_channel cmd;
Packit Service 8264ee
	struct hal_rsp_health_connect_channel rsp;
Packit Service 8264ee
	size_t len = sizeof(rsp);
Packit Service 8264ee
	bt_status_t status;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (!interface_ready())
Packit Service 8264ee
		return BT_STATUS_NOT_READY;
Packit Service 8264ee
Packit Service 8264ee
	if (!bd_addr || !channel_id)
Packit Service 8264ee
		return BT_STATUS_PARM_INVALID;
Packit Service 8264ee
Packit Service 8264ee
	*channel_id = -1;
Packit Service 8264ee
	cmd.app_id = app_id;
Packit Service 8264ee
	cmd.mdep_index = mdep_cfg_index;
Packit Service 8264ee
	memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
Packit Service 8264ee
Packit Service 8264ee
	status = hal_ipc_cmd(HAL_SERVICE_ID_HEALTH,
Packit Service 8264ee
					HAL_OP_HEALTH_CONNECT_CHANNEL,
Packit Service 8264ee
					sizeof(cmd), &cmd, &len, &rsp, NULL);
Packit Service 8264ee
Packit Service 8264ee
	if (status == BT_STATUS_SUCCESS)
Packit Service 8264ee
		*channel_id = rsp.channel_id;
Packit Service 8264ee
Packit Service 8264ee
	return status;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static bt_status_t destroy_channel(int channel_id)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_cmd_health_destroy_channel cmd;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (!interface_ready())
Packit Service 8264ee
		return BT_STATUS_NOT_READY;
Packit Service 8264ee
Packit Service 8264ee
	cmd.channel_id = channel_id;
Packit Service 8264ee
Packit Service 8264ee
	return hal_ipc_cmd(HAL_SERVICE_ID_HEALTH, HAL_OP_HEALTH_DESTROY_CHANNEL,
Packit Service 8264ee
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static bt_status_t init(bthl_callbacks_t *callbacks)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_cmd_register_module cmd;
Packit Service 8264ee
	int ret;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (interface_ready())
Packit Service 8264ee
		return BT_STATUS_DONE;
Packit Service 8264ee
Packit Service 8264ee
	/* store reference to user callbacks */
Packit Service 8264ee
	cbacks = callbacks;
Packit Service 8264ee
Packit Service 8264ee
	hal_ipc_register(HAL_SERVICE_ID_HEALTH, ev_handlers,
Packit Service 8264ee
				sizeof(ev_handlers)/sizeof(ev_handlers[0]));
Packit Service 8264ee
Packit Service 8264ee
	cmd.service_id = HAL_SERVICE_ID_HEALTH;
Packit Service 8264ee
	cmd.mode = HAL_MODE_DEFAULT;
Packit Service 8264ee
	cmd.max_clients = 1;
Packit Service 8264ee
Packit Service 8264ee
	ret = hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_REGISTER_MODULE,
Packit Service 8264ee
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit Service 8264ee
Packit Service 8264ee
	if (ret != BT_STATUS_SUCCESS) {
Packit Service 8264ee
		cbacks = NULL;
Packit Service 8264ee
		hal_ipc_unregister(HAL_SERVICE_ID_HEALTH);
Packit Service 8264ee
	}
Packit Service 8264ee
Packit Service 8264ee
	return ret;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static void cleanup(void)
Packit Service 8264ee
{
Packit Service 8264ee
	struct hal_cmd_unregister_module cmd;
Packit Service 8264ee
Packit Service 8264ee
	DBG("");
Packit Service 8264ee
Packit Service 8264ee
	if (!interface_ready())
Packit Service 8264ee
		return;
Packit Service 8264ee
Packit Service 8264ee
	cmd.service_id = HAL_SERVICE_ID_HEALTH;
Packit Service 8264ee
Packit Service 8264ee
	hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_UNREGISTER_MODULE,
Packit Service 8264ee
					sizeof(cmd), &cmd, NULL, NULL, NULL);
Packit Service 8264ee
Packit Service 8264ee
	hal_ipc_unregister(HAL_SERVICE_ID_HEALTH);
Packit Service 8264ee
Packit Service 8264ee
	cbacks = NULL;
Packit Service 8264ee
}
Packit Service 8264ee
Packit Service 8264ee
static bthl_interface_t health_if = {
Packit Service 8264ee
	.size = sizeof(health_if),
Packit Service 8264ee
	.init = init,
Packit Service 8264ee
	.register_application = register_application,
Packit Service 8264ee
	.unregister_application = unregister_application,
Packit Service 8264ee
	.connect_channel = connect_channel,
Packit Service 8264ee
	.destroy_channel = destroy_channel,
Packit Service 8264ee
	.cleanup = cleanup
Packit Service 8264ee
};
Packit Service 8264ee
Packit Service 8264ee
bthl_interface_t *bt_get_health_interface(void)
Packit Service 8264ee
{
Packit Service 8264ee
	return &health_if;
Packit Service 8264ee
}