mirror of
https://git.kernel.org/pub/scm/bluetooth/bluez.git
synced 2024-11-15 16:24:28 +08:00
6a6fe856a9
Future versions of Mesh will introduce new advertising packets, which do not fit in the limited and rigid filtering currently used. This minor rewrite allows registering and receiving of *any* AD types, including the filtering on multiple octets of the incoming AD parts.
171 lines
3.5 KiB
C
171 lines
3.5 KiB
C
/*
|
|
*
|
|
* BlueZ - Bluetooth protocol stack for Linux
|
|
*
|
|
* Copyright (C) 2018 Intel Corporation. All rights reserved.
|
|
*
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
#include <ell/ell.h>
|
|
|
|
#include "lib/bluetooth.h"
|
|
|
|
#include "mesh/mesh-defs.h"
|
|
#include "mesh/mesh-io.h"
|
|
#include "mesh/mesh-io-api.h"
|
|
|
|
/* List of Mesh-IO Type headers */
|
|
#include "mesh/mesh-io-generic.h"
|
|
|
|
/* List of Supported Mesh-IO Types */
|
|
static const struct mesh_io_table table[] = {
|
|
{MESH_IO_TYPE_GENERIC, &mesh_io_generic}
|
|
};
|
|
|
|
static struct l_queue *io_list;
|
|
|
|
static bool match_by_io(const void *a, const void *b)
|
|
{
|
|
return a == b;
|
|
}
|
|
|
|
static bool match_by_type(const void *a, const void *b)
|
|
{
|
|
const struct mesh_io *io = a;
|
|
const enum mesh_io_type type = L_PTR_TO_UINT(b);
|
|
|
|
return io->type == type;
|
|
}
|
|
|
|
struct mesh_io *mesh_io_new(enum mesh_io_type type, void *opts,
|
|
mesh_io_ready_func_t cb, void *user_data)
|
|
{
|
|
const struct mesh_io_api *api = NULL;
|
|
struct mesh_io *io;
|
|
uint16_t i;
|
|
|
|
for (i = 0; i < L_ARRAY_SIZE(table); i++) {
|
|
if (table[i].type == type) {
|
|
api = table[i].api;
|
|
break;
|
|
}
|
|
}
|
|
|
|
io = l_queue_find(io_list, match_by_type, L_UINT_TO_PTR(type));
|
|
|
|
if (!api || !api->init || io)
|
|
return NULL;
|
|
|
|
io = l_new(struct mesh_io, 1);
|
|
|
|
if (!io)
|
|
return NULL;
|
|
|
|
io->type = type;
|
|
|
|
io->api = api;
|
|
if (!api->init(io, opts, cb, user_data))
|
|
goto fail;
|
|
|
|
if (!io_list)
|
|
io_list = l_queue_new();
|
|
|
|
if (l_queue_push_head(io_list, io))
|
|
return io;
|
|
|
|
fail:
|
|
if (api->destroy)
|
|
api->destroy(io);
|
|
|
|
l_free(io);
|
|
return NULL;
|
|
}
|
|
|
|
void mesh_io_destroy(struct mesh_io *io)
|
|
{
|
|
io = l_queue_remove_if(io_list, match_by_io, io);
|
|
|
|
if (io && io->api && io->api->destroy)
|
|
io->api->destroy(io);
|
|
|
|
l_free(io);
|
|
|
|
if (l_queue_isempty(io_list)) {
|
|
l_queue_destroy(io_list, NULL);
|
|
io_list = NULL;
|
|
}
|
|
}
|
|
|
|
bool mesh_io_get_caps(struct mesh_io *io, struct mesh_io_caps *caps)
|
|
{
|
|
io = l_queue_find(io_list, match_by_io, io);
|
|
|
|
if (io && io->api && io->api->caps)
|
|
return io->api->caps(io, caps);
|
|
|
|
return false;
|
|
}
|
|
|
|
bool mesh_io_register_recv_cb(struct mesh_io *io, const uint8_t *filter,
|
|
uint8_t len, mesh_io_recv_func_t cb,
|
|
void *user_data)
|
|
{
|
|
io = l_queue_find(io_list, match_by_io, io);
|
|
|
|
if (io && io->api && io->api->reg)
|
|
return io->api->reg(io, filter, len, cb, user_data);
|
|
|
|
return false;
|
|
}
|
|
|
|
bool mesh_io_deregister_recv_cb(struct mesh_io *io, const uint8_t *filter,
|
|
uint8_t len)
|
|
{
|
|
io = l_queue_find(io_list, match_by_io, io);
|
|
|
|
if (io && io->api && io->api->dereg)
|
|
return io->api->dereg(io, filter, len);
|
|
|
|
return false;
|
|
}
|
|
|
|
bool mesh_io_send(struct mesh_io *io, struct mesh_io_send_info *info,
|
|
const uint8_t *data, uint16_t len)
|
|
{
|
|
io = l_queue_find(io_list, match_by_io, io);
|
|
|
|
if (!io)
|
|
io = l_queue_peek_head(io_list);
|
|
|
|
if (io && io->api && io->api->send)
|
|
return io->api->send(io, info, data, len);
|
|
|
|
return false;
|
|
}
|
|
|
|
bool mesh_io_send_cancel(struct mesh_io *io, const uint8_t *pattern,
|
|
uint8_t len)
|
|
{
|
|
io = l_queue_find(io_list, match_by_io, io);
|
|
|
|
if (io && io->api && io->api->cancel)
|
|
return io->api->cancel(io, pattern, len);
|
|
|
|
return false;
|
|
}
|