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