mirror of
https://git.kernel.org/pub/scm/bluetooth/bluez.git
synced 2024-11-30 23:54:13 +08:00
202 lines
4.5 KiB
C
202 lines
4.5 KiB
C
/*
|
|
* Copyright (C) 2013 Intel Corporation
|
|
*
|
|
* 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 <stdbool.h>
|
|
#include <stddef.h>
|
|
#include <string.h>
|
|
|
|
#include "hal-log.h"
|
|
#include "hal.h"
|
|
#include "hal-msg.h"
|
|
#include "hal-ipc.h"
|
|
|
|
static const btpan_callbacks_t *cbs = NULL;
|
|
|
|
static bool interface_ready(void)
|
|
{
|
|
return cbs != NULL;
|
|
}
|
|
|
|
static void handle_conn_state(void *buf, uint16_t len)
|
|
{
|
|
struct hal_ev_pan_conn_state *ev = buf;
|
|
|
|
if (cbs->connection_state_cb)
|
|
cbs->connection_state_cb(ev->state, ev->status,
|
|
(bt_bdaddr_t *) ev->bdaddr,
|
|
ev->local_role, ev->remote_role);
|
|
}
|
|
|
|
static void handle_ctrl_state(void *buf, uint16_t len)
|
|
{
|
|
struct hal_ev_pan_ctrl_state *ev = buf;
|
|
|
|
if (cbs->control_state_cb)
|
|
cbs->control_state_cb(ev->state, ev->status,
|
|
ev->local_role, (char *)ev->name);
|
|
}
|
|
|
|
/* handlers will be called from notification thread context,
|
|
* index in table equals to 'opcode - HAL_MINIMUM_EVENT' */
|
|
static const struct hal_ipc_handler ev_handlers[] = {
|
|
{ /* HAL_EV_PAN_CTRL_STATE */
|
|
.handler = handle_conn_state,
|
|
.var_len = false,
|
|
.data_len = sizeof(struct hal_ev_pan_conn_state),
|
|
},
|
|
{ /* HAL_EV_PAN_CONN_STATE */
|
|
.handler = handle_ctrl_state,
|
|
.var_len = false,
|
|
.data_len = sizeof(struct hal_ev_pan_ctrl_state),
|
|
},
|
|
};
|
|
|
|
static bt_status_t pan_enable(int local_role)
|
|
{
|
|
struct hal_cmd_pan_enable cmd;
|
|
|
|
DBG("");
|
|
|
|
if (!interface_ready())
|
|
return BT_STATUS_NOT_READY;
|
|
|
|
if (!(local_role == BTPAN_ROLE_PANU || local_role == BTPAN_ROLE_PANNAP))
|
|
return BT_STATUS_UNSUPPORTED;
|
|
|
|
cmd.local_role = local_role;
|
|
|
|
return hal_ipc_cmd(HAL_SERVICE_ID_PAN, HAL_OP_PAN_ENABLE,
|
|
sizeof(cmd), &cmd, 0, NULL, NULL);
|
|
}
|
|
|
|
static int pan_get_local_role(void)
|
|
{
|
|
struct hal_rsp_pan_get_role rsp;
|
|
size_t len = sizeof(rsp);
|
|
bt_status_t status;
|
|
|
|
DBG("");
|
|
|
|
if (!interface_ready())
|
|
return BTPAN_ROLE_NONE;
|
|
|
|
status = hal_ipc_cmd(HAL_SERVICE_ID_PAN, HAL_OP_PAN_GET_ROLE, 0, NULL,
|
|
&len, &rsp, NULL);
|
|
if (status != BT_STATUS_SUCCESS)
|
|
return BTPAN_ROLE_NONE;
|
|
|
|
return rsp.local_role;
|
|
}
|
|
|
|
static bt_status_t pan_connect(const bt_bdaddr_t *bd_addr, int local_role,
|
|
int remote_role)
|
|
{
|
|
struct hal_cmd_pan_connect cmd;
|
|
|
|
DBG("");
|
|
|
|
if (!interface_ready())
|
|
return BT_STATUS_NOT_READY;
|
|
|
|
switch (local_role) {
|
|
case BTPAN_ROLE_PANNAP:
|
|
if (remote_role != BTPAN_ROLE_PANU)
|
|
return BT_STATUS_UNSUPPORTED;
|
|
break;
|
|
case BTPAN_ROLE_PANU:
|
|
if (remote_role != BTPAN_ROLE_PANNAP &&
|
|
remote_role != BTPAN_ROLE_PANU)
|
|
return BT_STATUS_UNSUPPORTED;
|
|
break;
|
|
default:
|
|
return BT_STATUS_UNSUPPORTED;
|
|
}
|
|
|
|
memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
|
|
cmd.local_role = local_role;
|
|
cmd.remote_role = remote_role;
|
|
|
|
return hal_ipc_cmd(HAL_SERVICE_ID_PAN, HAL_OP_PAN_CONNECT,
|
|
sizeof(cmd), &cmd, 0, NULL, NULL);
|
|
}
|
|
|
|
static bt_status_t pan_disconnect(const bt_bdaddr_t *bd_addr)
|
|
{
|
|
struct hal_cmd_pan_disconnect cmd;
|
|
|
|
DBG("");
|
|
|
|
if (!interface_ready())
|
|
return BT_STATUS_NOT_READY;
|
|
|
|
memcpy(cmd.bdaddr, bd_addr, sizeof(cmd.bdaddr));
|
|
|
|
return hal_ipc_cmd(HAL_SERVICE_ID_PAN, HAL_OP_PAN_DISCONNECT,
|
|
sizeof(cmd), &cmd, 0, NULL, NULL);
|
|
}
|
|
|
|
static bt_status_t pan_init(const btpan_callbacks_t *callbacks)
|
|
{
|
|
struct hal_cmd_register_module cmd;
|
|
|
|
DBG("");
|
|
|
|
cbs = callbacks;
|
|
|
|
hal_ipc_register(HAL_SERVICE_ID_PAN, ev_handlers,
|
|
sizeof(ev_handlers)/sizeof(ev_handlers[0]));
|
|
|
|
cmd.service_id = HAL_SERVICE_ID_PAN;
|
|
|
|
return hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_REGISTER_MODULE,
|
|
sizeof(cmd), &cmd, 0, NULL, NULL);
|
|
}
|
|
|
|
static void pan_cleanup()
|
|
{
|
|
struct hal_cmd_register_module cmd;
|
|
|
|
DBG("");
|
|
|
|
if (!interface_ready())
|
|
return;
|
|
|
|
cbs = NULL;
|
|
|
|
cmd.service_id = HAL_SERVICE_ID_PAN;
|
|
|
|
hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_UNREGISTER_MODULE,
|
|
sizeof(cmd), &cmd, 0, NULL, NULL);
|
|
|
|
hal_ipc_unregister(HAL_SERVICE_ID_PAN);
|
|
}
|
|
|
|
static btpan_interface_t pan_if = {
|
|
.size = sizeof(pan_if),
|
|
.init = pan_init,
|
|
.enable = pan_enable,
|
|
.get_local_role = pan_get_local_role,
|
|
.connect = pan_connect,
|
|
.disconnect = pan_disconnect,
|
|
.cleanup = pan_cleanup
|
|
};
|
|
|
|
btpan_interface_t *bt_get_pan_interface()
|
|
{
|
|
return &pan_if;
|
|
}
|