link_policy.c revision 330449
1/*- 2 * link_policy.c 3 * 4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 5 * 6 * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com> 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 * 30 * $Id: link_policy.c,v 1.3 2003/08/18 19:19:54 max Exp $ 31 * $FreeBSD: stable/11/usr.sbin/bluetooth/hccontrol/link_policy.c 330449 2018-03-05 07:26:05Z eadler $ 32 */ 33 34#define L2CAP_SOCKET_CHECKED 35#include <bluetooth.h> 36#include <errno.h> 37#include <stdio.h> 38#include <string.h> 39#include "hccontrol.h" 40 41/* Send Role Discovery to the unit */ 42static int 43hci_role_discovery(int s, int argc, char **argv) 44{ 45 ng_hci_role_discovery_cp cp; 46 ng_hci_role_discovery_rp rp; 47 int n; 48 49 /* parse command parameters */ 50 switch (argc) { 51 case 1: 52 /* connection handle */ 53 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff) 54 return (USAGE); 55 56 cp.con_handle = (uint16_t) (n & 0x0fff); 57 cp.con_handle = htole16(cp.con_handle); 58 break; 59 60 default: 61 return (USAGE); 62 } 63 64 /* send request */ 65 n = sizeof(rp); 66 if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY, 67 NG_HCI_OCF_ROLE_DISCOVERY), 68 (char const *) &cp, sizeof(cp), 69 (char *) &rp, &n) == ERROR) 70 return (ERROR); 71 72 if (rp.status != 0x00) { 73 fprintf(stdout, "Status: %s [%#02x]\n", 74 hci_status2str(rp.status), rp.status); 75 return (FAILED); 76 } 77 78 fprintf(stdout, "Connection handle: %d\n", le16toh(rp.con_handle)); 79 fprintf(stdout, "Role: %s [%#x]\n", 80 (rp.role == NG_HCI_ROLE_MASTER)? "Master" : "Slave", rp.role); 81 82 return (OK); 83} /* hci_role_discovery */ 84 85/* Send Swith Role to the unit */ 86static int 87hci_switch_role(int s, int argc, char **argv) 88{ 89 int n0; 90 char b[512]; 91 ng_hci_switch_role_cp cp; 92 ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) b; 93 94 /* parse command parameters */ 95 switch (argc) { 96 case 2: 97 /* bdaddr */ 98 if (!bt_aton(argv[0], &cp.bdaddr)) { 99 struct hostent *he = NULL; 100 101 if ((he = bt_gethostbyname(argv[0])) == NULL) 102 return (USAGE); 103 104 memcpy(&cp.bdaddr, he->h_addr, sizeof(cp.bdaddr)); 105 } 106 107 /* role */ 108 if (sscanf(argv[1], "%d", &n0) != 1) 109 return (USAGE); 110 111 cp.role = n0? NG_HCI_ROLE_SLAVE : NG_HCI_ROLE_MASTER; 112 break; 113 114 default: 115 return (USAGE); 116 } 117 118 /* send request and expect status response */ 119 n0 = sizeof(b); 120 if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY, 121 NG_HCI_OCF_SWITCH_ROLE), 122 (char const *) &cp, sizeof(cp), b, &n0) == ERROR) 123 return (ERROR); 124 125 if (*b != 0x00) 126 return (FAILED); 127 128 /* wait for event */ 129again: 130 n0 = sizeof(b); 131 if (hci_recv(s, b, &n0) == ERROR) 132 return (ERROR); 133 if (n0 < sizeof(*e)) { 134 errno = EIO; 135 return (ERROR); 136 } 137 138 if (e->event == NG_HCI_EVENT_ROLE_CHANGE) { 139 ng_hci_role_change_ep *ep = (ng_hci_role_change_ep *)(e + 1); 140 141 if (ep->status != 0x00) { 142 fprintf(stdout, "Status: %s [%#02x]\n", 143 hci_status2str(ep->status), ep->status); 144 return (FAILED); 145 } 146 147 fprintf(stdout, "BD_ADDR: %s\n", hci_bdaddr2str(&ep->bdaddr)); 148 fprintf(stdout, "Role: %s [%#x]\n", 149 (ep->role == NG_HCI_ROLE_MASTER)? "Master" : "Slave", 150 ep->role); 151 } else 152 goto again; 153 154 return (OK); 155} /* hci_switch_role */ 156 157/* Send Read_Link_Policy_Settings command to the unit */ 158static int 159hci_read_link_policy_settings(int s, int argc, char **argv) 160{ 161 ng_hci_read_link_policy_settings_cp cp; 162 ng_hci_read_link_policy_settings_rp rp; 163 int n; 164 165 /* parse command parameters */ 166 switch (argc) { 167 case 1: 168 /* connection handle */ 169 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff) 170 return (USAGE); 171 172 cp.con_handle = (uint16_t) (n & 0x0fff); 173 cp.con_handle = htole16(cp.con_handle); 174 break; 175 176 default: 177 return (USAGE); 178 } 179 180 /* send request */ 181 n = sizeof(rp); 182 if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY, 183 NG_HCI_OCF_READ_LINK_POLICY_SETTINGS), 184 (char const *) &cp, sizeof(cp), 185 (char *) &rp, &n) == ERROR) 186 return (ERROR); 187 188 if (rp.status != 0x00) { 189 fprintf(stdout, "Status: %s [%#02x]\n", 190 hci_status2str(rp.status), rp.status); 191 return (FAILED); 192 } 193 194 fprintf(stdout, "Connection handle: %d\n", le16toh(rp.con_handle)); 195 fprintf(stdout, "Link policy settings: %#x\n", le16toh(rp.settings)); 196 197 return (OK); 198} /* hci_read_link_policy_settings */ 199 200/* Send Write_Link_Policy_Settings command to the unit */ 201static int 202hci_write_link_policy_settings(int s, int argc, char **argv) 203{ 204 ng_hci_write_link_policy_settings_cp cp; 205 ng_hci_write_link_policy_settings_rp rp; 206 int n; 207 208 /* parse command parameters */ 209 switch (argc) { 210 case 2: 211 /* connection handle */ 212 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff) 213 return (USAGE); 214 215 cp.con_handle = (uint16_t) (n & 0x0fff); 216 cp.con_handle = htole16(cp.con_handle); 217 218 /* link policy settings */ 219 if (sscanf(argv[1], "%x", &n) != 1) 220 return (USAGE); 221 222 cp.settings = (uint16_t) (n & 0x0ffff); 223 cp.settings = htole16(cp.settings); 224 break; 225 226 default: 227 return (USAGE); 228 } 229 230 /* send request */ 231 n = sizeof(rp); 232 if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY, 233 NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS), 234 (char const *) &cp, sizeof(cp), 235 (char *) &rp, &n) == ERROR) 236 return (ERROR); 237 238 if (rp.status != 0x00) { 239 fprintf(stdout, "Status: %s [%#02x]\n", 240 hci_status2str(rp.status), rp.status); 241 return (FAILED); 242 } 243 244 return (OK); 245} /* hci_write_link_policy_settings */ 246 247struct hci_command link_policy_commands[] = { 248{ 249"role_discovery <connection_handle>", 250"\nThe Role_Discovery command is used for a Bluetooth device to determine\n" \ 251"which role the device is performing for a particular Connection Handle.\n" \ 252"The connection handle must be a connection handle for an ACL connection.\n\n" \ 253"\t<connection_handle> - dddd; connection handle", 254&hci_role_discovery 255}, 256{ 257"switch_role <BD_ADDR> <role>", 258"\nThe Switch_Role command is used for a Bluetooth device to switch the\n" \ 259"current role the device is performing for a particular connection with\n" \ 260"another specified Bluetooth device. The BD_ADDR command parameter indicates\n"\ 261"for which connection the role switch is to be performed. The Role indicates\n"\ 262"the requested new role that the local device performs. Note: the BD_ADDR\n" \ 263"command parameter must specify a Bluetooth device for which a connection\n" 264"already exists.\n\n" \ 265"\t<BD_ADDR> - xx:xx:xx:xx:xx:xx BD_ADDR or name\n" \ 266"\t<role> - dd; role; 0 - Master, 1 - Slave", 267&hci_switch_role 268}, 269{ 270"read_link_policy_settings <connection_handle>", 271"\nThis command will read the Link Policy setting for the specified connection\n"\ 272"handle. The link policy settings parameter determines the behavior of the\n" \ 273"local Link Manager when it receives a request from a remote device or it\n" \ 274"determines itself to change the master-slave role or to enter the hold,\n" \ 275"sniff, or park mode. The local Link Manager will automatically accept or\n" \ 276"reject such a request from the remote device, and may even autonomously\n" \ 277"request itself, depending on the value of the link policy settings parameter\n"\ 278"for the corresponding connection handle. The connection handle must be a\n" \ 279"connection handle for an ACL connection.\n\n" \ 280"\t<connection_handle> - dddd; connection handle", 281&hci_read_link_policy_settings 282}, 283{ 284"write_link_policy_settings <connection_handle> <settings>", 285"\nThis command will write the Link Policy setting for the specified connection\n"\ 286"handle. The link policy settings parameter determines the behavior of the\n" \ 287"local Link Manager when it receives a request from a remote device or it\n" \ 288"determines itself to change the master-slave role or to enter the hold,\n" \ 289"sniff, or park mode. The local Link Manager will automatically accept or\n" \ 290"reject such a request from the remote device, and may even autonomously\n" \ 291"request itself, depending on the value of the link policy settings parameter\n"\ 292"for the corresponding connection handle. The connection handle must be a\n" \ 293"connection handle for an ACL connection. Multiple Link Manager policies may\n"\ 294"be specified for the link policy settings parameter by performing a bitwise\n"\ 295"OR operation of the different activity types.\n\n" \ 296"\t<connection_handle> - dddd; connection handle\n" \ 297"\t<settings> - xxxx; settings\n" \ 298"\t\t0x0000 - Disable All LM Modes (Default)\n" \ 299"\t\t0x0001 - Enable Master Slave Switch\n" \ 300"\t\t0x0002 - Enable Hold Mode\n" \ 301"\t\t0x0004 - Enable Sniff Mode\n" \ 302"\t\t0x0008 - Enable Park Mode\n", 303&hci_write_link_policy_settings 304}, 305{ 306NULL, 307}}; 308 309