usr.sbin/bluetooth/hccontrol/link_policy.c

   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 #include <bluetooth.h>
  33 #include <errno.h>
  34 #include <stdio.h>
  35 #include <string.h>
  36 #include "hccontrol.h"
  37
  38 /* Send Role Discovery to the unit */
  39 static int
  40 hci_role_discovery(int s, int argc, char **argv)
  41 {
  42         ng_hci_role_discovery_cp        cp;
  43         ng_hci_role_discovery_rp        rp;
  44         int                             n;
  45
  46         /* parse command parameters */
  47         switch (argc) {
  48         case 1:
  49                 /* connection handle */
  50                 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff)
  51                         return (USAGE);
  52
  53                 cp.con_handle = (uint16_t) (n & 0x0fff);
  54                 cp.con_handle = htole16(cp.con_handle);
  55                 break;
  56
  57         default:
  58                 return (USAGE);
  59         }
  60
  61         /* send request */
  62         n = sizeof(rp);
  63         if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY,
  64                         NG_HCI_OCF_ROLE_DISCOVERY),
  65                         (char const *) &cp, sizeof(cp),
  66                         (char *) &rp, &n) == ERROR)
  67                 return (ERROR);
  68
  69         if (rp.status != 0x00) {
  70                 fprintf(stdout, "Status: %s [%#02x]\n",
  71                         hci_status2str(rp.status), rp.status);
  72                 return (FAILED);
  73         }
  74
  75         fprintf(stdout, "Connection handle: %d\n", le16toh(rp.con_handle));
  76         fprintf(stdout, "Role: %s [%#x]\n",
  77                 (rp.role == NG_HCI_ROLE_MASTER)? "Master" : "Slave", rp.role);
  78
  79         return (OK);
  80 } /* hci_role_discovery */
  81
  82 /* Send Swith Role to the unit */
  83 static int
  84 hci_switch_role(int s, int argc, char **argv)
  85 {
  86         int                      n0;
  87         char                     b[512];
  88         ng_hci_switch_role_cp    cp;
  89         ng_hci_event_pkt_t      *e = (ng_hci_event_pkt_t *) b;
  90
  91         /* parse command parameters */
  92         switch (argc) {
  93         case 2:
  94                 /* bdaddr */
  95                 if (!bt_aton(argv[0], &cp.bdaddr)) {
  96                         struct hostent  *he = NULL;
  97
  98                         if ((he = bt_gethostbyname(argv[0])) == NULL)
  99                                 return (USAGE);
 100
 101                         memcpy(&cp.bdaddr, he->h_addr, sizeof(cp.bdaddr));
 102                 }
 103
 104                 /* role */
 105                 if (sscanf(argv[1], "%d", &n0) != 1)
 106                         return (USAGE);
 107
 108                 cp.role = n0? NG_HCI_ROLE_SLAVE : NG_HCI_ROLE_MASTER;
 109                 break;
 110
 111         default:
 112                 return (USAGE);
 113         }
 114
 115         /* send request and expect status response */
 116         n0 = sizeof(b);
 117         if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY,
 118                         NG_HCI_OCF_SWITCH_ROLE),
 119                         (char const *) &cp, sizeof(cp), b, &n0) == ERROR)
 120                 return (ERROR);
 121
 122         if (*b != 0x00)
 123                 return (FAILED);
 124
 125         /* wait for event */
 126 again:
 127         n0 = sizeof(b);
 128         if (hci_recv(s, b, &n0) == ERROR)
 129                 return (ERROR);
 130         if (n0 < sizeof(*e)) {
 131                 errno = EIO;
 132                 return (ERROR);
 133         }
 134
 135         if (e->event == NG_HCI_EVENT_ROLE_CHANGE) {
 136                 ng_hci_role_change_ep   *ep = (ng_hci_role_change_ep *)(e + 1);
 137
 138                 if (ep->status != 0x00) {
 139                         fprintf(stdout, "Status: %s [%#02x]\n",
 140                                 hci_status2str(ep->status), ep->status);
 141                         return (FAILED);
 142                 }
 143
 144                 fprintf(stdout, "BD_ADDR: %s\n", hci_bdaddr2str(&ep->bdaddr));
 145                 fprintf(stdout, "Role: %s [%#x]\n",
 146                         (ep->role == NG_HCI_ROLE_MASTER)? "Master" : "Slave",
 147                         ep->role);
 148         } else
 149                 goto again;
 150
 151         return (OK);
 152 } /* hci_switch_role */
 153
 154 /* Send Read_Link_Policy_Settings command to the unit */
 155 static int
 156 hci_read_link_policy_settings(int s, int argc, char **argv)
 157 {
 158         ng_hci_read_link_policy_settings_cp     cp;
 159         ng_hci_read_link_policy_settings_rp     rp;
 160         int                                     n;
 161
 162         /* parse command parameters */
 163         switch (argc) {
 164         case 1:
 165                 /* connection handle */
 166                 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff)
 167                         return (USAGE);
 168
 169                 cp.con_handle = (uint16_t) (n & 0x0fff);
 170                 cp.con_handle = htole16(cp.con_handle);
 171                 break;
 172
 173         default:
 174                 return (USAGE);
 175         }
 176
 177         /* send request */
 178         n = sizeof(rp);
 179         if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY,
 180                         NG_HCI_OCF_READ_LINK_POLICY_SETTINGS),
 181                         (char const *) &cp, sizeof(cp),
 182                         (char *) &rp, &n) == ERROR)
 183                 return (ERROR);
 184
 185         if (rp.status != 0x00) {
 186                 fprintf(stdout, "Status: %s [%#02x]\n",
 187                         hci_status2str(rp.status), rp.status);
 188                 return (FAILED);
 189         }
 190
 191         fprintf(stdout, "Connection handle: %d\n", le16toh(rp.con_handle));
 192         fprintf(stdout, "Link policy settings: %#x\n", le16toh(rp.settings));
 193
 194         return (OK);
 195 } /* hci_read_link_policy_settings */
 196
 197 /* Send Write_Link_Policy_Settings command to the unit */
 198 static int
 199 hci_write_link_policy_settings(int s, int argc, char **argv)
 200 {
 201         ng_hci_write_link_policy_settings_cp    cp;
 202         ng_hci_write_link_policy_settings_rp    rp;
 203         int                                     n;
 204
 205         /* parse command parameters */
 206         switch (argc) {
 207         case 2:
 208                 /* connection handle */
 209                 if (sscanf(argv[0], "%d", &n) != 1 || n <= 0 || n > 0x0eff)
 210                         return (USAGE);
 211
 212                 cp.con_handle = (uint16_t) (n & 0x0fff);
 213                 cp.con_handle = htole16(cp.con_handle);
 214
 215                 /* link policy settings */
 216                 if (sscanf(argv[1], "%x", &n) != 1)
 217                         return (USAGE);
 218
 219                 cp.settings = (uint16_t) (n & 0x0ffff);
 220                 cp.settings = htole16(cp.settings);
 221                 break;
 222
 223         default:
 224                 return (USAGE);
 225         }
 226
 227         /* send request */
 228         n = sizeof(rp);
 229         if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LINK_POLICY,
 230                         NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS),
 231                         (char const *) &cp, sizeof(cp),
 232                         (char *) &rp, &n) == ERROR)
 233                 return (ERROR);
 234
 235         if (rp.status != 0x00) {
 236                 fprintf(stdout, "Status: %s [%#02x]\n",
 237                         hci_status2str(rp.status), rp.status);
 238                 return (FAILED);
 239         }
 240
 241         return (OK);
 242 } /* hci_write_link_policy_settings */
 243
 244 struct hci_command      link_policy_commands[] = {
 245 {
 246 "role_discovery <connection_handle>",
 247 "\nThe Role_Discovery command is used for a Bluetooth device to determine\n" \
 248 "which role the device is performing for a particular Connection Handle.\n" \
 249 "The connection handle must be a connection handle for an ACL connection.\n\n" \
 250 "\t<connection_handle> - dddd; connection handle",
 251 &hci_role_discovery
 252 },
 253 {
 254 "switch_role <BD_ADDR> <role>",
 255 "\nThe Switch_Role command is used for a Bluetooth device to switch the\n" \
 256 "current role the device is performing for a particular connection with\n" \
 257 "another specified Bluetooth device. The BD_ADDR command parameter indicates\n"\
 258 "for which connection the role switch is to be performed. The Role indicates\n"\
 259 "the requested new role that the local device performs. Note: the BD_ADDR\n" \
 260 "command parameter must specify a Bluetooth device for which a connection\n"
 261 "already exists.\n\n" \
 262 "\t<BD_ADDR> - xx:xx:xx:xx:xx:xx BD_ADDR or name\n" \
 263 "\t<role>    - dd; role; 0 - Master, 1 - Slave",
 264 &hci_switch_role
 265 },
 266 {
 267 "read_link_policy_settings <connection_handle>",
 268 "\nThis command will read the Link Policy setting for the specified connection\n"\
 269 "handle. The link policy settings parameter determines the behavior of the\n" \
 270 "local Link Manager when it receives a request from a remote device or it\n" \
 271 "determines itself to change the master-slave role or to enter the hold,\n" \
 272 "sniff, or park mode. The local Link Manager will automatically accept or\n" \
 273 "reject such a request from the remote device, and may even autonomously\n" \
 274 "request itself, depending on the value of the link policy settings parameter\n"\
 275 "for the corresponding connection handle. The connection handle must be a\n" \
 276 "connection handle for an ACL connection.\n\n" \
 277 "\t<connection_handle> - dddd; connection handle",
 278 &hci_read_link_policy_settings
 279 },
 280 {
 281 "write_link_policy_settings <connection_handle> <settings>",
 282 "\nThis command will write the Link Policy setting for the specified connection\n"\
 283 "handle. The link policy settings parameter determines the behavior of the\n" \
 284 "local Link Manager when it receives a request from a remote device or it\n" \
 285 "determines itself to change the master-slave role or to enter the hold,\n" \
 286 "sniff, or park mode. The local Link Manager will automatically accept or\n" \
 287 "reject such a request from the remote device, and may even autonomously\n" \
 288 "request itself, depending on the value of the link policy settings parameter\n"\
 289 "for the corresponding connection handle. The connection handle must be a\n" \
 290 "connection handle for an ACL connection. Multiple Link Manager policies may\n"\
 291 "be specified for the link policy settings parameter by performing a bitwise\n"\
 292 "OR operation of the different activity types.\n\n" \
 293 "\t<connection_handle> - dddd; connection handle\n" \
 294 "\t<settings>          - xxxx; settings\n" \
 295 "\t\t0x0000 - Disable All LM Modes (Default)\n" \
 296 "\t\t0x0001 - Enable Master Slave Switch\n" \
 297 "\t\t0x0002 - Enable Hold Mode\n" \
 298 "\t\t0x0004 - Enable Sniff Mode\n" \
 299 "\t\t0x0008 - Enable Park Mode\n",
 300 &hci_write_link_policy_settings
 301 },
 302 {
 303 NULL,
 304 }};
 305