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 #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