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
