main.c.b1 78 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. *
  4. * BlueZ - Bluetooth protocol stack for Linux
  5. *
  6. * Copyright (C) 2012 Intel Corporation. All rights reserved.
  7. *
  8. *
  9. */
  10. #ifdef HAVE_CONFIG_H
  11. #include <config.h>
  12. #endif
  13. #define _GNU_SOURCE
  14. #include <stdio.h>
  15. #include <errno.h>
  16. #include <unistd.h>
  17. #include <stdlib.h>
  18. #include <stdbool.h>
  19. #include <wordexp.h>
  20. #include <ctype.h>
  21. #include <glib.h>
  22. #include "src/shared/shell.h"
  23. #include "src/shared/util.h"
  24. #include "gdbus/gdbus.h"
  25. #include "agent.h"
  26. #include "gatt.h"
  27. #include "advertising.h"
  28. #include "adv_monitor.h"
  29. #include "admin.h"
  30. /* String display constants */
  31. #define COLORED_NEW COLOR_GREEN "NEW" COLOR_OFF
  32. #define COLORED_CHG COLOR_YELLOW "CHG" COLOR_OFF
  33. #define COLORED_DEL COLOR_RED "DEL" COLOR_OFF
  34. #define PROMPT_ON COLOR_BLUE "[bluetooth]" COLOR_OFF "# "
  35. #define PROMPT_OFF "Waiting to connect to bluetoothd..."
  36. static DBusConnection *dbus_conn;
  37. static GDBusProxy *agent_manager;
  38. static char *auto_register_agent = NULL;
  39. struct adapter {
  40. GDBusProxy *proxy;
  41. GDBusProxy *ad_proxy;
  42. GDBusProxy *adv_monitor_proxy;
  43. GList *devices;
  44. };
  45. static struct adapter *default_ctrl;
  46. static GDBusProxy *default_dev;
  47. static GDBusProxy *default_attr;
  48. static GList *ctrl_list;
  49. static GList *battery_proxies;
  50. static GList *admin_devices_proxies;
  51. static const char *agent_arguments[] = {
  52. "on",
  53. "off",
  54. "DisplayOnly",
  55. "DisplayYesNo",
  56. "KeyboardDisplay",
  57. "KeyboardOnly",
  58. "NoInputNoOutput",
  59. NULL
  60. };
  61. static const char *ad_arguments[] = {
  62. "on",
  63. "off",
  64. "peripheral",
  65. "broadcast",
  66. NULL
  67. };
  68. static void proxy_leak(gpointer data)
  69. {
  70. printf("Leaking proxy %p\n", data);
  71. }
  72. static void setup_standard_input(void)
  73. {
  74. bt_shell_attach(fileno(stdin));
  75. }
  76. static void connect_handler(DBusConnection *connection, void *user_data)
  77. {
  78. bt_shell_set_prompt(PROMPT_ON);
  79. }
  80. static void disconnect_handler(DBusConnection *connection, void *user_data)
  81. {
  82. bt_shell_detach();
  83. bt_shell_set_prompt(PROMPT_OFF);
  84. g_list_free_full(ctrl_list, proxy_leak);
  85. g_list_free_full(battery_proxies, proxy_leak);
  86. ctrl_list = NULL;
  87. battery_proxies = NULL;
  88. default_ctrl = NULL;
  89. }
  90. static void print_adapter(GDBusProxy *proxy, const char *description)
  91. {
  92. DBusMessageIter iter;
  93. const char *address, *name;
  94. if (g_dbus_proxy_get_property(proxy, "Address", &iter) == FALSE)
  95. return;
  96. dbus_message_iter_get_basic(&iter, &address);
  97. if (g_dbus_proxy_get_property(proxy, "Alias", &iter) == TRUE)
  98. dbus_message_iter_get_basic(&iter, &name);
  99. else
  100. name = "<unknown>";
  101. bt_shell_printf("%s%s%sController %s %s %s\n",
  102. description ? "[" : "",
  103. description ? : "",
  104. description ? "] " : "",
  105. address, name,
  106. default_ctrl &&
  107. default_ctrl->proxy == proxy ?
  108. "[default]" : "");
  109. }
  110. static void print_device(GDBusProxy *proxy, const char *description)
  111. {
  112. DBusMessageIter iter;
  113. const char *address, *name;
  114. if (g_dbus_proxy_get_property(proxy, "Address", &iter) == FALSE)
  115. return;
  116. dbus_message_iter_get_basic(&iter, &address);
  117. if (g_dbus_proxy_get_property(proxy, "Alias", &iter) == TRUE)
  118. dbus_message_iter_get_basic(&iter, &name);
  119. else
  120. name = "<unknown>";
  121. #if 0
  122. bt_shell_printf("%s%s%s-Device %s %s\n",
  123. description ? "[" : "",
  124. description ? : "",
  125. description ? "] " : "",
  126. address, name);
  127. #endif
  128. }
  129. void find_sos_key(const unsigned char *buf, size_t len)
  130. {
  131. static const char hexdigits[] = "0123456789abcdef";
  132. char str[68];
  133. size_t i;
  134. if (!len)
  135. return;
  136. str[0] = ' ';
  137. for (i = 0; i < len; i++) {
  138. str[((i % 16) * 3) + 1] = ' ';
  139. str[((i % 16) * 3) + 2] = hexdigits[buf[i] >> 4];
  140. str[((i % 16) * 3) + 3] = hexdigits[buf[i] & 0xf];
  141. str[(i % 16) + 51] = isprint(buf[i]) ? buf[i] : '.';
  142. if ((i + 1) % 16 == 0) {
  143. str[49] = ' ';
  144. str[50] = ' ';
  145. str[67] = '\0';
  146. //function(str, user_data);
  147. bt_shell_printf("==%s\n", str);
  148. str[0] = ' ';
  149. }
  150. }
  151. if (i % 16 > 0) {
  152. size_t j;
  153. for (j = (i % 16); j < 16; j++) {
  154. str[(j * 3) + 1] = ' ';
  155. str[(j * 3) + 2] = ' ';
  156. str[(j * 3) + 3] = ' ';
  157. str[j + 51] = ' ';
  158. }
  159. str[49] = ' ';
  160. str[50] = ' ';
  161. str[67] = '\0';
  162. //function(str, user_data);
  163. bt_shell_printf("======%s\n", str);
  164. }
  165. }
  166. static void print_fixed_iter(const char *label, const char *name,
  167. DBusMessageIter *iter)
  168. {
  169. char des_mac[] = "F0:C9:10:01:03:E2";
  170. dbus_bool_t *valbool;
  171. dbus_uint32_t *valu32;
  172. dbus_uint16_t *valu16;
  173. dbus_int16_t *vals16;
  174. unsigned char *byte;
  175. int len;
  176. switch (dbus_message_iter_get_arg_type(iter)) {
  177. case DBUS_TYPE_BOOLEAN:
  178. dbus_message_iter_get_fixed_array(iter, &valbool, &len);
  179. if (len <= 0)
  180. return;
  181. bt_shell_printf("bool%s%s:\n", label, name);
  182. bt_shell_hexdump((void *)valbool, len * sizeof(*valbool));
  183. break;
  184. case DBUS_TYPE_UINT32:
  185. dbus_message_iter_get_fixed_array(iter, &valu32, &len);
  186. if (len <= 0)
  187. return;
  188. bt_shell_printf("++++%s%s:\n", label, name);
  189. bt_shell_hexdump((void *)valu32, len * sizeof(*valu32));
  190. break;
  191. case DBUS_TYPE_UINT16:
  192. dbus_message_iter_get_fixed_array(iter, &valu16, &len);
  193. if (len <= 0)
  194. return;
  195. bt_shell_printf("++%s%s:\n", label, name);
  196. bt_shell_hexdump((void *)valu16, len * sizeof(*valu16));
  197. break;
  198. case DBUS_TYPE_INT16:
  199. dbus_message_iter_get_fixed_array(iter, &vals16, &len);
  200. if (len <= 0)
  201. return;
  202. bt_shell_printf("++%s%s:\n", label, name);
  203. bt_shell_hexdump((void *)vals16, len * sizeof(*vals16));
  204. break;
  205. case DBUS_TYPE_BYTE:
  206. dbus_message_iter_get_fixed_array(iter, &byte, &len);
  207. if (len <= 0)
  208. return;
  209. char* p = strstr(label, des_mac);
  210. if( p!= NULL){
  211. bt_shell_printf("L=%sN=%s:\n", label, name);
  212. find_sos_key((void *)byte, len * sizeof(*byte));
  213. }
  214. #if 0
  215. bt_shell_printf("L=%sN=%s:\n", label, name);
  216. //bt_shell_hexdump((void *)byte, len * sizeof(*byte));
  217. find_sos_key((void *)byte, len * sizeof(*byte));
  218. #endif
  219. break;
  220. default:
  221. return;
  222. };
  223. }
  224. static void print_iter(const char *label, const char *name,
  225. DBusMessageIter *iter)
  226. {
  227. dbus_bool_t valbool;
  228. dbus_uint32_t valu32;
  229. dbus_uint16_t valu16;
  230. dbus_int16_t vals16;
  231. unsigned char byte;
  232. const char *valstr;
  233. DBusMessageIter subiter;
  234. char *entry;
  235. if (iter == NULL) {
  236. bt_shell_printf("%s%s is nil\n", label, name);
  237. return;
  238. }
  239. switch (dbus_message_iter_get_arg_type(iter)) {
  240. case DBUS_TYPE_INVALID:
  241. bt_shell_printf("%s%s is invalid\n", label, name);
  242. break;
  243. case DBUS_TYPE_STRING:
  244. case DBUS_TYPE_OBJECT_PATH:
  245. dbus_message_iter_get_basic(iter, &valstr);
  246. //bt_shell_printf("%s%s: %s\n", label, name, valstr);
  247. break;
  248. case DBUS_TYPE_BOOLEAN:
  249. dbus_message_iter_get_basic(iter, &valbool);
  250. //bt_shell_printf("%s%s: %s\n", label, name, valbool == TRUE ? "yes" : "no");
  251. break;
  252. case DBUS_TYPE_UINT32:
  253. dbus_message_iter_get_basic(iter, &valu32);
  254. //bt_shell_printf("%s%s: 0x%08x\n", label, name, valu32);
  255. break;
  256. case DBUS_TYPE_UINT16:
  257. dbus_message_iter_get_basic(iter, &valu16);
  258. //bt_shell_printf("%s%s: 0x%04x\n", label, name, valu16);
  259. break;
  260. case DBUS_TYPE_INT16:
  261. dbus_message_iter_get_basic(iter, &vals16);
  262. //bt_shell_printf("%s%s: %d\n", label, name, vals16);
  263. break;
  264. case DBUS_TYPE_BYTE:
  265. dbus_message_iter_get_basic(iter, &byte);
  266. bt_shell_printf("%s%s: 0x%02x (%d)\n", label, name, byte, byte);
  267. break;
  268. case DBUS_TYPE_VARIANT:
  269. dbus_message_iter_recurse(iter, &subiter);
  270. print_iter(label, name, &subiter);
  271. break;
  272. case DBUS_TYPE_ARRAY:
  273. dbus_message_iter_recurse(iter, &subiter);
  274. if (dbus_type_is_fixed(
  275. dbus_message_iter_get_arg_type(&subiter))) {
  276. print_fixed_iter(label, name, &subiter);
  277. break;
  278. }
  279. while (dbus_message_iter_get_arg_type(&subiter) !=
  280. DBUS_TYPE_INVALID) {
  281. print_iter(label, name, &subiter);
  282. dbus_message_iter_next(&subiter);
  283. }
  284. break;
  285. case DBUS_TYPE_DICT_ENTRY:
  286. dbus_message_iter_recurse(iter, &subiter);
  287. entry = g_strconcat(name, "-Key", NULL);
  288. print_iter(label, entry, &subiter);
  289. g_free(entry);
  290. entry = g_strconcat(name, "--Value", NULL);
  291. dbus_message_iter_next(&subiter);
  292. print_iter(label, entry, &subiter);
  293. g_free(entry);
  294. break;
  295. default:
  296. bt_shell_printf("%s%s has unsupported type\n", label, name);
  297. break;
  298. }
  299. }
  300. static void print_property_with_label(GDBusProxy *proxy, const char *name,
  301. const char *label)
  302. {
  303. DBusMessageIter iter;
  304. if (g_dbus_proxy_get_property(proxy, name, &iter) == FALSE)
  305. return;
  306. print_iter("\t", label ? label : name, &iter);
  307. }
  308. static void print_property(GDBusProxy *proxy, const char *name)
  309. {
  310. print_property_with_label(proxy, name, NULL);
  311. }
  312. static void print_uuid(const char *label, const char *uuid)
  313. {
  314. const char *text;
  315. text = bt_uuidstr_to_str(uuid);
  316. if (text) {
  317. char str[26];
  318. unsigned int n;
  319. str[sizeof(str) - 1] = '\0';
  320. n = snprintf(str, sizeof(str), "%s", text);
  321. if (n > sizeof(str) - 1) {
  322. str[sizeof(str) - 2] = '.';
  323. str[sizeof(str) - 3] = '.';
  324. if (str[sizeof(str) - 4] == ' ')
  325. str[sizeof(str) - 4] = '.';
  326. n = sizeof(str) - 1;
  327. }
  328. bt_shell_printf("\t%s: %s%*c(%s)\n", label, str, 26 - n, ' ',
  329. uuid);
  330. } else
  331. bt_shell_printf("\t%s: %*c(%s)\n", label, 26, ' ', uuid);
  332. }
  333. static void print_uuids(GDBusProxy *proxy)
  334. {
  335. DBusMessageIter iter, value;
  336. if (g_dbus_proxy_get_property(proxy, "UUIDs", &iter) == FALSE)
  337. return;
  338. dbus_message_iter_recurse(&iter, &value);
  339. while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
  340. const char *uuid;
  341. dbus_message_iter_get_basic(&value, &uuid);
  342. print_uuid("UUID", uuid);
  343. dbus_message_iter_next(&value);
  344. }
  345. }
  346. static void print_experimental(GDBusProxy *proxy)
  347. {
  348. DBusMessageIter iter, value;
  349. if (g_dbus_proxy_get_property(proxy, "ExperimentalFeatures",
  350. &iter) == FALSE)
  351. return;
  352. dbus_message_iter_recurse(&iter, &value);
  353. while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
  354. const char *uuid;
  355. dbus_message_iter_get_basic(&value, &uuid);
  356. print_uuid("ExperimentalFeatures", uuid);
  357. dbus_message_iter_next(&value);
  358. }
  359. }
  360. static gboolean device_is_child(GDBusProxy *device, GDBusProxy *parent)
  361. {
  362. DBusMessageIter iter;
  363. const char *adapter, *path;
  364. if (!parent)
  365. return FALSE;
  366. if (g_dbus_proxy_get_property(device, "Adapter", &iter) == FALSE)
  367. return FALSE;
  368. dbus_message_iter_get_basic(&iter, &adapter);
  369. path = g_dbus_proxy_get_path(parent);
  370. if (!strcmp(path, adapter))
  371. return TRUE;
  372. return FALSE;
  373. }
  374. static gboolean service_is_child(GDBusProxy *service)
  375. {
  376. DBusMessageIter iter;
  377. const char *device;
  378. if (g_dbus_proxy_get_property(service, "Device", &iter) == FALSE)
  379. return FALSE;
  380. dbus_message_iter_get_basic(&iter, &device);
  381. if (!default_ctrl)
  382. return FALSE;
  383. return g_dbus_proxy_lookup(default_ctrl->devices, NULL, device,
  384. "org.bluez.Device1") != NULL;
  385. }
  386. static struct adapter *find_parent(GDBusProxy *device)
  387. {
  388. GList *list;
  389. for (list = g_list_first(ctrl_list); list; list = g_list_next(list)) {
  390. struct adapter *adapter = list->data;
  391. if (device_is_child(device, adapter->proxy) == TRUE)
  392. return adapter;
  393. }
  394. return NULL;
  395. }
  396. static void set_default_device(GDBusProxy *proxy, const char *attribute)
  397. {
  398. char *desc = NULL;
  399. DBusMessageIter iter;
  400. const char *path;
  401. default_dev = proxy;
  402. if (proxy == NULL) {
  403. default_attr = NULL;
  404. goto done;
  405. }
  406. if (!g_dbus_proxy_get_property(proxy, "Alias", &iter)) {
  407. if (!g_dbus_proxy_get_property(proxy, "Address", &iter))
  408. goto done;
  409. }
  410. path = g_dbus_proxy_get_path(proxy);
  411. dbus_message_iter_get_basic(&iter, &desc);
  412. desc = g_strdup_printf(COLOR_BLUE "[%s%s%s]" COLOR_OFF "# ", desc,
  413. attribute ? ":" : "",
  414. attribute ? attribute + strlen(path) : "");
  415. done:
  416. bt_shell_set_prompt(desc ? desc : PROMPT_ON);
  417. g_free(desc);
  418. }
  419. static void battery_added(GDBusProxy *proxy)
  420. {
  421. battery_proxies = g_list_append(battery_proxies, proxy);
  422. }
  423. static void battery_removed(GDBusProxy *proxy)
  424. {
  425. battery_proxies = g_list_remove(battery_proxies, proxy);
  426. }
  427. static void device_added(GDBusProxy *proxy)
  428. {
  429. DBusMessageIter iter;
  430. struct adapter *adapter = find_parent(proxy);
  431. if (!adapter) {
  432. /* TODO: Error */
  433. return;
  434. }
  435. adapter->devices = g_list_append(adapter->devices, proxy);
  436. print_device(proxy, COLORED_NEW);
  437. bt_shell_set_env(g_dbus_proxy_get_path(proxy), proxy);
  438. if (default_dev)
  439. return;
  440. if (g_dbus_proxy_get_property(proxy, "Connected", &iter)) {
  441. dbus_bool_t connected;
  442. dbus_message_iter_get_basic(&iter, &connected);
  443. if (connected)
  444. set_default_device(proxy, NULL);
  445. }
  446. }
  447. static struct adapter *find_ctrl(GList *source, const char *path);
  448. static struct adapter *adapter_new(GDBusProxy *proxy)
  449. {
  450. struct adapter *adapter = g_malloc0(sizeof(struct adapter));
  451. ctrl_list = g_list_append(ctrl_list, adapter);
  452. if (!default_ctrl)
  453. default_ctrl = adapter;
  454. return adapter;
  455. }
  456. static void adapter_added(GDBusProxy *proxy)
  457. {
  458. struct adapter *adapter;
  459. adapter = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  460. if (!adapter)
  461. adapter = adapter_new(proxy);
  462. adapter->proxy = proxy;
  463. print_adapter(proxy, COLORED_NEW);
  464. bt_shell_set_env(g_dbus_proxy_get_path(proxy), proxy);
  465. }
  466. static void ad_manager_added(GDBusProxy *proxy)
  467. {
  468. struct adapter *adapter;
  469. adapter = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  470. if (!adapter)
  471. adapter = adapter_new(proxy);
  472. adapter->ad_proxy = proxy;
  473. }
  474. static void admon_manager_added(GDBusProxy *proxy)
  475. {
  476. struct adapter *adapter;
  477. adapter = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  478. if (!adapter)
  479. adapter = adapter_new(proxy);
  480. adapter->adv_monitor_proxy = proxy;
  481. adv_monitor_add_manager(dbus_conn, proxy);
  482. adv_monitor_register_app(dbus_conn);
  483. }
  484. static void admin_policy_set_added(GDBusProxy *proxy)
  485. {
  486. admin_policy_set_set_proxy(proxy);
  487. }
  488. static void admin_policy_status_added(GDBusProxy *proxy)
  489. {
  490. struct adapter *adapter;
  491. adapter = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  492. if (!adapter) {
  493. admin_devices_proxies = g_list_append(admin_devices_proxies,
  494. proxy);
  495. return;
  496. }
  497. admin_policy_set_status_proxy(proxy);
  498. }
  499. static void proxy_added(GDBusProxy *proxy, void *user_data)
  500. {
  501. const char *interface;
  502. interface = g_dbus_proxy_get_interface(proxy);
  503. if (!strcmp(interface, "org.bluez.Device1")) {
  504. device_added(proxy);
  505. } else if (!strcmp(interface, "org.bluez.Adapter1")) {
  506. adapter_added(proxy);
  507. } else if (!strcmp(interface, "org.bluez.AgentManager1")) {
  508. if (!agent_manager) {
  509. agent_manager = proxy;
  510. if (auto_register_agent &&
  511. !bt_shell_get_env("NON_INTERACTIVE"))
  512. agent_register(dbus_conn, agent_manager,
  513. auto_register_agent);
  514. }
  515. } else if (!strcmp(interface, "org.bluez.GattService1")) {
  516. if (service_is_child(proxy))
  517. gatt_add_service(proxy);
  518. } else if (!strcmp(interface, "org.bluez.GattCharacteristic1")) {
  519. gatt_add_characteristic(proxy);
  520. } else if (!strcmp(interface, "org.bluez.GattDescriptor1")) {
  521. gatt_add_descriptor(proxy);
  522. } else if (!strcmp(interface, "org.bluez.GattManager1")) {
  523. gatt_add_manager(proxy);
  524. } else if (!strcmp(interface, "org.bluez.LEAdvertisingManager1")) {
  525. ad_manager_added(proxy);
  526. } else if (!strcmp(interface, "org.bluez.Battery1")) {
  527. battery_added(proxy);
  528. } else if (!strcmp(interface,
  529. "org.bluez.AdvertisementMonitorManager1")) {
  530. admon_manager_added(proxy);
  531. } else if (!strcmp(interface, "org.bluez.AdminPolicySet1")) {
  532. admin_policy_set_added(proxy);
  533. } else if (!strcmp(interface, "org.bluez.AdminPolicyStatus1")) {
  534. admin_policy_status_added(proxy);
  535. }
  536. }
  537. static void set_default_attribute(GDBusProxy *proxy)
  538. {
  539. const char *path;
  540. default_attr = proxy;
  541. path = g_dbus_proxy_get_path(proxy);
  542. set_default_device(default_dev, path);
  543. }
  544. static void device_removed(GDBusProxy *proxy)
  545. {
  546. struct adapter *adapter = find_parent(proxy);
  547. if (!adapter) {
  548. /* TODO: Error */
  549. return;
  550. }
  551. adapter->devices = g_list_remove(adapter->devices, proxy);
  552. print_device(proxy, COLORED_DEL);
  553. bt_shell_set_env(g_dbus_proxy_get_path(proxy), NULL);
  554. if (default_dev == proxy)
  555. set_default_device(NULL, NULL);
  556. }
  557. static void adapter_removed(GDBusProxy *proxy)
  558. {
  559. GList *ll;
  560. for (ll = g_list_first(ctrl_list); ll; ll = g_list_next(ll)) {
  561. struct adapter *adapter = ll->data;
  562. if (adapter->proxy == proxy) {
  563. print_adapter(proxy, COLORED_DEL);
  564. bt_shell_set_env(g_dbus_proxy_get_path(proxy), NULL);
  565. if (default_ctrl && default_ctrl->proxy == proxy) {
  566. default_ctrl = NULL;
  567. set_default_device(NULL, NULL);
  568. }
  569. ctrl_list = g_list_remove_link(ctrl_list, ll);
  570. g_list_free(adapter->devices);
  571. g_free(adapter);
  572. g_list_free(ll);
  573. return;
  574. }
  575. }
  576. }
  577. static void admin_policy_set_removed(GDBusProxy *proxy)
  578. {
  579. admin_policy_set_set_proxy(NULL);
  580. }
  581. static void admin_policy_status_removed(GDBusProxy *proxy)
  582. {
  583. struct adapter *adapter;
  584. adapter = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  585. if (!adapter) {
  586. admin_devices_proxies = g_list_remove(admin_devices_proxies,
  587. proxy);
  588. return;
  589. }
  590. admin_policy_set_status_proxy(NULL);
  591. }
  592. static void proxy_removed(GDBusProxy *proxy, void *user_data)
  593. {
  594. const char *interface;
  595. interface = g_dbus_proxy_get_interface(proxy);
  596. if (!strcmp(interface, "org.bluez.Device1")) {
  597. device_removed(proxy);
  598. } else if (!strcmp(interface, "org.bluez.Adapter1")) {
  599. adapter_removed(proxy);
  600. } else if (!strcmp(interface, "org.bluez.AgentManager1")) {
  601. if (agent_manager == proxy) {
  602. agent_manager = NULL;
  603. if (auto_register_agent)
  604. agent_unregister(dbus_conn, NULL);
  605. }
  606. } else if (!strcmp(interface, "org.bluez.GattService1")) {
  607. gatt_remove_service(proxy);
  608. if (default_attr == proxy)
  609. set_default_attribute(NULL);
  610. } else if (!strcmp(interface, "org.bluez.GattCharacteristic1")) {
  611. gatt_remove_characteristic(proxy);
  612. if (default_attr == proxy)
  613. set_default_attribute(NULL);
  614. } else if (!strcmp(interface, "org.bluez.GattDescriptor1")) {
  615. gatt_remove_descriptor(proxy);
  616. if (default_attr == proxy)
  617. set_default_attribute(NULL);
  618. } else if (!strcmp(interface, "org.bluez.GattManager1")) {
  619. gatt_remove_manager(proxy);
  620. } else if (!strcmp(interface, "org.bluez.LEAdvertisingManager1")) {
  621. ad_unregister(dbus_conn, NULL);
  622. } else if (!strcmp(interface, "org.bluez.Battery1")) {
  623. battery_removed(proxy);
  624. } else if (!strcmp(interface,
  625. "org.bluez.AdvertisementMonitorManager1")) {
  626. adv_monitor_remove_manager(dbus_conn);
  627. } else if (!strcmp(interface, "org.bluez.AdminPolicySet1")) {
  628. admin_policy_set_removed(proxy);
  629. } else if (!strcmp(interface, "org.bluez.AdminPolicyStatus1")) {
  630. admin_policy_status_removed(proxy);
  631. }
  632. }
  633. static struct adapter *find_ctrl(GList *source, const char *path)
  634. {
  635. GList *list;
  636. for (list = g_list_first(source); list; list = g_list_next(list)) {
  637. struct adapter *adapter = list->data;
  638. if (!strcasecmp(g_dbus_proxy_get_path(adapter->proxy), path))
  639. return adapter;
  640. }
  641. return NULL;
  642. }
  643. static void property_changed(GDBusProxy *proxy, const char *name,
  644. DBusMessageIter *iter, void *user_data)
  645. {
  646. const char *interface;
  647. struct adapter *ctrl;
  648. interface = g_dbus_proxy_get_interface(proxy);
  649. if (!strcmp(interface, "org.bluez.Device1")) {
  650. if (default_ctrl && device_is_child(proxy,
  651. default_ctrl->proxy) == TRUE) {
  652. DBusMessageIter addr_iter;
  653. char *str;
  654. if (g_dbus_proxy_get_property(proxy, "Address",
  655. &addr_iter) == TRUE) {
  656. const char *address;
  657. dbus_message_iter_get_basic(&addr_iter,
  658. &address);
  659. str = g_strdup_printf("[" COLORED_CHG
  660. "] Device %s ", address);
  661. } else
  662. str = g_strdup("");
  663. if (strcmp(name, "Connected") == 0) {
  664. dbus_bool_t connected;
  665. dbus_message_iter_get_basic(iter, &connected);
  666. if (connected && default_dev == NULL)
  667. set_default_device(proxy, NULL);
  668. else if (!connected && default_dev == proxy)
  669. set_default_device(NULL, NULL);
  670. }
  671. print_iter(str, name, iter);
  672. g_free(str);
  673. }
  674. } else if (!strcmp(interface, "org.bluez.Adapter1")) {
  675. DBusMessageIter addr_iter;
  676. char *str;
  677. if (g_dbus_proxy_get_property(proxy, "Address",
  678. &addr_iter) == TRUE) {
  679. const char *address;
  680. dbus_message_iter_get_basic(&addr_iter, &address);
  681. str = g_strdup_printf("[" COLORED_CHG
  682. "] Controller %s ", address);
  683. } else
  684. str = g_strdup("");
  685. print_iter(str, name, iter);
  686. g_free(str);
  687. } else if (!strcmp(interface, "org.bluez.LEAdvertisingManager1")) {
  688. DBusMessageIter addr_iter;
  689. char *str;
  690. ctrl = find_ctrl(ctrl_list, g_dbus_proxy_get_path(proxy));
  691. if (!ctrl)
  692. return;
  693. if (g_dbus_proxy_get_property(ctrl->proxy, "Address",
  694. &addr_iter) == TRUE) {
  695. const char *address;
  696. dbus_message_iter_get_basic(&addr_iter, &address);
  697. str = g_strdup_printf("[" COLORED_CHG
  698. "] Controller %s ",
  699. address);
  700. } else
  701. str = g_strdup("");
  702. print_iter(str, name, iter);
  703. g_free(str);
  704. } else if (proxy == default_attr) {
  705. char *str;
  706. str = g_strdup_printf("[" COLORED_CHG "] Attribute %s ",
  707. g_dbus_proxy_get_path(proxy));
  708. print_iter(str, name, iter);
  709. g_free(str);
  710. }
  711. }
  712. static void message_handler(DBusConnection *connection,
  713. DBusMessage *message, void *user_data)
  714. {
  715. bt_shell_printf("[SIGNAL] %s.%s\n", dbus_message_get_interface(message),
  716. dbus_message_get_member(message));
  717. }
  718. static struct adapter *find_ctrl_by_address(GList *source, const char *address)
  719. {
  720. GList *list;
  721. for (list = g_list_first(source); list; list = g_list_next(list)) {
  722. struct adapter *adapter = list->data;
  723. DBusMessageIter iter;
  724. const char *str;
  725. if (g_dbus_proxy_get_property(adapter->proxy,
  726. "Address", &iter) == FALSE)
  727. continue;
  728. dbus_message_iter_get_basic(&iter, &str);
  729. if (!strcasecmp(str, address))
  730. return adapter;
  731. }
  732. return NULL;
  733. }
  734. static GDBusProxy *find_proxies_by_path(GList *source, const char *path)
  735. {
  736. GList *list;
  737. for (list = g_list_first(source); list; list = g_list_next(list)) {
  738. GDBusProxy *proxy = list->data;
  739. if (strcmp(g_dbus_proxy_get_path(proxy), path) == 0)
  740. return proxy;
  741. }
  742. return NULL;
  743. }
  744. static GDBusProxy *find_proxy_by_address(GList *source, const char *address)
  745. {
  746. GList *list;
  747. for (list = g_list_first(source); list; list = g_list_next(list)) {
  748. GDBusProxy *proxy = list->data;
  749. DBusMessageIter iter;
  750. const char *str;
  751. if (g_dbus_proxy_get_property(proxy, "Address", &iter) == FALSE)
  752. continue;
  753. dbus_message_iter_get_basic(&iter, &str);
  754. if (!strcasecmp(str, address))
  755. return proxy;
  756. }
  757. return NULL;
  758. }
  759. static gboolean check_default_ctrl(void)
  760. {
  761. if (!default_ctrl) {
  762. bt_shell_printf("No default controller available\n");
  763. return FALSE;
  764. }
  765. return TRUE;
  766. }
  767. static gboolean parse_argument(int argc, char *argv[], const char **arg_table,
  768. const char *msg, dbus_bool_t *value,
  769. const char **option)
  770. {
  771. const char **opt;
  772. if (!strcmp(argv[1], "help")) {
  773. for (opt = arg_table; opt && *opt; opt++)
  774. bt_shell_printf("%s\n", *opt);
  775. bt_shell_noninteractive_quit(EXIT_SUCCESS);
  776. return FALSE;
  777. }
  778. if (!strcmp(argv[1], "on") || !strcmp(argv[1], "yes")) {
  779. *value = TRUE;
  780. if (option)
  781. *option = "";
  782. return TRUE;
  783. }
  784. if (!strcmp(argv[1], "off") || !strcmp(argv[1], "no")) {
  785. *value = FALSE;
  786. return TRUE;
  787. }
  788. for (opt = arg_table; opt && *opt; opt++) {
  789. if (strcmp(argv[1], *opt) == 0) {
  790. *value = TRUE;
  791. *option = *opt;
  792. return TRUE;
  793. }
  794. }
  795. bt_shell_printf("Invalid argument %s\n", argv[1]);
  796. return FALSE;
  797. }
  798. static void cmd_list(int argc, char *argv[])
  799. {
  800. GList *list;
  801. for (list = g_list_first(ctrl_list); list; list = g_list_next(list)) {
  802. struct adapter *adapter = list->data;
  803. print_adapter(adapter->proxy, NULL);
  804. }
  805. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  806. }
  807. static void cmd_show(int argc, char *argv[])
  808. {
  809. struct adapter *adapter;
  810. DBusMessageIter iter;
  811. const char *address;
  812. if (argc < 2 || !strlen(argv[1])) {
  813. if (check_default_ctrl() == FALSE)
  814. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  815. adapter = default_ctrl;
  816. } else {
  817. adapter = find_ctrl_by_address(ctrl_list, argv[1]);
  818. if (!adapter) {
  819. bt_shell_printf("Controller %s not available\n",
  820. argv[1]);
  821. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  822. }
  823. }
  824. if (!g_dbus_proxy_get_property(adapter->proxy, "Address", &iter))
  825. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  826. dbus_message_iter_get_basic(&iter, &address);
  827. if (g_dbus_proxy_get_property(adapter->proxy, "AddressType", &iter)) {
  828. const char *type;
  829. dbus_message_iter_get_basic(&iter, &type);
  830. bt_shell_printf("Controller %s (%s)\n", address, type);
  831. } else {
  832. bt_shell_printf("Controller %s\n", address);
  833. }
  834. print_property(adapter->proxy, "Name");
  835. print_property(adapter->proxy, "Alias");
  836. print_property(adapter->proxy, "Class");
  837. print_property(adapter->proxy, "Powered");
  838. print_property(adapter->proxy, "Discoverable");
  839. print_property(adapter->proxy, "DiscoverableTimeout");
  840. print_property(adapter->proxy, "Pairable");
  841. print_uuids(adapter->proxy);
  842. print_property(adapter->proxy, "Modalias");
  843. print_property(adapter->proxy, "Discovering");
  844. print_property(adapter->proxy, "Roles");
  845. print_experimental(adapter->proxy);
  846. if (adapter->ad_proxy) {
  847. bt_shell_printf("Advertising Features:\n");
  848. print_property(adapter->ad_proxy, "ActiveInstances");
  849. print_property(adapter->ad_proxy, "SupportedInstances");
  850. print_property(adapter->ad_proxy, "SupportedIncludes");
  851. print_property(adapter->ad_proxy, "SupportedSecondaryChannels");
  852. print_property(adapter->ad_proxy, "SupportedCapabilities");
  853. print_property(adapter->ad_proxy, "SupportedFeatures");
  854. }
  855. if (adapter->adv_monitor_proxy) {
  856. bt_shell_printf("Advertisement Monitor Features:\n");
  857. print_property(adapter->adv_monitor_proxy,
  858. "SupportedMonitorTypes");
  859. print_property(adapter->adv_monitor_proxy, "SupportedFeatures");
  860. }
  861. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  862. }
  863. static void cmd_select(int argc, char *argv[])
  864. {
  865. struct adapter *adapter;
  866. adapter = find_ctrl_by_address(ctrl_list, argv[1]);
  867. if (!adapter) {
  868. bt_shell_printf("Controller %s not available\n", argv[1]);
  869. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  870. }
  871. if (default_ctrl && default_ctrl->proxy == adapter->proxy)
  872. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  873. default_ctrl = adapter;
  874. print_adapter(adapter->proxy, NULL);
  875. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  876. }
  877. static void cmd_devices(int argc, char *argv[])
  878. {
  879. GList *ll;
  880. if (check_default_ctrl() == FALSE)
  881. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  882. for (ll = g_list_first(default_ctrl->devices);
  883. ll; ll = g_list_next(ll)) {
  884. GDBusProxy *proxy = ll->data;
  885. print_device(proxy, NULL);
  886. }
  887. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  888. }
  889. static void cmd_paired_devices(int argc, char *argv[])
  890. {
  891. GList *ll;
  892. if (check_default_ctrl() == FALSE)
  893. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  894. for (ll = g_list_first(default_ctrl->devices);
  895. ll; ll = g_list_next(ll)) {
  896. GDBusProxy *proxy = ll->data;
  897. DBusMessageIter iter;
  898. dbus_bool_t paired;
  899. if (g_dbus_proxy_get_property(proxy, "Paired", &iter) == FALSE)
  900. continue;
  901. dbus_message_iter_get_basic(&iter, &paired);
  902. if (!paired)
  903. continue;
  904. print_device(proxy, NULL);
  905. }
  906. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  907. }
  908. static void generic_callback(const DBusError *error, void *user_data)
  909. {
  910. char *str = user_data;
  911. if (dbus_error_is_set(error)) {
  912. bt_shell_printf("Failed to set %s: %s\n", str, error->name);
  913. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  914. } else {
  915. bt_shell_printf("Changing %s succeeded\n", str);
  916. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  917. }
  918. }
  919. static void cmd_system_alias(int argc, char *argv[])
  920. {
  921. char *name;
  922. if (check_default_ctrl() == FALSE)
  923. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  924. name = g_strdup(argv[1]);
  925. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy, "Alias",
  926. DBUS_TYPE_STRING, &name,
  927. generic_callback, name, g_free) == TRUE)
  928. return;
  929. g_free(name);
  930. }
  931. static void cmd_reset_alias(int argc, char *argv[])
  932. {
  933. char *name;
  934. if (check_default_ctrl() == FALSE)
  935. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  936. name = g_strdup("");
  937. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy, "Alias",
  938. DBUS_TYPE_STRING, &name,
  939. generic_callback, name, g_free) == TRUE)
  940. return;
  941. g_free(name);
  942. }
  943. static void cmd_power(int argc, char *argv[])
  944. {
  945. dbus_bool_t powered;
  946. char *str;
  947. if (!parse_argument(argc, argv, NULL, NULL, &powered, NULL))
  948. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  949. if (check_default_ctrl() == FALSE)
  950. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  951. str = g_strdup_printf("power %s", powered == TRUE ? "on" : "off");
  952. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy, "Powered",
  953. DBUS_TYPE_BOOLEAN, &powered,
  954. generic_callback, str, g_free) == TRUE)
  955. return;
  956. g_free(str);
  957. }
  958. static void cmd_pairable(int argc, char *argv[])
  959. {
  960. dbus_bool_t pairable;
  961. char *str;
  962. if (!parse_argument(argc, argv, NULL, NULL, &pairable, NULL))
  963. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  964. if (check_default_ctrl() == FALSE)
  965. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  966. str = g_strdup_printf("pairable %s", pairable == TRUE ? "on" : "off");
  967. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy, "Pairable",
  968. DBUS_TYPE_BOOLEAN, &pairable,
  969. generic_callback, str, g_free) == TRUE)
  970. return;
  971. g_free(str);
  972. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  973. }
  974. static void cmd_discoverable(int argc, char *argv[])
  975. {
  976. dbus_bool_t discoverable;
  977. char *str;
  978. if (!parse_argument(argc, argv, NULL, NULL, &discoverable, NULL))
  979. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  980. if (check_default_ctrl() == FALSE)
  981. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  982. str = g_strdup_printf("discoverable %s",
  983. discoverable == TRUE ? "on" : "off");
  984. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy, "Discoverable",
  985. DBUS_TYPE_BOOLEAN, &discoverable,
  986. generic_callback, str, g_free) == TRUE)
  987. return;
  988. g_free(str);
  989. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  990. }
  991. static void cmd_discoverable_timeout(int argc, char *argv[])
  992. {
  993. uint32_t value;
  994. char *endptr = NULL;
  995. char *str;
  996. if (argc < 2) {
  997. DBusMessageIter iter;
  998. if (!g_dbus_proxy_get_property(default_ctrl->proxy,
  999. "DiscoverableTimeout", &iter)) {
  1000. bt_shell_printf("Unable to get DiscoverableTimeout\n");
  1001. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1002. }
  1003. dbus_message_iter_get_basic(&iter, &value);
  1004. bt_shell_printf("DiscoverableTimeout: %d seconds\n", value);
  1005. return;
  1006. }
  1007. value = strtol(argv[1], &endptr, 0);
  1008. if (!endptr || *endptr != '\0' || value > UINT32_MAX) {
  1009. bt_shell_printf("Invalid argument\n");
  1010. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1011. }
  1012. str = g_strdup_printf("discoverable-timeout %d", value);
  1013. if (g_dbus_proxy_set_property_basic(default_ctrl->proxy,
  1014. "DiscoverableTimeout",
  1015. DBUS_TYPE_UINT32, &value,
  1016. generic_callback, str, g_free))
  1017. return;
  1018. g_free(str);
  1019. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1020. }
  1021. static void cmd_agent(int argc, char *argv[])
  1022. {
  1023. dbus_bool_t enable;
  1024. const char *capability;
  1025. if (!parse_argument(argc, argv, agent_arguments, "capability",
  1026. &enable, &capability))
  1027. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1028. if (enable == TRUE) {
  1029. g_free(auto_register_agent);
  1030. auto_register_agent = g_strdup(capability);
  1031. if (agent_manager)
  1032. agent_register(dbus_conn, agent_manager,
  1033. auto_register_agent);
  1034. else
  1035. bt_shell_printf("Agent registration enabled\n");
  1036. } else {
  1037. g_free(auto_register_agent);
  1038. auto_register_agent = NULL;
  1039. if (agent_manager)
  1040. agent_unregister(dbus_conn, agent_manager);
  1041. else
  1042. bt_shell_printf("Agent registration disabled\n");
  1043. }
  1044. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1045. }
  1046. static void cmd_default_agent(int argc, char *argv[])
  1047. {
  1048. agent_default(dbus_conn, agent_manager);
  1049. }
  1050. #define DISTANCE_VAL_INVALID 0x7FFF
  1051. static struct set_discovery_filter_args {
  1052. char *transport;
  1053. char *pattern;
  1054. dbus_uint16_t rssi;
  1055. dbus_int16_t pathloss;
  1056. char **uuids;
  1057. size_t uuids_len;
  1058. dbus_bool_t duplicate;
  1059. dbus_bool_t discoverable;
  1060. bool set;
  1061. bool active;
  1062. } filter = {
  1063. .rssi = DISTANCE_VAL_INVALID,
  1064. .pathloss = DISTANCE_VAL_INVALID,
  1065. .set = true,
  1066. };
  1067. static void start_discovery_reply(DBusMessage *message, void *user_data)
  1068. {
  1069. dbus_bool_t enable = GPOINTER_TO_UINT(user_data);
  1070. DBusError error;
  1071. dbus_error_init(&error);
  1072. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1073. bt_shell_printf("Failed to %s discovery: %s\n",
  1074. enable == TRUE ? "start" : "stop", error.name);
  1075. dbus_error_free(&error);
  1076. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1077. }
  1078. bt_shell_printf("Discovery %s\n", enable ? "started" : "stopped");
  1079. filter.active = enable;
  1080. /* Leave the discovery running even on noninteractive mode */
  1081. }
  1082. static void clear_discovery_filter(DBusMessageIter *iter, void *user_data)
  1083. {
  1084. DBusMessageIter dict;
  1085. dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
  1086. DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
  1087. DBUS_TYPE_STRING_AS_STRING
  1088. DBUS_TYPE_VARIANT_AS_STRING
  1089. DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
  1090. dbus_message_iter_close_container(iter, &dict);
  1091. }
  1092. static void set_discovery_filter_setup(DBusMessageIter *iter, void *user_data)
  1093. {
  1094. struct set_discovery_filter_args *args = user_data;
  1095. DBusMessageIter dict;
  1096. dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
  1097. DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
  1098. DBUS_TYPE_STRING_AS_STRING
  1099. DBUS_TYPE_VARIANT_AS_STRING
  1100. DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
  1101. g_dbus_dict_append_array(&dict, "UUIDs", DBUS_TYPE_STRING,
  1102. &args->uuids,
  1103. args->uuids_len);
  1104. if (args->pathloss != DISTANCE_VAL_INVALID)
  1105. g_dbus_dict_append_entry(&dict, "Pathloss", DBUS_TYPE_UINT16,
  1106. &args->pathloss);
  1107. if (args->rssi != DISTANCE_VAL_INVALID)
  1108. g_dbus_dict_append_entry(&dict, "RSSI", DBUS_TYPE_INT16,
  1109. &args->rssi);
  1110. if (args->transport != NULL)
  1111. g_dbus_dict_append_entry(&dict, "Transport", DBUS_TYPE_STRING,
  1112. &args->transport);
  1113. if (args->duplicate)
  1114. g_dbus_dict_append_entry(&dict, "DuplicateData",
  1115. DBUS_TYPE_BOOLEAN,
  1116. &args->duplicate);
  1117. if (args->discoverable)
  1118. g_dbus_dict_append_entry(&dict, "Discoverable",
  1119. DBUS_TYPE_BOOLEAN,
  1120. &args->discoverable);
  1121. if (args->pattern != NULL)
  1122. g_dbus_dict_append_entry(&dict, "Pattern", DBUS_TYPE_STRING,
  1123. &args->pattern);
  1124. dbus_message_iter_close_container(iter, &dict);
  1125. }
  1126. static void set_discovery_filter_reply(DBusMessage *message, void *user_data)
  1127. {
  1128. DBusError error;
  1129. dbus_error_init(&error);
  1130. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1131. bt_shell_printf("SetDiscoveryFilter failed: %s\n", error.name);
  1132. dbus_error_free(&error);
  1133. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1134. }
  1135. filter.set = true;
  1136. bt_shell_printf("SetDiscoveryFilter success\n");
  1137. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1138. }
  1139. static void set_discovery_filter(bool cleared)
  1140. {
  1141. GDBusSetupFunction func;
  1142. if (check_default_ctrl() == FALSE || filter.set)
  1143. return;
  1144. func = cleared ? clear_discovery_filter : set_discovery_filter_setup;
  1145. if (g_dbus_proxy_method_call(default_ctrl->proxy, "SetDiscoveryFilter",
  1146. func, set_discovery_filter_reply,
  1147. &filter, NULL) == FALSE) {
  1148. bt_shell_printf("Failed to set discovery filter\n");
  1149. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1150. }
  1151. filter.set = true;
  1152. }
  1153. static void cmd_scan(int argc, char *argv[])
  1154. {
  1155. dbus_bool_t enable;
  1156. const char *method;
  1157. if (!parse_argument(argc, argv, NULL, NULL, &enable, NULL))
  1158. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1159. if (check_default_ctrl() == FALSE)
  1160. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1161. if (enable == TRUE) {
  1162. set_discovery_filter(false);
  1163. method = "StartDiscovery";
  1164. } else
  1165. method = "StopDiscovery";
  1166. if (g_dbus_proxy_method_call(default_ctrl->proxy, method,
  1167. NULL, start_discovery_reply,
  1168. GUINT_TO_POINTER(enable), NULL) == FALSE) {
  1169. bt_shell_printf("Failed to %s discovery\n",
  1170. enable == TRUE ? "start" : "stop");
  1171. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1172. }
  1173. }
  1174. static void cmd_scan_filter_uuids(int argc, char *argv[])
  1175. {
  1176. if (argc < 2 || !strlen(argv[1])) {
  1177. char **uuid;
  1178. for (uuid = filter.uuids; uuid && *uuid; uuid++)
  1179. print_uuid("UUID", *uuid);
  1180. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1181. }
  1182. g_strfreev(filter.uuids);
  1183. filter.uuids = NULL;
  1184. filter.uuids_len = 0;
  1185. if (!strcmp(argv[1], "all"))
  1186. goto commit;
  1187. filter.uuids = g_strdupv(&argv[1]);
  1188. if (!filter.uuids) {
  1189. bt_shell_printf("Failed to parse input\n");
  1190. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1191. }
  1192. filter.uuids_len = g_strv_length(filter.uuids);
  1193. commit:
  1194. filter.set = false;
  1195. if (filter.active)
  1196. set_discovery_filter(false);
  1197. }
  1198. static void cmd_scan_filter_rssi(int argc, char *argv[])
  1199. {
  1200. if (argc < 2 || !strlen(argv[1])) {
  1201. if (filter.rssi != DISTANCE_VAL_INVALID)
  1202. bt_shell_printf("RSSI: %d\n", filter.rssi);
  1203. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1204. }
  1205. filter.pathloss = DISTANCE_VAL_INVALID;
  1206. filter.rssi = atoi(argv[1]);
  1207. filter.set = false;
  1208. if (filter.active)
  1209. set_discovery_filter(false);
  1210. }
  1211. static void cmd_scan_filter_pathloss(int argc, char *argv[])
  1212. {
  1213. if (argc < 2 || !strlen(argv[1])) {
  1214. if (filter.pathloss != DISTANCE_VAL_INVALID)
  1215. bt_shell_printf("Pathloss: %d\n",
  1216. filter.pathloss);
  1217. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1218. }
  1219. filter.rssi = DISTANCE_VAL_INVALID;
  1220. filter.pathloss = atoi(argv[1]);
  1221. filter.set = false;
  1222. if (filter.active)
  1223. set_discovery_filter(false);
  1224. }
  1225. static void cmd_scan_filter_transport(int argc, char *argv[])
  1226. {
  1227. if (argc < 2 || !strlen(argv[1])) {
  1228. if (filter.transport)
  1229. bt_shell_printf("Transport: %s\n",
  1230. filter.transport);
  1231. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1232. }
  1233. g_free(filter.transport);
  1234. filter.transport = g_strdup(argv[1]);
  1235. filter.set = false;
  1236. if (filter.active)
  1237. set_discovery_filter(false);
  1238. }
  1239. static void cmd_scan_filter_duplicate_data(int argc, char *argv[])
  1240. {
  1241. if (argc < 2 || !strlen(argv[1])) {
  1242. bt_shell_printf("DuplicateData: %s\n",
  1243. filter.duplicate ? "on" : "off");
  1244. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1245. }
  1246. if (!strcmp(argv[1], "on"))
  1247. filter.duplicate = true;
  1248. else if (!strcmp(argv[1], "off"))
  1249. filter.duplicate = false;
  1250. else {
  1251. bt_shell_printf("Invalid option: %s\n", argv[1]);
  1252. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1253. }
  1254. filter.set = false;
  1255. if (filter.active)
  1256. set_discovery_filter(false);
  1257. }
  1258. static void cmd_scan_filter_discoverable(int argc, char *argv[])
  1259. {
  1260. if (argc < 2 || !strlen(argv[1])) {
  1261. bt_shell_printf("Discoverable: %s\n",
  1262. filter.discoverable ? "on" : "off");
  1263. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1264. }
  1265. if (!strcmp(argv[1], "on"))
  1266. filter.discoverable = true;
  1267. else if (!strcmp(argv[1], "off"))
  1268. filter.discoverable = false;
  1269. else {
  1270. bt_shell_printf("Invalid option: %s\n", argv[1]);
  1271. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1272. }
  1273. filter.set = false;
  1274. if (filter.active)
  1275. set_discovery_filter(false);
  1276. }
  1277. static void cmd_scan_filter_pattern(int argc, char *argv[])
  1278. {
  1279. if (argc < 2 || !strlen(argv[1])) {
  1280. bt_shell_printf("Pattern: %s\n", filter.pattern);
  1281. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1282. }
  1283. free(filter.pattern);
  1284. filter.pattern = strdup(argv[1]);
  1285. filter.set = false;
  1286. if (filter.active)
  1287. set_discovery_filter(false);
  1288. }
  1289. static void filter_clear_uuids(void)
  1290. {
  1291. g_strfreev(filter.uuids);
  1292. filter.uuids = NULL;
  1293. filter.uuids_len = 0;
  1294. }
  1295. static void filter_clear_rssi(void)
  1296. {
  1297. filter.rssi = DISTANCE_VAL_INVALID;
  1298. }
  1299. static void filter_clear_pathloss(void)
  1300. {
  1301. filter.pathloss = DISTANCE_VAL_INVALID;
  1302. }
  1303. static void filter_clear_transport(void)
  1304. {
  1305. g_free(filter.transport);
  1306. filter.transport = NULL;
  1307. }
  1308. static void filter_clear_duplicate(void)
  1309. {
  1310. filter.duplicate = false;
  1311. }
  1312. static void filter_clear_discoverable(void)
  1313. {
  1314. filter.discoverable = false;
  1315. }
  1316. static void filter_clear_pattern(void)
  1317. {
  1318. free(filter.pattern);
  1319. filter.pattern = NULL;
  1320. }
  1321. struct clear_entry {
  1322. const char *name;
  1323. void (*clear) (void);
  1324. };
  1325. static const struct clear_entry filter_clear[] = {
  1326. { "uuids", filter_clear_uuids },
  1327. { "rssi", filter_clear_rssi },
  1328. { "pathloss", filter_clear_pathloss },
  1329. { "transport", filter_clear_transport },
  1330. { "duplicate-data", filter_clear_duplicate },
  1331. { "discoverable", filter_clear_discoverable },
  1332. { "pattern", filter_clear_pattern },
  1333. {}
  1334. };
  1335. static char *filter_clear_generator(const char *text, int state)
  1336. {
  1337. static int index, len;
  1338. const char *arg;
  1339. if (!state) {
  1340. index = 0;
  1341. len = strlen(text);
  1342. }
  1343. while ((arg = filter_clear[index].name)) {
  1344. index++;
  1345. if (!strncmp(arg, text, len))
  1346. return strdup(arg);
  1347. }
  1348. return NULL;
  1349. }
  1350. static gboolean data_clear(const struct clear_entry *entry_table,
  1351. const char *name)
  1352. {
  1353. const struct clear_entry *entry;
  1354. bool all = false;
  1355. if (!name || !strlen(name) || !strcmp("all", name))
  1356. all = true;
  1357. for (entry = entry_table; entry && entry->name; entry++) {
  1358. if (all || !strcmp(entry->name, name)) {
  1359. entry->clear();
  1360. if (!all)
  1361. goto done;
  1362. }
  1363. }
  1364. if (!all) {
  1365. bt_shell_printf("Invalid argument %s\n", name);
  1366. return FALSE;
  1367. }
  1368. done:
  1369. return TRUE;
  1370. }
  1371. static void cmd_scan_filter_clear(int argc, char *argv[])
  1372. {
  1373. bool all = false;
  1374. if (argc < 2 || !strlen(argv[1]))
  1375. all = true;
  1376. if (!data_clear(filter_clear, all ? "all" : argv[1]))
  1377. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1378. filter.set = false;
  1379. if (check_default_ctrl() == FALSE)
  1380. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1381. set_discovery_filter(all);
  1382. }
  1383. static struct GDBusProxy *find_device(int argc, char *argv[])
  1384. {
  1385. GDBusProxy *proxy;
  1386. if (argc < 2 || !strlen(argv[1])) {
  1387. if (default_dev)
  1388. return default_dev;
  1389. bt_shell_printf("Missing device address argument\n");
  1390. return NULL;
  1391. }
  1392. if (check_default_ctrl() == FALSE)
  1393. return NULL;
  1394. proxy = find_proxy_by_address(default_ctrl->devices, argv[1]);
  1395. if (!proxy) {
  1396. bt_shell_printf("Device %s not available\n", argv[1]);
  1397. return NULL;
  1398. }
  1399. return proxy;
  1400. }
  1401. static void cmd_info(int argc, char *argv[])
  1402. {
  1403. GDBusProxy *proxy;
  1404. GDBusProxy *admin_proxy;
  1405. GDBusProxy *battery_proxy;
  1406. DBusMessageIter iter;
  1407. const char *address;
  1408. proxy = find_device(argc, argv);
  1409. if (!proxy)
  1410. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1411. if (g_dbus_proxy_get_property(proxy, "Address", &iter) == FALSE)
  1412. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1413. dbus_message_iter_get_basic(&iter, &address);
  1414. if (g_dbus_proxy_get_property(proxy, "AddressType", &iter) == TRUE) {
  1415. const char *type;
  1416. dbus_message_iter_get_basic(&iter, &type);
  1417. bt_shell_printf("Device %s (%s)\n", address, type);
  1418. } else {
  1419. bt_shell_printf("Device %s\n", address);
  1420. }
  1421. print_property(proxy, "Name");
  1422. print_property(proxy, "Alias");
  1423. print_property(proxy, "Class");
  1424. print_property(proxy, "Appearance");
  1425. print_property(proxy, "Icon");
  1426. print_property(proxy, "Paired");
  1427. print_property(proxy, "Trusted");
  1428. print_property(proxy, "Blocked");
  1429. print_property(proxy, "Connected");
  1430. print_property(proxy, "WakeAllowed");
  1431. print_property(proxy, "LegacyPairing");
  1432. print_uuids(proxy);
  1433. print_property(proxy, "Modalias");
  1434. print_property(proxy, "ManufacturerData");
  1435. print_property(proxy, "ServiceData");
  1436. print_property(proxy, "RSSI");
  1437. print_property(proxy, "TxPower");
  1438. print_property(proxy, "AdvertisingFlags");
  1439. print_property(proxy, "AdvertisingData");
  1440. battery_proxy = find_proxies_by_path(battery_proxies,
  1441. g_dbus_proxy_get_path(proxy));
  1442. admin_proxy = find_proxies_by_path(admin_devices_proxies,
  1443. g_dbus_proxy_get_path(proxy));
  1444. print_property_with_label(battery_proxy, "Percentage",
  1445. "Battery Percentage");
  1446. print_property_with_label(admin_proxy, "AffectedByPolicy",
  1447. "Affected by Policy");
  1448. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1449. }
  1450. static void pair_reply(DBusMessage *message, void *user_data)
  1451. {
  1452. DBusError error;
  1453. dbus_error_init(&error);
  1454. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1455. bt_shell_printf("Failed to pair: %s\n", error.name);
  1456. dbus_error_free(&error);
  1457. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1458. }
  1459. bt_shell_printf("Pairing successful\n");
  1460. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1461. }
  1462. static const char *proxy_address(GDBusProxy *proxy)
  1463. {
  1464. DBusMessageIter iter;
  1465. const char *addr;
  1466. if (!g_dbus_proxy_get_property(proxy, "Address", &iter))
  1467. return NULL;
  1468. dbus_message_iter_get_basic(&iter, &addr);
  1469. return addr;
  1470. }
  1471. static void cmd_pair(int argc, char *argv[])
  1472. {
  1473. GDBusProxy *proxy;
  1474. proxy = find_device(argc, argv);
  1475. if (!proxy)
  1476. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1477. if (g_dbus_proxy_method_call(proxy, "Pair", NULL, pair_reply,
  1478. NULL, NULL) == FALSE) {
  1479. bt_shell_printf("Failed to pair\n");
  1480. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1481. }
  1482. bt_shell_printf("Attempting to pair with %s\n", proxy_address(proxy));
  1483. }
  1484. static void cancel_pairing_reply(DBusMessage *message, void *user_data)
  1485. {
  1486. DBusError error;
  1487. dbus_error_init(&error);
  1488. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1489. bt_shell_printf("Failed to cancel pairing: %s\n", error.name);
  1490. dbus_error_free(&error);
  1491. return;
  1492. }
  1493. bt_shell_printf("Cancel pairing successful\n");
  1494. }
  1495. static void cmd_cancel_pairing(int argc, char *argv[])
  1496. {
  1497. GDBusProxy *proxy;
  1498. proxy = find_device(argc, argv);
  1499. if (!proxy)
  1500. return;
  1501. if (g_dbus_proxy_method_call(proxy, "CancelPairing", NULL,
  1502. cancel_pairing_reply, NULL, NULL) == FALSE) {
  1503. bt_shell_printf("Failed to cancel pairing\n");
  1504. return;
  1505. }
  1506. bt_shell_printf("Attempting to cancel pairing with %s\n",
  1507. proxy_address(proxy));
  1508. }
  1509. static void cmd_trust(int argc, char *argv[])
  1510. {
  1511. GDBusProxy *proxy;
  1512. dbus_bool_t trusted;
  1513. char *str;
  1514. proxy = find_device(argc, argv);
  1515. if (!proxy)
  1516. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1517. trusted = TRUE;
  1518. str = g_strdup_printf("%s trust", proxy_address(proxy));
  1519. if (g_dbus_proxy_set_property_basic(proxy, "Trusted",
  1520. DBUS_TYPE_BOOLEAN, &trusted,
  1521. generic_callback, str, g_free) == TRUE)
  1522. return;
  1523. g_free(str);
  1524. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1525. }
  1526. static void cmd_untrust(int argc, char *argv[])
  1527. {
  1528. GDBusProxy *proxy;
  1529. dbus_bool_t trusted;
  1530. char *str;
  1531. proxy = find_device(argc, argv);
  1532. if (!proxy)
  1533. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1534. trusted = FALSE;
  1535. str = g_strdup_printf("%s untrust", proxy_address(proxy));
  1536. if (g_dbus_proxy_set_property_basic(proxy, "Trusted",
  1537. DBUS_TYPE_BOOLEAN, &trusted,
  1538. generic_callback, str, g_free) == TRUE)
  1539. return;
  1540. g_free(str);
  1541. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1542. }
  1543. static void cmd_block(int argc, char *argv[])
  1544. {
  1545. GDBusProxy *proxy;
  1546. dbus_bool_t blocked;
  1547. char *str;
  1548. proxy = find_device(argc, argv);
  1549. if (!proxy)
  1550. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1551. blocked = TRUE;
  1552. str = g_strdup_printf("%s block", proxy_address(proxy));
  1553. if (g_dbus_proxy_set_property_basic(proxy, "Blocked",
  1554. DBUS_TYPE_BOOLEAN, &blocked,
  1555. generic_callback, str, g_free) == TRUE)
  1556. return;
  1557. g_free(str);
  1558. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1559. }
  1560. static void cmd_unblock(int argc, char *argv[])
  1561. {
  1562. GDBusProxy *proxy;
  1563. dbus_bool_t blocked;
  1564. char *str;
  1565. proxy = find_device(argc, argv);
  1566. if (!proxy)
  1567. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1568. blocked = FALSE;
  1569. str = g_strdup_printf("%s unblock", proxy_address(proxy));
  1570. if (g_dbus_proxy_set_property_basic(proxy, "Blocked",
  1571. DBUS_TYPE_BOOLEAN, &blocked,
  1572. generic_callback, str, g_free) == TRUE)
  1573. return;
  1574. g_free(str);
  1575. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1576. }
  1577. static void remove_device_reply(DBusMessage *message, void *user_data)
  1578. {
  1579. DBusError error;
  1580. dbus_error_init(&error);
  1581. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1582. bt_shell_printf("Failed to remove device: %s\n", error.name);
  1583. dbus_error_free(&error);
  1584. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1585. }
  1586. bt_shell_printf("Device has been removed\n");
  1587. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1588. }
  1589. static void remove_device_setup(DBusMessageIter *iter, void *user_data)
  1590. {
  1591. const char *path = user_data;
  1592. dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
  1593. }
  1594. static void remove_device(GDBusProxy *proxy)
  1595. {
  1596. char *path;
  1597. if (!default_ctrl)
  1598. return;
  1599. path = g_strdup(g_dbus_proxy_get_path(proxy));
  1600. if (g_dbus_proxy_method_call(default_ctrl->proxy, "RemoveDevice",
  1601. remove_device_setup,
  1602. remove_device_reply,
  1603. path, g_free) == FALSE) {
  1604. bt_shell_printf("Failed to remove device\n");
  1605. g_free(path);
  1606. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1607. }
  1608. }
  1609. static void cmd_remove(int argc, char *argv[])
  1610. {
  1611. GDBusProxy *proxy;
  1612. if (check_default_ctrl() == FALSE)
  1613. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1614. if (strcmp(argv[1], "*") == 0) {
  1615. GList *list;
  1616. for (list = default_ctrl->devices; list;
  1617. list = g_list_next(list)) {
  1618. GDBusProxy *proxy = list->data;
  1619. remove_device(proxy);
  1620. }
  1621. return;
  1622. }
  1623. proxy = find_proxy_by_address(default_ctrl->devices, argv[1]);
  1624. if (!proxy) {
  1625. bt_shell_printf("Device %s not available\n", argv[1]);
  1626. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1627. }
  1628. remove_device(proxy);
  1629. }
  1630. static void connect_reply(DBusMessage *message, void *user_data)
  1631. {
  1632. GDBusProxy *proxy = user_data;
  1633. DBusError error;
  1634. dbus_error_init(&error);
  1635. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1636. bt_shell_printf("Failed to connect: %s %s\n", error.name,
  1637. error.message);
  1638. dbus_error_free(&error);
  1639. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1640. }
  1641. bt_shell_printf("Connection successful\n");
  1642. set_default_device(proxy, NULL);
  1643. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1644. }
  1645. static void cmd_connect(int argc, char *argv[])
  1646. {
  1647. GDBusProxy *proxy;
  1648. if (check_default_ctrl() == FALSE)
  1649. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1650. proxy = find_proxy_by_address(default_ctrl->devices, argv[1]);
  1651. if (!proxy) {
  1652. bt_shell_printf("Device %s not available\n", argv[1]);
  1653. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1654. }
  1655. if (g_dbus_proxy_method_call(proxy, "Connect", NULL, connect_reply,
  1656. proxy, NULL) == FALSE) {
  1657. bt_shell_printf("Failed to connect\n");
  1658. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1659. }
  1660. bt_shell_printf("Attempting to connect to %s\n", argv[1]);
  1661. }
  1662. static void disconn_reply(DBusMessage *message, void *user_data)
  1663. {
  1664. GDBusProxy *proxy = user_data;
  1665. DBusError error;
  1666. dbus_error_init(&error);
  1667. if (dbus_set_error_from_message(&error, message) == TRUE) {
  1668. bt_shell_printf("Failed to disconnect: %s\n", error.name);
  1669. dbus_error_free(&error);
  1670. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1671. }
  1672. bt_shell_printf("Successful disconnected\n");
  1673. if (proxy == default_dev)
  1674. set_default_device(NULL, NULL);
  1675. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1676. }
  1677. static void cmd_disconn(int argc, char *argv[])
  1678. {
  1679. GDBusProxy *proxy;
  1680. proxy = find_device(argc, argv);
  1681. if (!proxy)
  1682. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1683. if (g_dbus_proxy_method_call(proxy, "Disconnect", NULL, disconn_reply,
  1684. proxy, NULL) == FALSE) {
  1685. bt_shell_printf("Failed to disconnect\n");
  1686. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1687. }
  1688. bt_shell_printf("Attempting to disconnect from %s\n",
  1689. proxy_address(proxy));
  1690. }
  1691. static void cmd_list_attributes(int argc, char *argv[])
  1692. {
  1693. GDBusProxy *proxy;
  1694. const char *path;
  1695. if (argc > 1 && !strcmp(argv[1], "local")) {
  1696. path = argv[1];
  1697. goto done;
  1698. }
  1699. proxy = find_device(argc, argv);
  1700. if (!proxy)
  1701. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1702. path = g_dbus_proxy_get_path(proxy);
  1703. done:
  1704. gatt_list_attributes(path);
  1705. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1706. }
  1707. static void cmd_set_alias(int argc, char *argv[])
  1708. {
  1709. char *name;
  1710. if (!default_dev) {
  1711. bt_shell_printf("No device connected\n");
  1712. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1713. }
  1714. name = g_strdup(argv[1]);
  1715. if (g_dbus_proxy_set_property_basic(default_dev, "Alias",
  1716. DBUS_TYPE_STRING, &name,
  1717. generic_callback, name, g_free) == TRUE)
  1718. return;
  1719. g_free(name);
  1720. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1721. }
  1722. static void cmd_select_attribute(int argc, char *argv[])
  1723. {
  1724. GDBusProxy *proxy;
  1725. if (!default_dev) {
  1726. bt_shell_printf("No device connected\n");
  1727. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1728. }
  1729. proxy = gatt_select_attribute(default_attr, argv[1]);
  1730. if (proxy) {
  1731. set_default_attribute(proxy);
  1732. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1733. }
  1734. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1735. }
  1736. static struct GDBusProxy *find_attribute(int argc, char *argv[])
  1737. {
  1738. GDBusProxy *proxy;
  1739. if (argc < 2 || !strlen(argv[1])) {
  1740. if (default_attr)
  1741. return default_attr;
  1742. bt_shell_printf("Missing attribute argument\n");
  1743. return NULL;
  1744. }
  1745. proxy = gatt_select_attribute(default_attr, argv[1]);
  1746. if (!proxy) {
  1747. bt_shell_printf("Attribute %s not available\n", argv[1]);
  1748. return NULL;
  1749. }
  1750. return proxy;
  1751. }
  1752. static void cmd_attribute_info(int argc, char *argv[])
  1753. {
  1754. GDBusProxy *proxy;
  1755. DBusMessageIter iter;
  1756. const char *iface, *uuid, *text;
  1757. proxy = find_attribute(argc, argv);
  1758. if (!proxy)
  1759. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1760. if (g_dbus_proxy_get_property(proxy, "UUID", &iter) == FALSE)
  1761. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1762. dbus_message_iter_get_basic(&iter, &uuid);
  1763. text = bt_uuidstr_to_str(uuid);
  1764. if (!text)
  1765. text = g_dbus_proxy_get_path(proxy);
  1766. iface = g_dbus_proxy_get_interface(proxy);
  1767. if (!strcmp(iface, "org.bluez.GattService1")) {
  1768. bt_shell_printf("Service - %s\n", text);
  1769. print_property(proxy, "UUID");
  1770. print_property(proxy, "Primary");
  1771. print_property(proxy, "Characteristics");
  1772. print_property(proxy, "Includes");
  1773. } else if (!strcmp(iface, "org.bluez.GattCharacteristic1")) {
  1774. bt_shell_printf("Characteristic - %s\n", text);
  1775. print_property(proxy, "UUID");
  1776. print_property(proxy, "Service");
  1777. print_property(proxy, "Value");
  1778. print_property(proxy, "Notifying");
  1779. print_property(proxy, "Flags");
  1780. print_property(proxy, "MTU");
  1781. print_property(proxy, "Descriptors");
  1782. } else if (!strcmp(iface, "org.bluez.GattDescriptor1")) {
  1783. bt_shell_printf("Descriptor - %s\n", text);
  1784. print_property(proxy, "UUID");
  1785. print_property(proxy, "Characteristic");
  1786. print_property(proxy, "Value");
  1787. }
  1788. return bt_shell_noninteractive_quit(EXIT_SUCCESS);
  1789. }
  1790. static void cmd_read(int argc, char *argv[])
  1791. {
  1792. if (!default_attr) {
  1793. bt_shell_printf("No attribute selected\n");
  1794. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1795. }
  1796. gatt_read_attribute(default_attr, argc, argv);
  1797. }
  1798. static void cmd_write(int argc, char *argv[])
  1799. {
  1800. if (!default_attr) {
  1801. bt_shell_printf("No attribute selected\n");
  1802. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1803. }
  1804. gatt_write_attribute(default_attr, argc, argv);
  1805. }
  1806. static void cmd_acquire_write(int argc, char *argv[])
  1807. {
  1808. if (!default_attr) {
  1809. bt_shell_printf("No attribute selected\n");
  1810. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1811. }
  1812. gatt_acquire_write(default_attr, argv[1]);
  1813. }
  1814. static void cmd_release_write(int argc, char *argv[])
  1815. {
  1816. if (!default_attr) {
  1817. bt_shell_printf("No attribute selected\n");
  1818. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1819. }
  1820. gatt_release_write(default_attr, argv[1]);
  1821. }
  1822. static void cmd_acquire_notify(int argc, char *argv[])
  1823. {
  1824. if (!default_attr) {
  1825. bt_shell_printf("No attribute selected\n");
  1826. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1827. }
  1828. gatt_acquire_notify(default_attr, argv[1]);
  1829. }
  1830. static void cmd_release_notify(int argc, char *argv[])
  1831. {
  1832. if (!default_attr) {
  1833. bt_shell_printf("No attribute selected\n");
  1834. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1835. }
  1836. gatt_release_notify(default_attr, argv[1]);
  1837. }
  1838. static void cmd_notify(int argc, char *argv[])
  1839. {
  1840. dbus_bool_t enable;
  1841. if (!parse_argument(argc, argv, NULL, NULL, &enable, NULL))
  1842. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1843. if (!default_attr) {
  1844. bt_shell_printf("No attribute selected\n");
  1845. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1846. }
  1847. gatt_notify_attribute(default_attr, enable ? true : false);
  1848. }
  1849. static void cmd_clone(int argc, char *argv[])
  1850. {
  1851. GDBusProxy *proxy;
  1852. proxy = default_attr ? default_attr : default_dev;
  1853. if (!proxy) {
  1854. bt_shell_printf("Not connected\n");
  1855. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1856. }
  1857. gatt_clone_attribute(proxy, argc, argv);
  1858. }
  1859. static void cmd_register_app(int argc, char *argv[])
  1860. {
  1861. if (check_default_ctrl() == FALSE)
  1862. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1863. gatt_register_app(dbus_conn, default_ctrl->proxy, argc, argv);
  1864. }
  1865. static void cmd_unregister_app(int argc, char *argv[])
  1866. {
  1867. if (check_default_ctrl() == FALSE)
  1868. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1869. gatt_unregister_app(dbus_conn, default_ctrl->proxy);
  1870. }
  1871. static void cmd_register_service(int argc, char *argv[])
  1872. {
  1873. if (check_default_ctrl() == FALSE)
  1874. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1875. gatt_register_service(dbus_conn, default_ctrl->proxy, argc, argv);
  1876. }
  1877. static void cmd_register_includes(int argc, char *argv[])
  1878. {
  1879. if (check_default_ctrl() == FALSE)
  1880. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1881. gatt_register_include(dbus_conn, default_ctrl->proxy, argc, argv);
  1882. }
  1883. static void cmd_unregister_includes(int argc, char *argv[])
  1884. {
  1885. if (check_default_ctrl() == FALSE)
  1886. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1887. gatt_unregister_include(dbus_conn, default_ctrl->proxy, argc, argv);
  1888. }
  1889. static void cmd_unregister_service(int argc, char *argv[])
  1890. {
  1891. if (check_default_ctrl() == FALSE)
  1892. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1893. gatt_unregister_service(dbus_conn, default_ctrl->proxy, argc, argv);
  1894. }
  1895. static void cmd_register_characteristic(int argc, char *argv[])
  1896. {
  1897. if (check_default_ctrl() == FALSE)
  1898. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1899. gatt_register_chrc(dbus_conn, default_ctrl->proxy, argc, argv);
  1900. }
  1901. static void cmd_unregister_characteristic(int argc, char *argv[])
  1902. {
  1903. if (check_default_ctrl() == FALSE)
  1904. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1905. gatt_unregister_chrc(dbus_conn, default_ctrl->proxy, argc, argv);
  1906. }
  1907. static void cmd_register_descriptor(int argc, char *argv[])
  1908. {
  1909. if (check_default_ctrl() == FALSE)
  1910. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1911. gatt_register_desc(dbus_conn, default_ctrl->proxy, argc, argv);
  1912. }
  1913. static void cmd_unregister_descriptor(int argc, char *argv[])
  1914. {
  1915. if (check_default_ctrl() == FALSE)
  1916. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  1917. gatt_unregister_desc(dbus_conn, default_ctrl->proxy, argc, argv);
  1918. }
  1919. static char *generic_generator(const char *text, int state,
  1920. GList *source, const char *property)
  1921. {
  1922. static int index, len;
  1923. GList *list;
  1924. if (!state) {
  1925. index = 0;
  1926. len = strlen(text);
  1927. }
  1928. for (list = g_list_nth(source, index); list;
  1929. list = g_list_next(list)) {
  1930. GDBusProxy *proxy = list->data;
  1931. DBusMessageIter iter;
  1932. const char *str;
  1933. index++;
  1934. if (g_dbus_proxy_get_property(proxy, property, &iter) == FALSE)
  1935. continue;
  1936. dbus_message_iter_get_basic(&iter, &str);
  1937. if (!strncasecmp(str, text, len))
  1938. return strdup(str);
  1939. }
  1940. return NULL;
  1941. }
  1942. static char *ctrl_generator(const char *text, int state)
  1943. {
  1944. static int index = 0;
  1945. static int len = 0;
  1946. GList *list;
  1947. if (!state) {
  1948. index = 0;
  1949. len = strlen(text);
  1950. }
  1951. for (list = g_list_nth(ctrl_list, index); list;
  1952. list = g_list_next(list)) {
  1953. struct adapter *adapter = list->data;
  1954. DBusMessageIter iter;
  1955. const char *str;
  1956. index++;
  1957. if (g_dbus_proxy_get_property(adapter->proxy,
  1958. "Address", &iter) == FALSE)
  1959. continue;
  1960. dbus_message_iter_get_basic(&iter, &str);
  1961. if (!strncasecmp(str, text, len))
  1962. return strdup(str);
  1963. }
  1964. return NULL;
  1965. }
  1966. static char *dev_generator(const char *text, int state)
  1967. {
  1968. return generic_generator(text, state,
  1969. default_ctrl ? default_ctrl->devices : NULL, "Address");
  1970. }
  1971. static char *attribute_generator(const char *text, int state)
  1972. {
  1973. return gatt_attribute_generator(text, state);
  1974. }
  1975. static char *argument_generator(const char *text, int state,
  1976. const char *args_list[])
  1977. {
  1978. static int index, len;
  1979. const char *arg;
  1980. if (!state) {
  1981. index = 0;
  1982. len = strlen(text);
  1983. }
  1984. while ((arg = args_list[index])) {
  1985. index++;
  1986. if (!strncmp(arg, text, len))
  1987. return strdup(arg);
  1988. }
  1989. return NULL;
  1990. }
  1991. static char *capability_generator(const char *text, int state)
  1992. {
  1993. return argument_generator(text, state, agent_arguments);
  1994. }
  1995. static void cmd_advertise(int argc, char *argv[])
  1996. {
  1997. dbus_bool_t enable;
  1998. const char *type;
  1999. if (!parse_argument(argc, argv, ad_arguments, "type",
  2000. &enable, &type))
  2001. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2002. if (!default_ctrl || !default_ctrl->ad_proxy) {
  2003. bt_shell_printf("LEAdvertisingManager not found\n");
  2004. bt_shell_noninteractive_quit(EXIT_FAILURE);
  2005. }
  2006. if (enable == TRUE)
  2007. ad_register(dbus_conn, default_ctrl->ad_proxy, type);
  2008. else
  2009. ad_unregister(dbus_conn, default_ctrl->ad_proxy);
  2010. }
  2011. static char *ad_generator(const char *text, int state)
  2012. {
  2013. return argument_generator(text, state, ad_arguments);
  2014. }
  2015. static void cmd_advertise_uuids(int argc, char *argv[])
  2016. {
  2017. ad_advertise_uuids(dbus_conn, argc, argv);
  2018. }
  2019. static void cmd_advertise_service(int argc, char *argv[])
  2020. {
  2021. ad_advertise_service(dbus_conn, argc, argv);
  2022. }
  2023. static void cmd_advertise_manufacturer(int argc, char *argv[])
  2024. {
  2025. ad_advertise_manufacturer(dbus_conn, argc, argv);
  2026. }
  2027. static void cmd_advertise_data(int argc, char *argv[])
  2028. {
  2029. ad_advertise_data(dbus_conn, argc, argv);
  2030. }
  2031. static void cmd_advertise_discoverable(int argc, char *argv[])
  2032. {
  2033. dbus_bool_t discoverable;
  2034. if (argc < 2) {
  2035. ad_advertise_discoverable(dbus_conn, NULL);
  2036. return;
  2037. }
  2038. if (!parse_argument(argc, argv, NULL, NULL, &discoverable, NULL))
  2039. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2040. ad_advertise_discoverable(dbus_conn, &discoverable);
  2041. }
  2042. static void cmd_advertise_discoverable_timeout(int argc, char *argv[])
  2043. {
  2044. long int value;
  2045. char *endptr = NULL;
  2046. if (argc < 2) {
  2047. ad_advertise_discoverable_timeout(dbus_conn, NULL);
  2048. return;
  2049. }
  2050. value = strtol(argv[1], &endptr, 0);
  2051. if (!endptr || *endptr != '\0' || value > UINT16_MAX) {
  2052. bt_shell_printf("Invalid argument\n");
  2053. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2054. }
  2055. ad_advertise_discoverable_timeout(dbus_conn, &value);
  2056. }
  2057. static void cmd_advertise_tx_power(int argc, char *argv[])
  2058. {
  2059. dbus_bool_t powered;
  2060. if (argc < 2) {
  2061. ad_advertise_tx_power(dbus_conn, NULL);
  2062. return;
  2063. }
  2064. if (!parse_argument(argc, argv, NULL, NULL, &powered, NULL))
  2065. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2066. ad_advertise_tx_power(dbus_conn, &powered);
  2067. }
  2068. static void cmd_advertise_name(int argc, char *argv[])
  2069. {
  2070. if (argc < 2) {
  2071. ad_advertise_local_name(dbus_conn, NULL);
  2072. return;
  2073. }
  2074. if (strcmp(argv[1], "on") == 0 || strcmp(argv[1], "yes") == 0) {
  2075. ad_advertise_name(dbus_conn, true);
  2076. return;
  2077. }
  2078. if (strcmp(argv[1], "off") == 0 || strcmp(argv[1], "no") == 0) {
  2079. ad_advertise_name(dbus_conn, false);
  2080. return;
  2081. }
  2082. ad_advertise_local_name(dbus_conn, argv[1]);
  2083. }
  2084. static void cmd_advertise_appearance(int argc, char *argv[])
  2085. {
  2086. long int value;
  2087. char *endptr = NULL;
  2088. if (argc < 2) {
  2089. ad_advertise_local_appearance(dbus_conn, NULL);
  2090. return;
  2091. }
  2092. if (strcmp(argv[1], "on") == 0 || strcmp(argv[1], "yes") == 0) {
  2093. ad_advertise_appearance(dbus_conn, true);
  2094. return;
  2095. }
  2096. if (strcmp(argv[1], "off") == 0 || strcmp(argv[1], "no") == 0) {
  2097. ad_advertise_appearance(dbus_conn, false);
  2098. return;
  2099. }
  2100. value = strtol(argv[1], &endptr, 0);
  2101. if (!endptr || *endptr != '\0' || value > UINT16_MAX) {
  2102. bt_shell_printf("Invalid argument\n");
  2103. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2104. }
  2105. ad_advertise_local_appearance(dbus_conn, &value);
  2106. }
  2107. static void cmd_advertise_duration(int argc, char *argv[])
  2108. {
  2109. long int value;
  2110. char *endptr = NULL;
  2111. if (argc < 2) {
  2112. ad_advertise_duration(dbus_conn, NULL);
  2113. return;
  2114. }
  2115. value = strtol(argv[1], &endptr, 0);
  2116. if (!endptr || *endptr != '\0' || value > UINT16_MAX) {
  2117. bt_shell_printf("Invalid argument\n");
  2118. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2119. }
  2120. ad_advertise_duration(dbus_conn, &value);
  2121. }
  2122. static void cmd_advertise_timeout(int argc, char *argv[])
  2123. {
  2124. long int value;
  2125. char *endptr = NULL;
  2126. if (argc < 2) {
  2127. ad_advertise_timeout(dbus_conn, NULL);
  2128. return;
  2129. }
  2130. value = strtol(argv[1], &endptr, 0);
  2131. if (!endptr || *endptr != '\0' || value > UINT16_MAX) {
  2132. bt_shell_printf("Invalid argument\n");
  2133. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2134. }
  2135. ad_advertise_timeout(dbus_conn, &value);
  2136. }
  2137. static void cmd_advertise_secondary(int argc, char *argv[])
  2138. {
  2139. if (argc < 2) {
  2140. ad_advertise_secondary(dbus_conn, NULL);
  2141. return;
  2142. }
  2143. ad_advertise_secondary(dbus_conn, argv[1]);
  2144. }
  2145. static void cmd_advertise_interval(int argc, char *argv[])
  2146. {
  2147. uint32_t min, max;
  2148. char *endptr = NULL;
  2149. if (argc < 2) {
  2150. ad_advertise_interval(dbus_conn, NULL, NULL);
  2151. return;
  2152. }
  2153. min = strtol(argv[1], &endptr, 0);
  2154. if (!endptr || *endptr != '\0' || min < 20 || min > 10485) {
  2155. bt_shell_printf("Invalid argument\n");
  2156. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2157. }
  2158. max = min;
  2159. if (argc > 2) {
  2160. max = strtol(argv[1], &endptr, 0);
  2161. if (!endptr || *endptr != '\0' || max < 20 || max > 10485) {
  2162. bt_shell_printf("Invalid argument\n");
  2163. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2164. }
  2165. }
  2166. if (min > max) {
  2167. bt_shell_printf("Invalid argument: %u > %u\n", min, max);
  2168. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2169. }
  2170. ad_advertise_interval(dbus_conn, &min, &max);
  2171. }
  2172. static void ad_clear_uuids(void)
  2173. {
  2174. ad_disable_uuids(dbus_conn);
  2175. }
  2176. static void ad_clear_service(void)
  2177. {
  2178. ad_disable_service(dbus_conn);
  2179. }
  2180. static void ad_clear_manufacturer(void)
  2181. {
  2182. ad_disable_manufacturer(dbus_conn);
  2183. }
  2184. static void ad_clear_data(void)
  2185. {
  2186. ad_disable_data(dbus_conn);
  2187. }
  2188. static void ad_clear_tx_power(void)
  2189. {
  2190. dbus_bool_t powered = false;
  2191. ad_advertise_tx_power(dbus_conn, &powered);
  2192. }
  2193. static void ad_clear_name(void)
  2194. {
  2195. ad_advertise_name(dbus_conn, false);
  2196. }
  2197. static void ad_clear_appearance(void)
  2198. {
  2199. ad_advertise_appearance(dbus_conn, false);
  2200. }
  2201. static void ad_clear_duration(void)
  2202. {
  2203. long int value = 0;
  2204. ad_advertise_duration(dbus_conn, &value);
  2205. }
  2206. static void ad_clear_timeout(void)
  2207. {
  2208. long int value = 0;
  2209. ad_advertise_timeout(dbus_conn, &value);
  2210. }
  2211. static void ad_clear_secondary(void)
  2212. {
  2213. const char *value = "";
  2214. ad_advertise_secondary(dbus_conn, value);
  2215. }
  2216. static void ad_clear_interval(void)
  2217. {
  2218. uint32_t min = 0;
  2219. uint32_t max = 0;
  2220. ad_advertise_interval(dbus_conn, &min, &max);
  2221. }
  2222. static const struct clear_entry ad_clear[] = {
  2223. { "uuids", ad_clear_uuids },
  2224. { "service", ad_clear_service },
  2225. { "manufacturer", ad_clear_manufacturer },
  2226. { "data", ad_clear_data },
  2227. { "tx-power", ad_clear_tx_power },
  2228. { "name", ad_clear_name },
  2229. { "appearance", ad_clear_appearance },
  2230. { "duration", ad_clear_duration },
  2231. { "timeout", ad_clear_timeout },
  2232. { "secondary", ad_clear_secondary },
  2233. { "interval", ad_clear_interval },
  2234. {}
  2235. };
  2236. static void cmd_ad_clear(int argc, char *argv[])
  2237. {
  2238. bool all = false;
  2239. if (argc < 2 || !strlen(argv[1]))
  2240. all = true;
  2241. if(!data_clear(ad_clear, all ? "all" : argv[1]))
  2242. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2243. }
  2244. static void print_add_or_pattern_usage(void)
  2245. {
  2246. bt_shell_printf("pattern format:\n"
  2247. "\t<start_position> <ad_data_type> <content_of_pattern>\n");
  2248. bt_shell_printf("e.g.\n"
  2249. "\tadd-or-pattern 1 2 01ab55 3 4 23cd66\n");
  2250. }
  2251. static void cmd_adv_monitor_print_usage(int argc, char *argv[])
  2252. {
  2253. if (strcmp(argv[1], "add-or-pattern") == 0)
  2254. print_add_or_pattern_usage();
  2255. else
  2256. bt_shell_printf("Invalid argument %s", argv[1]);
  2257. }
  2258. static void cmd_adv_monitor_set_rssi_threshold(int argc, char *argv[])
  2259. {
  2260. int low_threshold, high_threshold;
  2261. low_threshold = atoi(argv[1]);
  2262. high_threshold = atoi(argv[2]);
  2263. adv_monitor_set_rssi_threshold(low_threshold, high_threshold);
  2264. }
  2265. static void cmd_adv_monitor_set_rssi_timeout(int argc, char *argv[])
  2266. {
  2267. int low_timeout, high_timeout;
  2268. low_timeout = atoi(argv[1]);
  2269. high_timeout = atoi(argv[2]);
  2270. adv_monitor_set_rssi_timeout(low_timeout, high_timeout);
  2271. }
  2272. static void cmd_adv_monitor_set_rssi_sampling_period(int argc, char *argv[])
  2273. {
  2274. int sampling = atoi(argv[1]);
  2275. adv_monitor_set_rssi_sampling_period(sampling);
  2276. }
  2277. static void cmd_adv_monitor_add_or_monitor(int argc, char *argv[])
  2278. {
  2279. adv_monitor_add_monitor(dbus_conn, "or_patterns", argc, argv);
  2280. }
  2281. static void cmd_adv_monitor_print_monitor(int argc, char *argv[])
  2282. {
  2283. int monitor_idx;
  2284. if (strcmp(argv[1], "all") == 0)
  2285. monitor_idx = -1;
  2286. else
  2287. monitor_idx = atoi(argv[1]);
  2288. adv_monitor_print_monitor(dbus_conn, monitor_idx);
  2289. }
  2290. static void cmd_adv_monitor_remove_monitor(int argc, char *argv[])
  2291. {
  2292. int monitor_idx;
  2293. if (strcmp(argv[1], "all") == 0)
  2294. monitor_idx = -1;
  2295. else
  2296. monitor_idx = atoi(argv[1]);
  2297. adv_monitor_remove_monitor(dbus_conn, monitor_idx);
  2298. }
  2299. static void cmd_adv_monitor_get_supported_info(int argc, char *argv[])
  2300. {
  2301. adv_monitor_get_supported_info();
  2302. }
  2303. static void cmd_admin_allow(int argc, char *argv[])
  2304. {
  2305. if (check_default_ctrl() == FALSE)
  2306. return bt_shell_noninteractive_quit(EXIT_FAILURE);
  2307. if (argc <= 1) {
  2308. admin_policy_read_service_allowlist(dbus_conn);
  2309. return;
  2310. }
  2311. if (strcmp(argv[1], "clear") == 0)
  2312. argc--;
  2313. admin_policy_set_service_allowlist(dbus_conn, argc - 1, argv + 1);
  2314. }
  2315. static const struct bt_shell_menu advertise_menu = {
  2316. .name = "advertise",
  2317. .desc = "Advertise Options Submenu",
  2318. .entries = {
  2319. { "uuids", "[uuid1 uuid2 ...]", cmd_advertise_uuids,
  2320. "Set/Get advertise uuids" },
  2321. { "service", "[uuid] [data=xx xx ...]", cmd_advertise_service,
  2322. "Set/Get advertise service data" },
  2323. { "manufacturer", "[id] [data=xx xx ...]",
  2324. cmd_advertise_manufacturer,
  2325. "Set/Get advertise manufacturer data" },
  2326. { "data", "[type] [data=xx xx ...]", cmd_advertise_data,
  2327. "Set/Get advertise data" },
  2328. { "discoverable", "[on/off]", cmd_advertise_discoverable,
  2329. "Set/Get advertise discoverable" },
  2330. { "discoverable-timeout", "[seconds]",
  2331. cmd_advertise_discoverable_timeout,
  2332. "Set/Get advertise discoverable timeout" },
  2333. { "tx-power", "[on/off]", cmd_advertise_tx_power,
  2334. "Show/Enable/Disable TX power to be advertised",
  2335. NULL },
  2336. { "name", "[on/off/name]", cmd_advertise_name,
  2337. "Configure local name to be advertised" },
  2338. { "appearance", "[on/off/value]", cmd_advertise_appearance,
  2339. "Configure custom appearance to be advertised" },
  2340. { "duration", "[seconds]", cmd_advertise_duration,
  2341. "Set/Get advertise duration" },
  2342. { "timeout", "[seconds]", cmd_advertise_timeout,
  2343. "Set/Get advertise timeout" },
  2344. { "secondary", "[1M/2M/Coded]", cmd_advertise_secondary,
  2345. "Set/Get advertise secondary channel" },
  2346. { "interval", "[min] [max] ", cmd_advertise_interval,
  2347. "Set/Get advertise interval range" },
  2348. { "clear", "[uuids/service/manufacturer/config-name...]", cmd_ad_clear,
  2349. "Clear advertise config" },
  2350. { } },
  2351. };
  2352. static const struct bt_shell_menu advertise_monitor_menu = {
  2353. .name = "monitor",
  2354. .desc = "Advertisement Monitor Options Submenu",
  2355. .entries = {
  2356. { "set-rssi-threshold", "<low_threshold> <high_threshold>",
  2357. cmd_adv_monitor_set_rssi_threshold,
  2358. "Set RSSI threshold parameter" },
  2359. { "set-rssi-timeout", "<low_timeout> <high_timeout>",
  2360. cmd_adv_monitor_set_rssi_timeout,
  2361. "Set RSSI timeout parameter" },
  2362. { "set-rssi-sampling-period", "<sampling_period>",
  2363. cmd_adv_monitor_set_rssi_sampling_period,
  2364. "Set RSSI sampling period parameter" },
  2365. { "add-or-pattern", "[patterns=pattern1 pattern2 ...]",
  2366. cmd_adv_monitor_add_or_monitor,
  2367. "Register 'or pattern' type monitor with the "
  2368. "specified RSSI parameters" },
  2369. { "get-pattern", "<monitor-id/all>",
  2370. cmd_adv_monitor_print_monitor,
  2371. "Get advertisement monitor" },
  2372. { "remove-pattern", "<monitor-id/all>",
  2373. cmd_adv_monitor_remove_monitor,
  2374. "Remove advertisement monitor" },
  2375. { "get-supported-info", NULL,
  2376. cmd_adv_monitor_get_supported_info,
  2377. "Get advertisement manager supported "
  2378. "features and supported monitor types" },
  2379. { "print-usage", "<add-or-pattern>",
  2380. cmd_adv_monitor_print_usage,
  2381. "Print the command usage"},
  2382. { } },
  2383. };
  2384. static const struct bt_shell_menu scan_menu = {
  2385. .name = "scan",
  2386. .desc = "Scan Options Submenu",
  2387. .entries = {
  2388. { "uuids", "[all/uuid1 uuid2 ...]", cmd_scan_filter_uuids,
  2389. "Set/Get UUIDs filter" },
  2390. { "rssi", "[rssi]", cmd_scan_filter_rssi,
  2391. "Set/Get RSSI filter, and clears pathloss" },
  2392. { "pathloss", "[pathloss]", cmd_scan_filter_pathloss,
  2393. "Set/Get Pathloss filter, and clears RSSI" },
  2394. { "transport", "[transport]", cmd_scan_filter_transport,
  2395. "Set/Get transport filter" },
  2396. { "duplicate-data", "[on/off]", cmd_scan_filter_duplicate_data,
  2397. "Set/Get duplicate data filter",
  2398. NULL },
  2399. { "discoverable", "[on/off]", cmd_scan_filter_discoverable,
  2400. "Set/Get discoverable filter",
  2401. NULL },
  2402. { "pattern", "[value]", cmd_scan_filter_pattern,
  2403. "Set/Get pattern filter",
  2404. NULL },
  2405. { "clear",
  2406. "[uuids/rssi/pathloss/transport/duplicate-data/discoverable/pattern]",
  2407. cmd_scan_filter_clear,
  2408. "Clears discovery filter.",
  2409. filter_clear_generator },
  2410. { } },
  2411. };
  2412. static const struct bt_shell_menu gatt_menu = {
  2413. .name = "gatt",
  2414. .desc = "Generic Attribute Submenu",
  2415. .entries = {
  2416. { "list-attributes", "[dev/local]", cmd_list_attributes,
  2417. "List attributes", dev_generator },
  2418. { "select-attribute", "<attribute/UUID>", cmd_select_attribute,
  2419. "Select attribute", attribute_generator },
  2420. { "attribute-info", "[attribute/UUID]", cmd_attribute_info,
  2421. "Select attribute", attribute_generator },
  2422. { "read", "[offset]", cmd_read, "Read attribute value" },
  2423. { "write", "<data=xx xx ...> [offset] [type]", cmd_write,
  2424. "Write attribute value" },
  2425. { "acquire-write", NULL, cmd_acquire_write,
  2426. "Acquire Write file descriptor" },
  2427. { "release-write", NULL, cmd_release_write,
  2428. "Release Write file descriptor" },
  2429. { "acquire-notify", NULL, cmd_acquire_notify,
  2430. "Acquire Notify file descriptor" },
  2431. { "release-notify", NULL, cmd_release_notify,
  2432. "Release Notify file descriptor" },
  2433. { "notify", "<on/off>", cmd_notify, "Notify attribute value",
  2434. NULL },
  2435. { "clone", "[dev/attribute/UUID]", cmd_clone,
  2436. "Clone a device or attribute" },
  2437. { "register-application", "[UUID ...]", cmd_register_app,
  2438. "Register profile to connect" },
  2439. { "unregister-application", NULL, cmd_unregister_app,
  2440. "Unregister profile" },
  2441. { "register-service", "<UUID> [handle]", cmd_register_service,
  2442. "Register application service." },
  2443. { "unregister-service", "<UUID/object>", cmd_unregister_service,
  2444. "Unregister application service" },
  2445. { "register-includes", "<UUID> [handle]", cmd_register_includes,
  2446. "Register as Included service in." },
  2447. { "unregister-includes", "<Service-UUID><Inc-UUID>",
  2448. cmd_unregister_includes,
  2449. "Unregister Included service." },
  2450. { "register-characteristic",
  2451. "<UUID> <Flags=read,write,notify...> [handle]",
  2452. cmd_register_characteristic,
  2453. "Register application characteristic" },
  2454. { "unregister-characteristic", "<UUID/object>",
  2455. cmd_unregister_characteristic,
  2456. "Unregister application characteristic" },
  2457. { "register-descriptor", "<UUID> <Flags=read,write...> [handle]",
  2458. cmd_register_descriptor,
  2459. "Register application descriptor" },
  2460. { "unregister-descriptor", "<UUID/object>",
  2461. cmd_unregister_descriptor,
  2462. "Unregister application descriptor" },
  2463. { } },
  2464. };
  2465. static const struct bt_shell_menu admin_menu = {
  2466. .name = "admin",
  2467. .desc = "Admin Policy Submenu",
  2468. .entries = {
  2469. { "allow", "[clear/uuid1 uuid2 ...]", cmd_admin_allow,
  2470. "Allow service UUIDs and block rest of them"},
  2471. {} },
  2472. };
  2473. static const struct bt_shell_menu main_menu = {
  2474. .name = "main",
  2475. .entries = {
  2476. { "list", NULL, cmd_list, "List available controllers" },
  2477. { "show", "[ctrl]", cmd_show, "Controller information",
  2478. ctrl_generator },
  2479. { "select", "<ctrl>", cmd_select, "Select default controller",
  2480. ctrl_generator },
  2481. { "devices", NULL, cmd_devices, "List available devices" },
  2482. { "paired-devices", NULL, cmd_paired_devices,
  2483. "List paired devices"},
  2484. { "system-alias", "<name>", cmd_system_alias,
  2485. "Set controller alias" },
  2486. { "reset-alias", NULL, cmd_reset_alias,
  2487. "Reset controller alias" },
  2488. { "power", "<on/off>", cmd_power, "Set controller power",
  2489. NULL },
  2490. { "pairable", "<on/off>", cmd_pairable,
  2491. "Set controller pairable mode",
  2492. NULL },
  2493. { "discoverable", "<on/off>", cmd_discoverable,
  2494. "Set controller discoverable mode",
  2495. NULL },
  2496. { "discoverable-timeout", "[value]", cmd_discoverable_timeout,
  2497. "Set discoverable timeout", NULL },
  2498. { "agent", "<on/off/capability>", cmd_agent,
  2499. "Enable/disable agent with given capability",
  2500. capability_generator},
  2501. { "default-agent",NULL, cmd_default_agent,
  2502. "Set agent as the default one" },
  2503. { "advertise", "<on/off/type>", cmd_advertise,
  2504. "Enable/disable advertising with given type",
  2505. ad_generator},
  2506. { "set-alias", "<alias>", cmd_set_alias, "Set device alias" },
  2507. { "scan", "<on/off>", cmd_scan, "Scan for devices", NULL },
  2508. { "info", "[dev]", cmd_info, "Device information",
  2509. dev_generator },
  2510. { "pair", "[dev]", cmd_pair, "Pair with device",
  2511. dev_generator },
  2512. { "cancel-pairing", "[dev]", cmd_cancel_pairing,
  2513. "Cancel pairing with device", dev_generator },
  2514. { "trust", "[dev]", cmd_trust, "Trust device",
  2515. dev_generator },
  2516. { "untrust", "[dev]", cmd_untrust, "Untrust device",
  2517. dev_generator },
  2518. { "block", "[dev]", cmd_block, "Block device",
  2519. dev_generator },
  2520. { "unblock", "[dev]", cmd_unblock, "Unblock device",
  2521. dev_generator },
  2522. { "remove", "<dev>", cmd_remove, "Remove device",
  2523. dev_generator },
  2524. { "connect", "<dev>", cmd_connect, "Connect device",
  2525. dev_generator },
  2526. { "disconnect", "[dev]", cmd_disconn, "Disconnect device",
  2527. dev_generator },
  2528. { } },
  2529. };
  2530. static const struct option options[] = {
  2531. { "agent", required_argument, 0, 'a' },
  2532. { 0, 0, 0, 0 }
  2533. };
  2534. static const char *agent_option;
  2535. static const char **optargs[] = {
  2536. &agent_option
  2537. };
  2538. static const char *help[] = {
  2539. "Register agent handler: <capability>"
  2540. };
  2541. static const struct bt_shell_opt opt = {
  2542. .options = options,
  2543. .optno = sizeof(options) / sizeof(struct option),
  2544. .optstr = "a:",
  2545. .optarg = optargs,
  2546. .help = help,
  2547. };
  2548. static void client_ready(GDBusClient *client, void *user_data)
  2549. {
  2550. setup_standard_input();
  2551. }
  2552. int main(int argc, char *argv[])
  2553. {
  2554. GDBusClient *client;
  2555. int status;
  2556. bt_shell_init(argc, argv, &opt);
  2557. bt_shell_set_menu(&main_menu);
  2558. bt_shell_add_submenu(&advertise_menu);
  2559. bt_shell_add_submenu(&advertise_monitor_menu);
  2560. bt_shell_add_submenu(&scan_menu);
  2561. bt_shell_add_submenu(&gatt_menu);
  2562. bt_shell_add_submenu(&admin_menu);
  2563. bt_shell_set_prompt(PROMPT_OFF);
  2564. if (agent_option)
  2565. auto_register_agent = g_strdup(agent_option);
  2566. else
  2567. auto_register_agent = g_strdup("");
  2568. dbus_conn = g_dbus_setup_bus(DBUS_BUS_SYSTEM, NULL, NULL);
  2569. g_dbus_attach_object_manager(dbus_conn);
  2570. bt_shell_set_env("DBUS_CONNECTION", dbus_conn);
  2571. client = g_dbus_client_new(dbus_conn, "org.bluez", "/org/bluez");
  2572. g_dbus_client_set_connect_watch(client, connect_handler, NULL);
  2573. g_dbus_client_set_disconnect_watch(client, disconnect_handler, NULL);
  2574. g_dbus_client_set_signal_watch(client, message_handler, NULL);
  2575. g_dbus_client_set_proxy_handlers(client, proxy_added, proxy_removed,
  2576. property_changed, NULL);
  2577. g_dbus_client_set_ready_watch(client, client_ready, NULL);
  2578. status = bt_shell_run();
  2579. g_dbus_client_unref(client);
  2580. dbus_connection_unref(dbus_conn);
  2581. g_list_free_full(ctrl_list, proxy_leak);
  2582. g_free(auto_register_agent);
  2583. return status;
  2584. }