| /****************************************************************************** |
| * |
| * Copyright (C) 1999-2012 Broadcom Corporation |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| * |
| ******************************************************************************/ |
| #include "_OverrideLog.h" |
| |
| #include "android_logmsg.h" |
| #include "nfc_target.h" |
| #include "buildcfg.h" |
| #include <cutils/log.h> |
| |
| |
| extern uint32_t ScrProtocolTraceFlag; |
| #define MAX_NCI_PACKET_SIZE 259 |
| #define BTE_LOG_BUF_SIZE 1024 |
| #define BTE_LOG_MAX_SIZE (BTE_LOG_BUF_SIZE - 12) |
| #define MAX_LOGCAT_LINE 4096 |
| #define PRINT(s) __android_log_write (ANDROID_LOG_DEBUG, "BrcmNci", s) |
| static char log_line [MAX_LOGCAT_LINE]; |
| static const char* sTable = "0123456789abcdef"; |
| static bool sIsUseRaw = FALSE; |
| static void ToHex (const uint8_t* data, uint16_t len, char* hexString, uint16_t hexStringSize); |
| static void dumpbin (const char* data, int size, uint32_t trace_layer, uint32_t trace_type); |
| static inline void word2hex (const char* data, char** hex); |
| static inline void byte2char (const char* data, char** str); |
| static inline void byte2hex (const char* data, char** str); |
| |
| |
| void BTDISP_LOCK_LOG() |
| { |
| } |
| |
| |
| void BTDISP_UNLOCK_LOG() |
| { |
| } |
| |
| |
| void BTDISP_INIT_LOCK() |
| { |
| } |
| |
| |
| void BTDISP_UNINIT_LOCK() |
| { |
| } |
| |
| |
| void ProtoDispAdapterUseRawOutput (bool isUseRaw) |
| { |
| sIsUseRaw = isUseRaw; |
| } |
| |
| |
| void ProtoDispAdapterDisplayNciPacket (uint8_t *nciPacket, uint16_t nciPacketLen, bool is_recv) |
| { |
| //Protocol decoder is not available, so decode NCI packet into hex numbers. |
| if (!(ScrProtocolTraceFlag & SCR_PROTO_TRACE_NCI)) |
| return; |
| char line_buf [(MAX_NCI_PACKET_SIZE*2)+1]; |
| ToHex (nciPacket, nciPacketLen, line_buf, sizeof(line_buf)); |
| __android_log_write (ANDROID_LOG_DEBUG, (is_recv) ? "BrcmNciR": "BrcmNciX", line_buf); |
| } |
| |
| |
| void ToHex (const uint8_t* data, uint16_t len, char* hexString, uint16_t hexStringSize) |
| { |
| int i=0, j=0; |
| for(i = 0, j = 0; i < len && j < hexStringSize-3; i++) |
| { |
| hexString [j++] = sTable [(*data >> 4) & 0xf]; |
| hexString [j++] = sTable [*data & 0xf]; |
| data++; |
| } |
| hexString [j] = '\0'; |
| } |
| |
| |
| //Protodisp code calls ScrLog() to print decoded texts. |
| void ScrLog (uint32_t trace_set_mask, const char *fmt_str, ...) |
| { |
| static char buffer [BTE_LOG_BUF_SIZE]; |
| va_list ap; |
| |
| va_start (ap, fmt_str); |
| vsnprintf (buffer, BTE_LOG_MAX_SIZE, fmt_str, ap); |
| va_end (ap); |
| __android_log_write(ANDROID_LOG_INFO, "BrcmNci", buffer); |
| } |
| |
| |
| uint8_t *scru_dump_hex (uint8_t *p, char *pTitle, uint32_t len, uint32_t layer, uint32_t type) |
| { |
| if(pTitle && *pTitle) |
| PRINT(pTitle); |
| dumpbin((char*) p, len, layer, type); |
| return p; |
| } |
| |
| |
| void dumpbin(const char* data, int size, uint32_t trace_layer, uint32_t trace_type) |
| { |
| char line_buff[256]; |
| char *line; |
| int i, j, addr; |
| const int width = 16; |
| if(size <= 0) |
| return; |
| for(i = 0; i < size / width; i++) |
| { |
| line = line_buff; |
| //write address: |
| addr = i*width; |
| word2hex((const char*)&addr, &line); |
| *line++ = ':'; *line++ = ' '; |
| //write hex of data |
| for(j = 0; j < width; j++) |
| { |
| byte2hex(&data[j], &line); |
| *line++ = ' '; |
| } |
| //write char of data |
| for(j = 0; j < width; j++) |
| byte2char(data++, &line); |
| //wirte the end of line |
| *line = 0; |
| //output the line |
| PRINT(line_buff); |
| } |
| //last line of left over if any |
| int leftover = size % width; |
| if(leftover > 0) |
| { |
| line = line_buff; |
| //write address: |
| addr = i*width; |
| word2hex((const char*)&addr, &line); |
| *line++ = ':'; *line++ = ' '; |
| //write hex of data |
| for(j = 0; j < leftover; j++) |
| { |
| byte2hex(&data[j], &line); |
| *line++ = ' '; |
| } |
| //write hex padding |
| for(; j < width; j++) |
| { |
| *line++ = ' '; |
| *line++ = ' '; |
| *line++ = ' '; |
| } |
| //write char of data |
| for(j = 0; j < leftover; j++) |
| byte2char(data++, &line); |
| //write the end of line |
| *line = 0; |
| //output the line |
| PRINT(line_buff); |
| } |
| } |
| |
| |
| inline void word2hex (const char* data, char** hex) |
| { |
| byte2hex(&data[1], hex); |
| byte2hex(&data[0], hex); |
| } |
| |
| |
| inline void byte2char (const char* data, char** str) |
| { |
| **str = *data < ' ' ? '.' : *data > '~' ? '.' : *data; |
| ++(*str); |
| } |
| |
| |
| inline void byte2hex (const char* data, char** str) |
| { |
| **str = sTable[(*data >> 4) & 0xf]; |
| ++*str; |
| **str = sTable[*data & 0xf]; |
| ++*str; |
| } |
| |
| |
| //Decode a few Bluetooth HCI packets into hex numbers. |
| void DispHciCmd (NFC_HDR *p_buf) |
| { |
| uint32_t nBytes = ((NFC_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1; |
| uint8_t* data = (uint8_t*) p_buf; |
| int data_len = NFC_HDR_SIZE + p_buf->offset + p_buf->len; |
| |
| if (appl_trace_level < BT_TRACE_LEVEL_DEBUG) |
| return; |
| |
| if (nBytes > sizeof(log_line)) |
| return; |
| |
| ToHex (data, data_len, log_line, sizeof(log_line)); |
| __android_log_write (ANDROID_LOG_DEBUG, "BrcmHciX", log_line); |
| } |
| |
| |
| //Decode a few Bluetooth HCI packets into hex numbers. |
| void DispHciEvt (NFC_HDR *p_buf) |
| { |
| uint32_t nBytes = ((NFC_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1; |
| uint8_t* data = (uint8_t*) p_buf; |
| int data_len = NFC_HDR_SIZE + p_buf->offset + p_buf->len; |
| |
| if (appl_trace_level < BT_TRACE_LEVEL_DEBUG) |
| return; |
| |
| if (nBytes > sizeof(log_line)) |
| return; |
| |
| ToHex (data, data_len, log_line, sizeof(log_line)); |
| __android_log_write (ANDROID_LOG_DEBUG, "BrcmHciR", log_line); |
| } |
| |
| |
| /*************************************************************************** |
| ** |
| ** Function DispLLCP |
| ** |
| ** Description Log LLCP packet as hex-ascii bytes. |
| ** |
| ** Returns None. |
| ** |
| ***************************************************************************/ |
| void DispLLCP (NFC_HDR *p_buf, bool is_recv) |
| { |
| uint32_t nBytes = ((NFC_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1; |
| uint8_t * data = (uint8_t*) p_buf; |
| int data_len = NFC_HDR_SIZE + p_buf->offset + p_buf->len; |
| |
| if (appl_trace_level < BT_TRACE_LEVEL_DEBUG) |
| return; |
| |
| if (nBytes > sizeof(log_line)) |
| return; |
| |
| ToHex (data, data_len, log_line, sizeof(log_line)); |
| __android_log_write (ANDROID_LOG_DEBUG, (is_recv) ? "BrcmLlcpR": "BrcmLlcpX", log_line); |
| } |
| |
| |
| /*************************************************************************** |
| ** |
| ** Function DispHcp |
| ** |
| ** Description Log raw HCP packet as hex-ascii bytes |
| ** |
| ** Returns None. |
| ** |
| ***************************************************************************/ |
| void DispHcp (uint8_t *data, uint16_t len, bool is_recv) |
| { |
| uint32_t nBytes = (len*2)+1; |
| |
| if (appl_trace_level < BT_TRACE_LEVEL_DEBUG) |
| return; |
| |
| // Only trace HCP if we're tracing HCI as well |
| if (!(ScrProtocolTraceFlag & SCR_PROTO_TRACE_HCI_SUMMARY)) |
| return; |
| |
| if (nBytes > sizeof(log_line)) |
| return; |
| |
| ToHex (data, len, log_line, sizeof(log_line)); |
| __android_log_write (ANDROID_LOG_DEBUG, (is_recv) ? "BrcmHcpR": "BrcmHcpX", log_line); |
| } |
| |
| |
| void DispSNEP (uint8_t local_sap, uint8_t remote_sap, NFC_HDR *p_buf, bool is_first, bool is_rx) {} |
| void DispCHO (uint8_t *pMsg, uint32_t MsgLen, bool is_rx) {} |
| void DispT3TagMessage(NFC_HDR *p_msg, bool is_rx) {} |
| void DispRWT4Tags (NFC_HDR *p_buf, bool is_rx) {} |
| void DispCET4Tags (NFC_HDR *p_buf, bool is_rx) {} |
| void DispRWI93Tag (NFC_HDR *p_buf, bool is_rx, uint8_t command_to_respond) {} |
| void DispNDEFMsg (uint8_t *pMsg, uint32_t MsgLen, bool is_recv) {} |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function: LogMsg |
| ** |
| ** Description: Print messages from NFC stack. |
| ** |
| ** Returns: None. |
| ** |
| *******************************************************************************/ |
| void LogMsg (uint32_t trace_set_mask, const char *fmt_str, ...) |
| { |
| static char buffer [BTE_LOG_BUF_SIZE]; |
| va_list ap; |
| uint32_t trace_type = trace_set_mask & 0x07; //lower 3 bits contain trace type |
| int android_log_type = ANDROID_LOG_INFO; |
| |
| va_start (ap, fmt_str); |
| vsnprintf (buffer, BTE_LOG_MAX_SIZE, fmt_str, ap); |
| va_end (ap); |
| if (trace_type == TRACE_TYPE_ERROR) |
| android_log_type = ANDROID_LOG_ERROR; |
| __android_log_write (android_log_type, LOGMSG_TAG_NAME, buffer); |
| } |
| |
| |
| void LogMsg_0 (uint32_t maskTraceSet, const char *p_str) |
| { |
| LogMsg (maskTraceSet, p_str); |
| } |
| |
| |
| void LogMsg_1 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1); |
| } |
| |
| |
| void LogMsg_2 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1, uintptr_t p2) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1, p2); |
| } |
| |
| |
| void LogMsg_3 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1, uintptr_t p2, uintptr_t p3) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1, p2, p3); |
| } |
| |
| |
| void LogMsg_4 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1, uintptr_t p2, uintptr_t p3, uintptr_t p4) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4); |
| } |
| |
| void LogMsg_5 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1, uintptr_t p2, uintptr_t p3, uintptr_t p4, uintptr_t p5) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4, p5); |
| } |
| |
| |
| void LogMsg_6 (uint32_t maskTraceSet, const char *fmt_str, uintptr_t p1, uintptr_t p2, uintptr_t p3, uintptr_t p4, uintptr_t p5, uintptr_t p6) |
| { |
| LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4, p5, p6); |
| } |