sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.c

   1 /*
   2  * ng_l2cap_cmds.c
   3  */
   4
   5 /*-
   6  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   7  *
   8  * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
   9  * All rights reserved.
  10  *
  11  * Redistribution and use in source and binary forms, with or without
  12  * modification, are permitted provided that the following conditions
  13  * are met:
  14  * 1. Redistributions of source code must retain the above copyright
  15  *    notice, this list of conditions and the following disclaimer.
  16  * 2. Redistributions in binary form must reproduce the above copyright
  17  *    notice, this list of conditions and the following disclaimer in the
  18  *    documentation and/or other materials provided with the distribution.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  30  * SUCH DAMAGE.
  31  *
  32  * $Id: ng_l2cap_cmds.c,v 1.2 2003/09/08 19:11:45 max Exp $
  33  * $FreeBSD$
  34  */
  35
  36 #include <sys/param.h>
  37 #include <sys/systm.h>
  38 #include <sys/kernel.h>
  39 #include <sys/endian.h>
  40 #include <sys/malloc.h>
  41 #include <sys/mbuf.h>
  42 #include <sys/queue.h>
  43 #include <netgraph/ng_message.h>
  44 #include <netgraph/netgraph.h>
  45 #include <netgraph/bluetooth/include/ng_bluetooth.h>
  46 #include <netgraph/bluetooth/include/ng_hci.h>
  47 #include <netgraph/bluetooth/include/ng_l2cap.h>
  48 #include <netgraph/bluetooth/l2cap/ng_l2cap_var.h>
  49 #include <netgraph/bluetooth/l2cap/ng_l2cap_cmds.h>
  50 #include <netgraph/bluetooth/l2cap/ng_l2cap_evnt.h>
  51 #include <netgraph/bluetooth/l2cap/ng_l2cap_llpi.h>
  52 #include <netgraph/bluetooth/l2cap/ng_l2cap_ulpi.h>
  53 #include <netgraph/bluetooth/l2cap/ng_l2cap_misc.h>
  54
  55 /******************************************************************************
  56  ******************************************************************************
  57  **                    L2CAP commands processing module
  58  ******************************************************************************
  59  ******************************************************************************/
  60
  61 /*
  62  * Process L2CAP command queue on connection
  63  */
  64
  65 void
  66 ng_l2cap_con_wakeup(ng_l2cap_con_p con)
  67 {
  68         ng_l2cap_cmd_p   cmd = NULL;
  69         struct mbuf     *m = NULL;
  70         int              error = 0;
  71
  72         /* Find first non-pending command in the queue */
  73         TAILQ_FOREACH(cmd, &con->cmd_list, next) {
  74                 KASSERT((cmd->con == con),
  75 ("%s: %s - invalid connection pointer!\n",
  76                         __func__, NG_NODE_NAME(con->l2cap->node)));
  77
  78                 if (!(cmd->flags & NG_L2CAP_CMD_PENDING))
  79                         break;
  80         }
  81
  82         if (cmd == NULL)
  83                 return;
  84
  85         /* Detach command packet */
  86         m = cmd->aux;
  87         cmd->aux = NULL;
  88
  89         /* Process command */
  90         switch (cmd->code) {
  91         case NG_L2CAP_DISCON_RSP:
  92         case NG_L2CAP_ECHO_RSP:
  93         case NG_L2CAP_INFO_RSP:
  94                 /*
  95                  * Do not check return ng_l2cap_lp_send() value, because
  96                  * in these cases we do not really have a graceful way out.
  97                  * ECHO and INFO responses are internal to the stack and not
  98                  * visible to user. REJect is just being nice to remote end
  99                  * (otherwise remote end will timeout anyway). DISCON is
 100                  * probably most interesting here, however, if it fails
 101                  * there is nothing we can do anyway.
 102                  */
 103
 104                 (void) ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 105                 ng_l2cap_unlink_cmd(cmd);
 106                 ng_l2cap_free_cmd(cmd);
 107                 break;
 108         case NG_L2CAP_CMD_REJ:
 109                 (void) ng_l2cap_lp_send(con,
 110                                         (con->linktype == NG_HCI_LINK_ACL)?
 111                                         NG_L2CAP_SIGNAL_CID:
 112                                         NG_L2CAP_LESIGNAL_CID
 113                                         , m);
 114                 ng_l2cap_unlink_cmd(cmd);
 115                 ng_l2cap_free_cmd(cmd);
 116                 break;
 117
 118         case NG_L2CAP_CON_REQ:
 119                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 120                 if (error != 0) {
 121                         ng_l2cap_l2ca_con_rsp(cmd->ch, cmd->token,
 122                                 NG_L2CAP_NO_RESOURCES, 0);
 123                         ng_l2cap_free_chan(cmd->ch); /* will free commands */
 124                 } else
 125                         ng_l2cap_command_timeout(cmd,
 126                                 bluetooth_l2cap_rtx_timeout());
 127                 break;
 128         case NG_L2CAP_CON_RSP:
 129                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 130                 ng_l2cap_unlink_cmd(cmd);
 131                 if (cmd->ch != NULL) {
 132                         ng_l2cap_l2ca_con_rsp_rsp(cmd->ch, cmd->token,
 133                                 (error == 0)? NG_L2CAP_SUCCESS :
 134                                         NG_L2CAP_NO_RESOURCES);
 135                         if (error != 0)
 136                                 ng_l2cap_free_chan(cmd->ch);
 137                 }
 138                 ng_l2cap_free_cmd(cmd);
 139                 break;
 140
 141         case NG_L2CAP_CFG_REQ:
 142                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 143                 if (error != 0) {
 144                         ng_l2cap_l2ca_cfg_rsp(cmd->ch, cmd->token,
 145                                 NG_L2CAP_NO_RESOURCES);
 146                         ng_l2cap_unlink_cmd(cmd);
 147                         ng_l2cap_free_cmd(cmd);
 148                 } else
 149                         ng_l2cap_command_timeout(cmd,
 150                                 bluetooth_l2cap_rtx_timeout());
 151                 break;
 152
 153         case NG_L2CAP_CFG_RSP:
 154                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 155                 ng_l2cap_unlink_cmd(cmd);
 156                 if (cmd->ch != NULL)
 157                         ng_l2cap_l2ca_cfg_rsp_rsp(cmd->ch, cmd->token,
 158                                 (error == 0)? NG_L2CAP_SUCCESS :
 159                                         NG_L2CAP_NO_RESOURCES);
 160                 ng_l2cap_free_cmd(cmd);
 161                 break;
 162
 163         case NG_L2CAP_DISCON_REQ:
 164                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 165                 ng_l2cap_l2ca_discon_rsp(cmd->ch, cmd->token,
 166                         (error == 0)? NG_L2CAP_SUCCESS : NG_L2CAP_NO_RESOURCES);
 167                 if (error != 0)
 168                         ng_l2cap_free_chan(cmd->ch); /* XXX free channel */
 169                 else
 170                         ng_l2cap_command_timeout(cmd,
 171                                 bluetooth_l2cap_rtx_timeout());
 172                 break;
 173
 174         case NG_L2CAP_ECHO_REQ:
 175                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 176                 if (error != 0) {
 177                         ng_l2cap_l2ca_ping_rsp(con, cmd->token,
 178                                         NG_L2CAP_NO_RESOURCES, NULL);
 179                         ng_l2cap_unlink_cmd(cmd);
 180                         ng_l2cap_free_cmd(cmd);
 181                 } else
 182                         ng_l2cap_command_timeout(cmd,
 183                                 bluetooth_l2cap_rtx_timeout());
 184                 break;
 185
 186         case NG_L2CAP_INFO_REQ:
 187                 error = ng_l2cap_lp_send(con, NG_L2CAP_SIGNAL_CID, m);
 188                 if (error != 0) {
 189                         ng_l2cap_l2ca_get_info_rsp(con, cmd->token,
 190                                 NG_L2CAP_NO_RESOURCES, NULL);
 191                         ng_l2cap_unlink_cmd(cmd);
 192                         ng_l2cap_free_cmd(cmd);
 193                 } else
 194                         ng_l2cap_command_timeout(cmd,
 195                                 bluetooth_l2cap_rtx_timeout());
 196                 break;
 197
 198         case NGM_L2CAP_L2CA_WRITE: {
 199                 int     length = m->m_pkthdr.len;
 200
 201                 if (cmd->ch->dcid == NG_L2CAP_CLT_CID) {
 202                         m = ng_l2cap_prepend(m, sizeof(ng_l2cap_clt_hdr_t));
 203                         if (m == NULL)
 204                                 error = ENOBUFS;
 205                         else
 206                                 mtod(m, ng_l2cap_clt_hdr_t *)->psm =
 207                                                         htole16(cmd->ch->psm);
 208                 }
 209
 210                 if (error == 0)
 211                         error = ng_l2cap_lp_send(con, cmd->ch->dcid, m);
 212
 213                 ng_l2cap_l2ca_write_rsp(cmd->ch, cmd->token,
 214                         (error == 0)? NG_L2CAP_SUCCESS : NG_L2CAP_NO_RESOURCES,
 215                         length);
 216
 217                 ng_l2cap_unlink_cmd(cmd);
 218                 ng_l2cap_free_cmd(cmd);
 219                 } break;
 220         case NG_L2CAP_CMD_PARAM_UPDATE_RESPONSE:
 221                 error = ng_l2cap_lp_send(con, NG_L2CAP_LESIGNAL_CID, m);
 222                 ng_l2cap_unlink_cmd(cmd);
 223                 ng_l2cap_free_cmd(cmd);
 224                 break;
 225         case NG_L2CAP_CMD_PARAM_UPDATE_REQUEST:
 226                   /*TBD.*/
 227         /* XXX FIXME add other commands */
 228         default:
 229                 panic(
 230 "%s: %s - unknown command code=%d\n",
 231                         __func__, NG_NODE_NAME(con->l2cap->node), cmd->code);
 232                 break;
 233         }
 234 } /* ng_l2cap_con_wakeup */
 235
 236 /*
 237  * We have failed to open ACL connection to the remote unit. Could be negative
 238  * confirmation or timeout. So fail any "delayed" commands, notify upper layer,
 239  * remove all channels and remove connection descriptor.
 240  */
 241
 242 void
 243 ng_l2cap_con_fail(ng_l2cap_con_p con, u_int16_t result)
 244 {
 245         ng_l2cap_p      l2cap = con->l2cap;
 246         ng_l2cap_cmd_p  cmd = NULL;
 247         ng_l2cap_chan_p ch = NULL;
 248
 249         NG_L2CAP_INFO(
 250 "%s: %s - ACL connection failed, result=%d\n",
 251                 __func__, NG_NODE_NAME(l2cap->node), result);
 252
 253         /* Connection is dying */
 254         con->flags |= NG_L2CAP_CON_DYING;
 255
 256         /* Clean command queue */
 257         while (!TAILQ_EMPTY(&con->cmd_list)) {
 258                 cmd = TAILQ_FIRST(&con->cmd_list);
 259
 260                 ng_l2cap_unlink_cmd(cmd);
 261                 if(cmd->flags & NG_L2CAP_CMD_PENDING)
 262                         ng_l2cap_command_untimeout(cmd);
 263
 264                 KASSERT((cmd->con == con),
 265 ("%s: %s - invalid connection pointer!\n",
 266                         __func__, NG_NODE_NAME(l2cap->node)));
 267
 268                 switch (cmd->code) {
 269                 case NG_L2CAP_CMD_REJ:
 270                 case NG_L2CAP_DISCON_RSP:
 271                 case NG_L2CAP_ECHO_RSP:
 272                 case NG_L2CAP_INFO_RSP:
 273                 case NG_L2CAP_CMD_PARAM_UPDATE_RESPONSE:
 274                         break;
 275
 276                 case NG_L2CAP_CON_REQ:
 277                         ng_l2cap_l2ca_con_rsp(cmd->ch, cmd->token, result, 0);
 278                         break;
 279
 280                 case NG_L2CAP_CON_RSP:
 281                         if (cmd->ch != NULL)
 282                                 ng_l2cap_l2ca_con_rsp_rsp(cmd->ch, cmd->token,
 283                                         result);
 284                         break;
 285
 286                 case NG_L2CAP_CFG_REQ:
 287                 case NG_L2CAP_CFG_RSP:
 288                 case NGM_L2CAP_L2CA_WRITE:
 289                         ng_l2cap_l2ca_discon_ind(cmd->ch);
 290                         break;
 291
 292                 case NG_L2CAP_DISCON_REQ:
 293                         ng_l2cap_l2ca_discon_rsp(cmd->ch, cmd->token,
 294                                 NG_L2CAP_SUCCESS);
 295                         break;
 296
 297                 case NG_L2CAP_ECHO_REQ:
 298                         ng_l2cap_l2ca_ping_rsp(cmd->con, cmd->token,
 299                                 result, NULL);
 300                         break;
 301
 302                 case NG_L2CAP_INFO_REQ:
 303                         ng_l2cap_l2ca_get_info_rsp(cmd->con, cmd->token,
 304                                 result, NULL);
 305                         break;
 306
 307                 /* XXX FIXME add other commands */
 308
 309                 default:
 310                         panic(
 311 "%s: %s - unexpected command code=%d\n",
 312                                 __func__, NG_NODE_NAME(l2cap->node), cmd->code);
 313                         break;
 314                 }
 315
 316                 if (cmd->ch != NULL)
 317                         ng_l2cap_free_chan(cmd->ch);
 318
 319                 ng_l2cap_free_cmd(cmd);
 320         }
 321
 322         /*
 323          * There still might be channels (in OPEN state?) that
 324          * did not submit any commands, so disconnect them
 325          */
 326
 327         LIST_FOREACH(ch, &l2cap->chan_list, next)
 328                 if (ch->con == con)
 329                         ng_l2cap_l2ca_discon_ind(ch);
 330
 331         /* Free connection descriptor */
 332         ng_l2cap_free_con(con);
 333 } /* ng_l2cap_con_fail */
 334
 335 /*
 336  * Process L2CAP command timeout. In general - notify upper layer and destroy
 337  * channel. Do not pay much attention to return code, just do our best.
 338  */
 339
 340 void
 341 ng_l2cap_process_command_timeout(node_p node, hook_p hook, void *arg1, int arg2)
 342 {
 343         ng_l2cap_p      l2cap = NULL;
 344         ng_l2cap_con_p  con = NULL;
 345         ng_l2cap_cmd_p  cmd = NULL;
 346         u_int16_t       con_handle = (arg2 & 0x0ffff);
 347         u_int8_t        ident = ((arg2 >> 16) & 0xff);
 348
 349         if (NG_NODE_NOT_VALID(node)) {
 350                 printf("%s: Netgraph node is not valid\n", __func__);
 351                 return;
 352         }
 353
 354         l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node);
 355
 356         con = ng_l2cap_con_by_handle(l2cap, con_handle);
 357         if (con == NULL) {
 358                 NG_L2CAP_ALERT(
 359 "%s: %s - could not find connection, con_handle=%d\n",
 360                         __func__, NG_NODE_NAME(node), con_handle);
 361                 return;
 362         }
 363
 364         cmd = ng_l2cap_cmd_by_ident(con, ident);
 365         if (cmd == NULL) {
 366                 NG_L2CAP_ALERT(
 367 "%s: %s - could not find command, con_handle=%d, ident=%d\n",
 368                         __func__, NG_NODE_NAME(node), con_handle, ident);
 369                 return;
 370         }
 371
 372         cmd->flags &= ~NG_L2CAP_CMD_PENDING;
 373         ng_l2cap_unlink_cmd(cmd);
 374
 375         switch (cmd->code) {
 376         case NG_L2CAP_CON_REQ:
 377                 ng_l2cap_l2ca_con_rsp(cmd->ch, cmd->token, NG_L2CAP_TIMEOUT, 0);
 378                 ng_l2cap_free_chan(cmd->ch);
 379                 break;
 380
 381         case NG_L2CAP_CFG_REQ:
 382                 ng_l2cap_l2ca_cfg_rsp(cmd->ch, cmd->token, NG_L2CAP_TIMEOUT);
 383                 break;
 384
 385         case NG_L2CAP_DISCON_REQ:
 386                 ng_l2cap_l2ca_discon_rsp(cmd->ch, cmd->token, NG_L2CAP_TIMEOUT);
 387                 ng_l2cap_free_chan(cmd->ch); /* XXX free channel */
 388                 break;
 389
 390         case NG_L2CAP_ECHO_REQ:
 391                 /* Echo request timed out. Let the upper layer know */
 392                 ng_l2cap_l2ca_ping_rsp(cmd->con, cmd->token,
 393                         NG_L2CAP_TIMEOUT, NULL);
 394                 break;
 395
 396         case NG_L2CAP_INFO_REQ:
 397                 /* Info request timed out. Let the upper layer know */
 398                 ng_l2cap_l2ca_get_info_rsp(cmd->con, cmd->token,
 399                         NG_L2CAP_TIMEOUT, NULL);
 400                 break;
 401
 402         /* XXX FIXME add other commands */
 403
 404         default:
 405                 panic(
 406 "%s: %s - unexpected command code=%d\n",
 407                         __func__, NG_NODE_NAME(l2cap->node), cmd->code);
 408                 break;
 409         }
 410
 411         ng_l2cap_free_cmd(cmd);
 412 } /* ng_l2cap_process_command_timeout */
 413