360 lines
10 KiB
C++
360 lines
10 KiB
C++
/******************************************************************************
|
|
*
|
|
* 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 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 BOOLEAN sIsUseRaw = FALSE;
|
|
static void ToHex (const UINT8* data, UINT16 len, char* hexString, UINT16 hexStringSize);
|
|
static void dumpbin (const char* data, int size, UINT32 trace_layer, UINT32 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 (BOOLEAN isUseRaw)
|
|
{
|
|
sIsUseRaw = isUseRaw;
|
|
}
|
|
|
|
|
|
void ProtoDispAdapterDisplayNciPacket (UINT8 *nciPacket, UINT16 nciPacketLen, BOOLEAN 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* data, UINT16 len, char* hexString, UINT16 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 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 *scru_dump_hex (UINT8 *p, char *pTitle, UINT32 len, UINT32 layer, UINT32 type)
|
|
{
|
|
if(pTitle && *pTitle)
|
|
PRINT(pTitle);
|
|
dumpbin((char*) p, len, layer, type);
|
|
return p;
|
|
}
|
|
|
|
|
|
void dumpbin(const char* data, int size, UINT32 trace_layer, UINT32 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 (BT_HDR *p_buf)
|
|
{
|
|
UINT32 nBytes = ((BT_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1;
|
|
UINT8* data = (UINT8*) p_buf;
|
|
int data_len = BT_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 (BT_HDR *p_buf)
|
|
{
|
|
UINT32 nBytes = ((BT_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1;
|
|
UINT8* data = (UINT8*) p_buf;
|
|
int data_len = BT_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 (BT_HDR *p_buf, BOOLEAN is_recv)
|
|
{
|
|
UINT32 nBytes = ((BT_HDR_SIZE + p_buf->offset + p_buf->len)*2)+1;
|
|
UINT8 * data = (UINT8*) p_buf;
|
|
int data_len = BT_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 *data, UINT16 len, BOOLEAN is_recv)
|
|
{
|
|
UINT32 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 local_sap, UINT8 remote_sap, BT_HDR *p_buf, BOOLEAN is_first, BOOLEAN is_rx) {}
|
|
void DispCHO (UINT8 *pMsg, UINT32 MsgLen, BOOLEAN is_rx) {}
|
|
void DispT3TagMessage(BT_HDR *p_msg, BOOLEAN is_rx) {}
|
|
void DispRWT4Tags (BT_HDR *p_buf, BOOLEAN is_rx) {}
|
|
void DispCET4Tags (BT_HDR *p_buf, BOOLEAN is_rx) {}
|
|
void DispRWI93Tag (BT_HDR *p_buf, BOOLEAN is_rx, UINT8 command_to_respond) {}
|
|
void DispNDEFMsg (UINT8 *pMsg, UINT32 MsgLen, BOOLEAN is_recv) {}
|
|
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: LogMsg
|
|
**
|
|
** Description: Print messages from NFC stack.
|
|
**
|
|
** Returns: None.
|
|
**
|
|
*******************************************************************************/
|
|
void LogMsg (UINT32 trace_set_mask, const char *fmt_str, ...)
|
|
{
|
|
static char buffer [BTE_LOG_BUF_SIZE];
|
|
va_list ap;
|
|
UINT32 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 maskTraceSet, const char *p_str)
|
|
{
|
|
LogMsg (maskTraceSet, p_str);
|
|
}
|
|
|
|
|
|
void LogMsg_1 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1);
|
|
}
|
|
|
|
|
|
void LogMsg_2 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1, UINT32 p2)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1, p2);
|
|
}
|
|
|
|
|
|
void LogMsg_3 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1, UINT32 p2, UINT32 p3)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1, p2, p3);
|
|
}
|
|
|
|
|
|
void LogMsg_4 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1, UINT32 p2, UINT32 p3, UINT32 p4)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4);
|
|
}
|
|
|
|
void LogMsg_5 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1, UINT32 p2, UINT32 p3, UINT32 p4, UINT32 p5)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4, p5);
|
|
}
|
|
|
|
|
|
void LogMsg_6 (UINT32 maskTraceSet, const char *fmt_str, UINT32 p1, UINT32 p2, UINT32 p3, UINT32 p4, UINT32 p5, UINT32 p6)
|
|
{
|
|
LogMsg (maskTraceSet, fmt_str, p1, p2, p3, p4, p5, p6);
|
|
}
|