Home | History | Annotate | Download | only in src
      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] + 3;
     44       break;
     45 
     46     case BT_EVT_TO_BTU_HCI_EVT:
     47       if (packet->len > 1)
     48         length = data[1] + 2;
     49       break;
     50 
     51     case BT_EVT_TO_LM_HCI_ACL:
     52     case BT_EVT_TO_BTU_HCI_ACL:
     53       if (packet->len > 3)
     54         length = (data[2] | (data[3] << 8)) + 4;
     55       break;
     56 
     57     case BT_EVT_TO_LM_HCI_SCO:
     58     case BT_EVT_TO_BTU_HCI_SCO:
     59       if (packet->len > 2)
     60         length = data[2] + 3;
     61       break;
     62   }
     63 
     64   if (length)
     65     (*data_callback)(type, data, length);
     66 }
     67