hci/src/btsnoop_mem.c

   1 /******************************************************************************
   2  *
   3  *  Copyright (C) 2015 Google Inc.
   4  *
   5  *  Licensed under the Apache License, Version 2.0 (the "License");
   6  *  you may not use this file except in compliance with the License.
   7  *  You may obtain a copy of the License at:
   8  *
   9  *  http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  *  Unless required by applicable law or agreed to in writing, software
  12  *  distributed under the License is distributed on an "AS IS" BASIS,
  13  *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  *  See the License for the specific language governing permissions and
  15  *  limitations under the License.
  16  *
  17  ******************************************************************************/
  18
  19 #include <assert.h>
  20 #include <time.h>
  21
  22 #include "hci/include/btsnoop_mem.h"
  23
  24 static btsnoop_data_cb data_callback = NULL;
  25
  26 void btsnoop_mem_set_callback(btsnoop_data_cb cb) {
  27   data_callback = cb;
  28 }
  29
  30 void btsnoop_mem_capture(const BT_HDR *packet) {
  31   if (!data_callback)
  32     return;
  33
  34   assert(packet);
  35
  36   const uint8_t *data = &packet->data[packet->offset];
  37   const uint16_t type = packet->event & BT_EVT_MASK;
  38   size_t length = 0;
  39
  40   switch (type) {
  41     case BT_EVT_TO_LM_HCI_CMD:
  42       if (packet->len > 2)
  43         length = data[2] + 4;
  44       break;
  45
  46     case BT_EVT_TO_BTU_HCI_EVT:
  47       if (packet->len > 1)
  48         length = data[1] + 3;
  49       break;
  50
  51     // Ignore data for privacy
  52     case BT_EVT_TO_LM_HCI_ACL:
  53     case BT_EVT_TO_LM_HCI_SCO:
  54     case BT_EVT_TO_BTU_HCI_ACL:
  55     case BT_EVT_TO_BTU_HCI_SCO:
  56       break;
  57   }
  58
  59   if (length)
  60     (*data_callback)(type, data, length);
  61 }