| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * |
| * BlueZ - Bluetooth protocol stack for Linux |
| * |
| * Copyright (C) 2016 Intel Corporation. All rights reserved. |
| * |
| * |
| */ |
| |
| #ifdef HAVE_CONFIG_H |
| #include <config.h> |
| #endif |
| |
| #define _GNU_SOURCE |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <stdint.h> |
| #include <stdbool.h> |
| #include <string.h> |
| |
| #include "gdbus/gdbus.h" |
| #include "src/shared/util.h" |
| #include "src/shared/shell.h" |
| #include "advertising.h" |
| |
| #define AD_PATH "/org/bluez/advertising" |
| #define AD_IFACE "org.bluez.LEAdvertisement1" |
| |
| struct ad_data { |
| uint8_t data[245]; |
| uint8_t len; |
| }; |
| |
| struct service_data { |
| char *uuid; |
| struct ad_data data; |
| }; |
| |
| struct manufacturer_data { |
| uint16_t id; |
| struct ad_data data; |
| }; |
| |
| struct data { |
| bool valid; |
| uint8_t type; |
| struct ad_data data; |
| }; |
| |
| static struct ad { |
| bool registered; |
| char *type; |
| char *local_name; |
| char *secondary; |
| uint32_t min_interval; |
| uint32_t max_interval; |
| uint16_t local_appearance; |
| uint16_t duration; |
| uint16_t timeout; |
| uint16_t discoverable_to; |
| char **uuids; |
| size_t uuids_len; |
| struct service_data service; |
| struct manufacturer_data manufacturer; |
| struct data data; |
| bool discoverable; |
| bool tx_power; |
| bool name; |
| bool appearance; |
| bool rsi; |
| } ad = { |
| .local_appearance = UINT16_MAX, |
| .discoverable = true, |
| .rsi = true, |
| }; |
| |
| static void ad_release(DBusConnection *conn) |
| { |
| ad.registered = false; |
| |
| g_dbus_unregister_interface(conn, AD_PATH, AD_IFACE); |
| } |
| |
| static DBusMessage *release_advertising(DBusConnection *conn, |
| DBusMessage *msg, void *user_data) |
| { |
| bt_shell_printf("Advertising released\n"); |
| |
| ad_release(conn); |
| |
| return dbus_message_new_method_return(msg); |
| } |
| |
| static const GDBusMethodTable ad_methods[] = { |
| { GDBUS_METHOD("Release", NULL, NULL, release_advertising) }, |
| { } |
| }; |
| |
| static void register_setup(DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter dict; |
| const char *path = AD_PATH; |
| |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path); |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, |
| DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING |
| DBUS_TYPE_STRING_AS_STRING |
| DBUS_TYPE_VARIANT_AS_STRING |
| DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict); |
| dbus_message_iter_close_container(iter, &dict); |
| } |
| |
| static void print_uuid(const char *uuid) |
| { |
| const char *text; |
| |
| text = bt_uuidstr_to_str(uuid); |
| if (text) { |
| char str[26]; |
| unsigned int n; |
| |
| str[sizeof(str) - 1] = '\0'; |
| |
| n = snprintf(str, sizeof(str), "%s", text); |
| if (n > sizeof(str) - 1) { |
| str[sizeof(str) - 2] = '.'; |
| str[sizeof(str) - 3] = '.'; |
| if (str[sizeof(str) - 4] == ' ') |
| str[sizeof(str) - 4] = '.'; |
| } |
| |
| bt_shell_printf("UUID: %s(%s)\n", str, uuid); |
| } else |
| bt_shell_printf("UUID: (%s)\n", uuid ? uuid : ""); |
| } |
| |
| static void print_ad_uuids(void) |
| { |
| char **uuid; |
| |
| for (uuid = ad.uuids; uuid && *uuid; uuid++) |
| print_uuid(*uuid); |
| } |
| |
| static void print_ad(void) |
| { |
| print_ad_uuids(); |
| |
| if (ad.service.uuid) { |
| print_uuid(ad.service.uuid); |
| bt_shell_hexdump(ad.service.data.data, ad.service.data.len); |
| } |
| |
| if (ad.manufacturer.data.len) { |
| bt_shell_printf("Manufacturer: %u\n", ad.manufacturer.id); |
| bt_shell_hexdump(ad.manufacturer.data.data, |
| ad.manufacturer.data.len); |
| } |
| |
| if (ad.data.valid) { |
| bt_shell_printf("Data Type: 0x%02x\n", ad.data.type); |
| bt_shell_hexdump(ad.data.data.data, ad.data.data.len); |
| } |
| |
| bt_shell_printf("Tx Power: %s\n", ad.tx_power ? "on" : "off"); |
| |
| if (ad.local_name) |
| bt_shell_printf("LocalName: %s\n", ad.local_name); |
| else |
| bt_shell_printf("Name: %s\n", ad.name ? "on" : "off"); |
| |
| if (ad.local_appearance != UINT16_MAX) |
| bt_shell_printf("Appearance: %s (0x%04x)\n", |
| bt_appear_to_str(ad.local_appearance), |
| ad.local_appearance); |
| else |
| bt_shell_printf("Appearance: %s\n", |
| ad.appearance ? "on" : "off"); |
| |
| bt_shell_printf("Discoverable: %s\n", ad.discoverable ? "on" : "off"); |
| bt_shell_printf("RSI: %s\n", ad.rsi ? "on" : "off"); |
| |
| if (ad.duration) |
| bt_shell_printf("Duration: %u sec\n", ad.duration); |
| |
| if (ad.timeout) |
| bt_shell_printf("Timeout: %u sec\n", ad.timeout); |
| |
| if (ad.min_interval) |
| bt_shell_printf("Interval: %u-%u msec\n", ad.min_interval, |
| ad.max_interval); |
| } |
| |
| static void register_reply(DBusMessage *message, void *user_data) |
| { |
| DBusConnection *conn = user_data; |
| DBusError error; |
| |
| dbus_error_init(&error); |
| |
| if (dbus_set_error_from_message(&error, message) == FALSE) { |
| ad.registered = true; |
| bt_shell_printf("Advertising object registered\n"); |
| print_ad(); |
| /* Leave advertise running even on noninteractive mode */ |
| } else { |
| bt_shell_printf("Failed to register advertisement: %s\n", error.name); |
| dbus_error_free(&error); |
| |
| if (g_dbus_unregister_interface(conn, AD_PATH, |
| AD_IFACE) == FALSE) |
| bt_shell_printf("Failed to unregister advertising object\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| } |
| |
| static gboolean get_type(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| const char *type = "peripheral"; |
| |
| if (ad.type && strlen(ad.type) > 0) |
| type = ad.type; |
| |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &type); |
| |
| return TRUE; |
| } |
| |
| static gboolean uuids_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.uuids_len != 0; |
| } |
| |
| static gboolean get_uuids(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter array; |
| size_t i; |
| |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, "as", &array); |
| |
| for (i = 0; i < ad.uuids_len; i++) |
| dbus_message_iter_append_basic(&array, DBUS_TYPE_STRING, |
| &ad.uuids[i]); |
| |
| dbus_message_iter_close_container(iter, &array); |
| |
| return TRUE; |
| } |
| |
| static gboolean service_data_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.service.uuid != NULL; |
| } |
| |
| static gboolean get_service_data(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter dict; |
| struct ad_data *data = &ad.service.data; |
| uint8_t *val = data->data; |
| |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, "{sv}", &dict); |
| |
| g_dbus_dict_append_array(&dict, ad.service.uuid, DBUS_TYPE_BYTE, &val, |
| data->len); |
| |
| dbus_message_iter_close_container(iter, &dict); |
| |
| return TRUE; |
| } |
| |
| static gboolean manufacturer_data_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.manufacturer.id != 0; |
| } |
| |
| static gboolean get_manufacturer_data(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter dict; |
| struct ad_data *data = &ad.manufacturer.data; |
| uint8_t *val = data->data; |
| |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, "{qv}", &dict); |
| |
| g_dbus_dict_append_basic_array(&dict, DBUS_TYPE_UINT16, |
| &ad.manufacturer.id, |
| DBUS_TYPE_BYTE, &val, data->len); |
| |
| dbus_message_iter_close_container(iter, &dict); |
| |
| return TRUE; |
| } |
| |
| static gboolean includes_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.tx_power || ad.name || ad.appearance || ad.rsi; |
| } |
| |
| static gboolean get_includes(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter array; |
| |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, "as", &array); |
| |
| if (ad.tx_power) { |
| const char *str = "tx-power"; |
| |
| dbus_message_iter_append_basic(&array, DBUS_TYPE_STRING, &str); |
| } |
| |
| if (ad.name) { |
| const char *str = "local-name"; |
| |
| dbus_message_iter_append_basic(&array, DBUS_TYPE_STRING, &str); |
| } |
| |
| if (ad.appearance) { |
| const char *str = "appearance"; |
| |
| dbus_message_iter_append_basic(&array, DBUS_TYPE_STRING, &str); |
| } |
| |
| if (ad.rsi) { |
| const char *str = "rsi"; |
| |
| dbus_message_iter_append_basic(&array, DBUS_TYPE_STRING, &str); |
| } |
| |
| dbus_message_iter_close_container(iter, &array); |
| |
| |
| return TRUE; |
| } |
| |
| static gboolean local_name_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.local_name ? TRUE : FALSE; |
| } |
| |
| static gboolean get_local_name(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &ad.local_name); |
| |
| return TRUE; |
| } |
| |
| static gboolean appearance_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.local_appearance != UINT16_MAX ? TRUE : FALSE; |
| } |
| |
| static gboolean get_appearance(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16, |
| &ad.local_appearance); |
| |
| return TRUE; |
| } |
| |
| static gboolean duration_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.duration; |
| } |
| |
| static gboolean get_duration(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16, &ad.duration); |
| |
| return TRUE; |
| } |
| |
| static gboolean timeout_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.timeout; |
| } |
| |
| static gboolean get_timeout(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16, &ad.timeout); |
| |
| return TRUE; |
| } |
| |
| static gboolean data_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.data.valid; |
| } |
| |
| static gboolean get_data(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| DBusMessageIter dict; |
| struct ad_data *data = &ad.data.data; |
| uint8_t *val = data->data; |
| |
| dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY, "{yv}", &dict); |
| |
| g_dbus_dict_append_basic_array(&dict, DBUS_TYPE_BYTE, &ad.data.type, |
| DBUS_TYPE_BYTE, &val, data->len); |
| |
| dbus_message_iter_close_container(iter, &dict); |
| |
| return TRUE; |
| } |
| |
| static gboolean get_discoverable(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_bool_t value = ad.discoverable; |
| |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &value); |
| |
| return TRUE; |
| } |
| |
| static gboolean discoverable_timeout_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.discoverable_to; |
| } |
| |
| static gboolean get_discoverable_timeout(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16, |
| &ad.discoverable_to); |
| |
| return TRUE; |
| } |
| |
| static gboolean secondary_exists(const GDBusPropertyTable *property, void *data) |
| { |
| return ad.secondary ? TRUE : FALSE; |
| } |
| |
| static gboolean get_secondary(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, |
| &ad.secondary); |
| |
| return TRUE; |
| } |
| |
| static gboolean min_interval_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.min_interval; |
| } |
| |
| static gboolean get_min_interval(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, |
| &ad.min_interval); |
| |
| return TRUE; |
| } |
| |
| static gboolean max_interval_exists(const GDBusPropertyTable *property, |
| void *data) |
| { |
| return ad.max_interval; |
| } |
| |
| static gboolean get_max_interval(const GDBusPropertyTable *property, |
| DBusMessageIter *iter, void *user_data) |
| { |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, |
| &ad.max_interval); |
| |
| return TRUE; |
| } |
| |
| static const GDBusPropertyTable ad_props[] = { |
| { "Type", "s", get_type }, |
| { "ServiceUUIDs", "as", get_uuids, NULL, uuids_exists }, |
| { "ServiceData", "a{sv}", get_service_data, NULL, service_data_exists }, |
| { "ManufacturerData", "a{qv}", get_manufacturer_data, NULL, |
| manufacturer_data_exists }, |
| { "Data", "a{yv}", get_data, NULL, data_exists }, |
| { "Discoverable", "b", get_discoverable, NULL, NULL }, |
| { "DiscoverableTimeout", "q", get_discoverable_timeout, NULL, |
| discoverable_timeout_exists }, |
| { "Includes", "as", get_includes, NULL, includes_exists }, |
| { "LocalName", "s", get_local_name, NULL, local_name_exists }, |
| { "Appearance", "q", get_appearance, NULL, appearance_exists }, |
| { "Duration", "q", get_duration, NULL, duration_exists }, |
| { "Timeout", "q", get_timeout, NULL, timeout_exists }, |
| { "MinInterval", "u", get_min_interval, NULL, min_interval_exists }, |
| { "MaxInterval", "u", get_max_interval, NULL, max_interval_exists }, |
| { "SecondaryChannel", "s", get_secondary, NULL, secondary_exists }, |
| { } |
| }; |
| |
| void ad_register(DBusConnection *conn, GDBusProxy *manager, const char *type) |
| { |
| if (ad.registered) { |
| bt_shell_printf("Advertisement is already registered\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| |
| g_free(ad.type); |
| ad.type = g_strdup(type); |
| |
| if (!strcasecmp(ad.type, "Broadcast")) |
| ad.discoverable = false; |
| |
| if (g_dbus_register_interface(conn, AD_PATH, AD_IFACE, ad_methods, |
| NULL, ad_props, NULL, NULL) == FALSE) { |
| bt_shell_printf("Failed to register advertising object\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| |
| if (g_dbus_proxy_method_call(manager, "RegisterAdvertisement", |
| register_setup, register_reply, |
| conn, NULL) == FALSE) { |
| bt_shell_printf("Failed to register advertising\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| } |
| |
| static void unregister_setup(DBusMessageIter *iter, void *user_data) |
| { |
| const char *path = AD_PATH; |
| |
| dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path); |
| } |
| |
| static void unregister_reply(DBusMessage *message, void *user_data) |
| { |
| DBusConnection *conn = user_data; |
| DBusError error; |
| |
| dbus_error_init(&error); |
| |
| if (dbus_set_error_from_message(&error, message) == FALSE) { |
| ad.registered = false; |
| bt_shell_printf("Advertising object unregistered\n"); |
| if (g_dbus_unregister_interface(conn, AD_PATH, |
| AD_IFACE) == FALSE) |
| bt_shell_printf("Failed to unregister advertising" |
| " object\n"); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } else { |
| bt_shell_printf("Failed to unregister advertisement: %s\n", |
| error.name); |
| dbus_error_free(&error); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| } |
| |
| void ad_unregister(DBusConnection *conn, GDBusProxy *manager) |
| { |
| if (!manager) |
| ad_release(conn); |
| |
| if (!ad.registered) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| g_free(ad.type); |
| ad.type = NULL; |
| |
| if (g_dbus_proxy_method_call(manager, "UnregisterAdvertisement", |
| unregister_setup, unregister_reply, |
| conn, NULL) == FALSE) { |
| bt_shell_printf("Failed to unregister advertisement method\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| } |
| |
| static void ad_clear_uuids(void) |
| { |
| g_strfreev(ad.uuids); |
| ad.uuids = NULL; |
| ad.uuids_len = 0; |
| } |
| |
| void ad_advertise_uuids(DBusConnection *conn, int argc, char *argv[]) |
| { |
| if (argc < 2 || !strlen(argv[1])) { |
| print_ad_uuids(); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| ad_clear_uuids(); |
| |
| ad.uuids = g_strdupv(&argv[1]); |
| if (!ad.uuids) { |
| bt_shell_printf("Failed to parse input\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| |
| ad.uuids_len = g_strv_length(ad.uuids); |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "ServiceUUIDs"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_disable_uuids(DBusConnection *conn) |
| { |
| if (!ad.uuids) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad_clear_uuids(); |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "ServiceUUIDs"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| static void ad_clear_service(void) |
| { |
| g_free(ad.service.uuid); |
| memset(&ad.service, 0, sizeof(ad.service)); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| static bool ad_add_data(struct ad_data *data, int argc, char *argv[]) |
| { |
| unsigned int i; |
| |
| memset(data, 0, sizeof(*data)); |
| |
| for (i = 0; i < (unsigned int) argc; i++) { |
| long int val; |
| char *endptr = NULL; |
| |
| if (i >= G_N_ELEMENTS(data->data)) { |
| bt_shell_printf("Too much data\n"); |
| return false; |
| } |
| |
| val = strtol(argv[i], &endptr, 0); |
| if (!endptr || *endptr != '\0' || val > UINT8_MAX) { |
| bt_shell_printf("Invalid value at index %d\n", i); |
| return false; |
| } |
| |
| data->data[data->len] = val; |
| data->len++; |
| } |
| |
| return true; |
| } |
| |
| void ad_advertise_service(DBusConnection *conn, int argc, char *argv[]) |
| { |
| struct ad_data data; |
| |
| if (argc < 2 || !strlen(argv[1])) { |
| if (ad.service.uuid) { |
| print_uuid(ad.service.uuid); |
| bt_shell_hexdump(ad.service.data.data, |
| ad.service.data.len); |
| } |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (!ad_add_data(&data, argc - 2, argv + 2)) |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| |
| ad_clear_service(); |
| |
| ad.service.uuid = g_strdup(argv[1]); |
| ad.service.data = data; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "ServiceData"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_disable_service(DBusConnection *conn) |
| { |
| if (!ad.service.uuid) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad_clear_service(); |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "ServiceData"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| static void ad_clear_manufacturer(void) |
| { |
| memset(&ad.manufacturer, 0, sizeof(ad.manufacturer)); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_manufacturer(DBusConnection *conn, int argc, char *argv[]) |
| { |
| char *endptr = NULL; |
| long int val; |
| struct ad_data data; |
| |
| if (argc < 2 || !strlen(argv[1])) { |
| if (ad.manufacturer.data.len) { |
| bt_shell_printf("Manufacturer: %u\n", |
| ad.manufacturer.id); |
| bt_shell_hexdump(ad.manufacturer.data.data, |
| ad.manufacturer.data.len); |
| } |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| val = strtol(argv[1], &endptr, 0); |
| if (!endptr || *endptr != '\0' || val > UINT16_MAX) { |
| bt_shell_printf("Invalid manufacture id\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| |
| if (!ad_add_data(&data, argc - 2, argv + 2)) |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| |
| ad_clear_manufacturer(); |
| ad.manufacturer.id = val; |
| ad.manufacturer.data = data; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "ManufacturerData"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_disable_manufacturer(DBusConnection *conn) |
| { |
| if (!ad.manufacturer.id && !ad.manufacturer.data.len) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad_clear_manufacturer(); |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "ManufacturerData"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| static void ad_clear_data(void) |
| { |
| memset(&ad.data, 0, sizeof(ad.data)); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_data(DBusConnection *conn, int argc, char *argv[]) |
| { |
| char *endptr = NULL; |
| long int val; |
| struct ad_data data; |
| |
| if (argc < 2 || !strlen(argv[1])) { |
| if (ad.data.data.len) { |
| bt_shell_printf("Type: 0x%02x\n", ad.data.type); |
| bt_shell_hexdump(ad.data.data.data, ad.data.data.len); |
| } |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| val = strtol(argv[1], &endptr, 0); |
| if (!endptr || *endptr != '\0' || val > UINT8_MAX) { |
| bt_shell_printf("Invalid type\n"); |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| } |
| |
| if (!ad_add_data(&data, argc - 2, argv + 2)) |
| return bt_shell_noninteractive_quit(EXIT_FAILURE); |
| |
| ad_clear_data(); |
| ad.data.valid = true; |
| ad.data.type = val; |
| ad.data.data = data; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Data"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_disable_data(DBusConnection *conn) |
| { |
| if (!ad.data.type && !ad.data.data.len) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad_clear_data(); |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Data"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_discoverable(DBusConnection *conn, dbus_bool_t *value) |
| { |
| if (!value) { |
| bt_shell_printf("Discoverable: %s\n", |
| ad.discoverable ? "on" : "off"); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.discoverable == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.discoverable = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Discoverable"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_discoverable_timeout(DBusConnection *conn, long int *value) |
| { |
| if (!value) { |
| if (ad.discoverable_to) |
| bt_shell_printf("Timeout: %u sec\n", |
| ad.discoverable_to); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.discoverable_to == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.discoverable_to = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "DiscoverableTimeout"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_tx_power(DBusConnection *conn, dbus_bool_t *value) |
| { |
| if (!value) { |
| bt_shell_printf("Tx Power: %s\n", ad.tx_power ? "on" : "off"); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.tx_power == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.tx_power = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Includes"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_name(DBusConnection *conn, bool value) |
| { |
| if (ad.name == value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.name = value; |
| |
| if (!value) { |
| free(ad.local_name); |
| ad.local_name = NULL; |
| } |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Includes"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_local_name(DBusConnection *conn, const char *name) |
| { |
| if (!name) { |
| if (ad.local_name) |
| bt_shell_printf("LocalName: %s\n", ad.local_name); |
| else |
| bt_shell_printf("Name: %s\n", ad.name ? "on" : "off"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.local_name && !strcmp(name, ad.local_name)) |
| return; |
| |
| g_free(ad.local_name); |
| ad.local_name = strdup(name); |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "LocalName"); |
| |
| /* Remove local-name from Includes since LocalName would be set */ |
| if (ad.name) { |
| ad.name = false; |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "Includes"); |
| } |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_appearance(DBusConnection *conn, bool value) |
| { |
| if (ad.appearance == value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.appearance = value; |
| |
| if (!value) |
| ad.local_appearance = UINT16_MAX; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Includes"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_local_appearance(DBusConnection *conn, long int *value) |
| { |
| if (!value) { |
| if (ad.local_appearance != UINT16_MAX) |
| bt_shell_printf("Appearance: %s (0x%04x)\n", |
| bt_appear_to_str(ad.local_appearance), |
| ad.local_appearance); |
| else |
| bt_shell_printf("Appearance: %s\n", |
| ad.appearance ? "on" : "off"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.local_appearance == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.local_appearance = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Appearance"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_duration(DBusConnection *conn, long int *value) |
| { |
| if (!value) { |
| if (ad.duration) |
| bt_shell_printf("Duration: %u sec\n", ad.duration); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.duration == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.duration = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Duration"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_timeout(DBusConnection *conn, long int *value) |
| { |
| if (!value) { |
| if (ad.timeout) |
| bt_shell_printf("Timeout: %u sec\n", ad.timeout); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.timeout == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.timeout = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Timeout"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_secondary(DBusConnection *conn, const char *value) |
| { |
| if (!value) { |
| if (ad.secondary) |
| bt_shell_printf("Secondary Channel: %s\n", |
| ad.secondary); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.secondary && !strcmp(value, ad.secondary)) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| free(ad.secondary); |
| |
| if (value[0] == '\0') { |
| ad.secondary = NULL; |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| ad.secondary = strdup(value); |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "SecondaryChannel"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_interval(DBusConnection *conn, uint32_t *min, uint32_t *max) |
| { |
| if (!min && !max) { |
| if (ad.min_interval && ad.max_interval) |
| bt_shell_printf("Interval: %u-%u msec\n", |
| ad.min_interval, ad.max_interval); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (min && ad.min_interval != *min) { |
| ad.min_interval = *min; |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "MinInterval"); |
| } |
| |
| if (max && ad.max_interval != *max) { |
| ad.max_interval = *max; |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, |
| "MaxInterval"); |
| } |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| void ad_advertise_rsi(DBusConnection *conn, dbus_bool_t *value) |
| { |
| if (!value) { |
| bt_shell_printf("RSI: %s\n", ad.rsi ? "on" : "off"); |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |
| |
| if (ad.rsi == *value) |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| |
| ad.rsi = *value; |
| |
| g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE, "Includes"); |
| |
| return bt_shell_noninteractive_quit(EXIT_SUCCESS); |
| } |