shared/ad: Add bt_ad_foreach_manufacturer_data

This adds bt_ad_foreach_manufacturer_data function that can be used
list entries added to manufacturer data.
This commit is contained in:
Luiz Augusto von Dentz 2015-04-14 16:40:08 +03:00
parent 93ff31d835
commit 5722661684
2 changed files with 27 additions and 13 deletions

View File

@ -39,12 +39,6 @@ struct uuid_data {
size_t len;
};
struct manufacturer_data {
uint16_t manufacturer_id;
uint8_t *data;
size_t len;
};
struct bt_ad *bt_ad_new(void)
{
struct bt_ad *ad;
@ -109,7 +103,7 @@ static bool uuid_data_match(const void *data, const void *elem)
static void manuf_destroy(void *data)
{
struct manufacturer_data *manuf = data;
struct bt_ad_manufacturer_data *manuf = data;
free(manuf->data);
free(manuf);
@ -117,7 +111,7 @@ static void manuf_destroy(void *data)
static bool manuf_match(const void *data, const void *elem)
{
const struct manufacturer_data *manuf = elem;
const struct bt_ad_manufacturer_data *manuf = elem;
uint16_t manuf_id = PTR_TO_UINT(elem);
return manuf->manufacturer_id == manuf_id;
@ -187,7 +181,7 @@ static size_t mfg_data_length(struct queue *manuf_data)
entry = queue_get_entries(manuf_data);
while (entry) {
struct manufacturer_data *data = entry->data;
struct bt_ad_manufacturer_data *data = entry->data;
length += 2 + sizeof(uint16_t) + data->len;
@ -289,7 +283,7 @@ static void serialize_manuf_data(struct queue *manuf_data, uint8_t *buf,
const struct queue_entry *entry = queue_get_entries(manuf_data);
while (entry) {
struct manufacturer_data *data = entry->data;
struct bt_ad_manufacturer_data *data = entry->data;
buf[(*pos)++] = data->len + 2 + 1;
@ -446,7 +440,7 @@ void bt_ad_clear_service_uuid(struct bt_ad *ad)
bool bt_ad_add_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_id,
void *data, size_t len)
{
struct manufacturer_data *new_data;
struct bt_ad_manufacturer_data *new_data;
if (!ad)
return false;
@ -454,7 +448,7 @@ bool bt_ad_add_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_id,
if (len > (MAX_ADV_DATA_LEN - 2 - sizeof(uint16_t)))
return false;
new_data = new0(struct manufacturer_data, 1);
new_data = new0(struct bt_ad_manufacturer_data, 1);
if (!new_data)
return false;
@ -478,9 +472,18 @@ bool bt_ad_add_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_id,
return false;
}
void bt_ad_foreach_manufacturer_data(struct bt_ad *ad, bt_ad_func_t func,
void *user_data)
{
if (!ad)
return;
queue_foreach(ad->manufacturer_data, func, user_data);
}
bool bt_ad_remove_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_id)
{
struct manufacturer_data *data;
struct bt_ad_manufacturer_data *data;
if (!ad)
return false;

View File

@ -23,8 +23,16 @@
#include "lib/bluetooth.h"
#include "lib/uuid.h"
typedef void (*bt_ad_func_t)(void *data, void *user_data);
struct bt_ad;
struct bt_ad_manufacturer_data {
uint16_t manufacturer_id;
uint8_t *data;
size_t len;
};
struct bt_ad *bt_ad_new(void);
struct bt_ad *bt_ad_ref(struct bt_ad *ad);
@ -42,6 +50,9 @@ void bt_ad_clear_service_uuid(struct bt_ad *ad);
bool bt_ad_add_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_data,
void *data, size_t len);
void bt_ad_foreach_manufacturer_data(struct bt_ad *ad, bt_ad_func_t func,
void *user_data);
bool bt_ad_remove_manufacturer_data(struct bt_ad *ad, uint16_t manufacturer_id);
void bt_ad_clear_manufacturer_data(struct bt_ad *ad);