| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025 |
- // 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[25];
- uint8_t len;
- };
- struct service_data {
- char *uuid;
- struct ad_data data;
- };
- struct manufacturer_data {
- uint16_t id;
- struct ad_data data;
- };
- struct data {
- 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;
- } ad = {
- .local_appearance = UINT16_MAX,
- .discoverable = 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] = '.';
- n = sizeof(str) - 1;
- }
- 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.data.len) {
- 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");
- 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;
- }
- 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);
- }
- dbus_message_iter_close_container(iter, &array);
- return TRUE;
- }
- static gboolean local_name_exits(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_exits(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_exits(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_exits(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.type != 0;
- }
- 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 discoverable_exists(const GDBusPropertyTable *property,
- void *data)
- {
- return ad.discoverable;
- }
- 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_exits(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_exits(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_exits(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_exits(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, discoverable_exists },
- { "DiscoverableTimeout", "q", get_discoverable_timeout, NULL,
- discoverable_timeout_exits },
- { "Includes", "as", get_includes, NULL, includes_exists },
- { "LocalName", "s", get_local_name, NULL, local_name_exits },
- { "Appearance", "q", get_appearance, NULL, appearance_exits },
- { "Duration", "q", get_duration, NULL, duration_exits },
- { "Timeout", "q", get_timeout, NULL, timeout_exits },
- { "MinInterval", "u", get_min_interval, NULL, min_interval_exits },
- { "MaxInterval", "u", get_max_interval, NULL, max_interval_exits },
- { "SecondaryChannel", "s", get_secondary, NULL, secondary_exits },
- { }
- };
- 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.manufacturer, 0, sizeof(ad.manufacturer));
- 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.manufacturer.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.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 (ad.min_interval != *min) {
- ad.min_interval = *min;
- g_dbus_emit_property_changed(conn, AD_PATH, AD_IFACE,
- "MinInterval");
- }
- if (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);
- }
|