/*
|
* Copyright (C) 2015 Spreadtrum Communications Inc.
|
*
|
* This software is licensed under the terms of the GNU General Public
|
* License version 2, as published by the Free Software Foundation, and
|
* may be copied, distributed, and modified under those terms.
|
*
|
* This program is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* GNU General Public License for more details.
|
*/
|
|
#include <linux/vmalloc.h>
|
#include "dump.h"
|
|
extern bt_host_data_dump *data_dump;
|
|
static void data_left_shift(unsigned char data_inout)
|
{
|
unsigned char loop_count_i = 0;
|
switch (data_inout) {
|
case BT_DATA_OUT:
|
for (; loop_count_i < BT_MAX_DUMP_FRAME_LEN - 1; loop_count_i++) {
|
memcpy(data_dump->txtime_t + loop_count_i, data_dump->txtime_t + loop_count_i + 1, sizeof(bt_host_time));
|
memcpy(data_dump->tx[loop_count_i], data_dump->tx[loop_count_i + 1], BT_MAX_DUMP_DATA_LEN);
|
}
|
break;
|
case BT_DATA_IN:
|
for (; loop_count_i < BT_MAX_DUMP_FRAME_LEN - 1; loop_count_i++) {
|
memcpy(data_dump->rxtime_t + loop_count_i, data_dump->rxtime_t + loop_count_i + 1, sizeof(bt_host_time));
|
memcpy(data_dump->rx[loop_count_i], data_dump->rx[loop_count_i + 1], BT_MAX_DUMP_DATA_LEN);
|
}
|
break;
|
default:
|
break;
|
}
|
}
|
|
static void get_time(unsigned char data_inout)
|
{
|
struct timespec64 now;
|
|
ktime_get_real_ts64(&now);
|
switch (data_inout) {
|
case BT_DATA_OUT:
|
data_dump->txtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_sec = now.tv_sec;
|
data_dump->txtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_nsec = now.tv_nsec;
|
rtc_time64_to_tm(data_dump->txtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_sec,
|
&(data_dump->txtime_t[BT_MAX_DUMP_FRAME_LEN - 1].rtc_t));
|
break;
|
case BT_DATA_IN:
|
data_dump->rxtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_sec = now.tv_sec;
|
data_dump->rxtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_nsec = now.tv_nsec;
|
rtc_time64_to_tm(data_dump->rxtime_t[BT_MAX_DUMP_FRAME_LEN - 1].tv.tv_sec,
|
&(data_dump->rxtime_t[BT_MAX_DUMP_FRAME_LEN - 1].rtc_t));
|
break;
|
default:
|
break;
|
}
|
}
|
|
void bt_host_data_save(const unsigned char *buf, int count, unsigned char data_inout)
|
{
|
if (data_dump == NULL)
|
return;
|
if ((buf[0] == HCI_COMMAND) ||
|
((buf[0] == HCI_EVENT) && (buf[1] == HCI_COMMAND_STATUS)) ||
|
((buf[0] == HCI_EVENT) && (buf[1] == HCI_COMMAND_COMPELET))) {
|
pr_debug("bt_host_data_save: data %d \n", data_inout);
|
data_left_shift(data_inout);
|
get_time(data_inout);
|
} else {
|
return;
|
}
|
|
if (count <= BT_MAX_DUMP_DATA_LEN) {
|
switch (data_inout) {
|
case BT_DATA_OUT:
|
memset(data_dump->tx[BT_MAX_DUMP_FRAME_LEN - 1], 0, BT_MAX_DUMP_DATA_LEN);
|
memcpy(data_dump->tx[BT_MAX_DUMP_FRAME_LEN - 1], buf, count);
|
break;
|
case BT_DATA_IN:
|
memset(data_dump->rx[BT_MAX_DUMP_FRAME_LEN - 1], 0, BT_MAX_DUMP_DATA_LEN);
|
memcpy(data_dump->rx[BT_MAX_DUMP_FRAME_LEN - 1], buf, count);
|
break;
|
default:
|
break;
|
}
|
} else {
|
switch (data_inout) {
|
case BT_DATA_OUT:
|
memcpy(data_dump->tx[BT_MAX_DUMP_FRAME_LEN - 1], buf, BT_MAX_DUMP_DATA_LEN);
|
break;
|
case BT_DATA_IN:
|
memcpy(data_dump->rx[BT_MAX_DUMP_FRAME_LEN - 1], buf, BT_MAX_DUMP_DATA_LEN);
|
break;
|
default:
|
break;
|
}
|
}
|
}
|
|
void bt_host_data_printf(void)
|
{
|
unsigned char loop_count_i = 0, loop_count_j = 0;
|
for (; loop_count_j < BT_MAX_DUMP_FRAME_LEN; loop_count_j++) {
|
printk("bt_host_data_printf txdata[%d]: ", loop_count_j + 1);
|
printk("%d-%d-%d %d:%d:%d.%06ld ", 1900 + data_dump->txtime_t[loop_count_j].rtc_t.tm_year,
|
1 + data_dump->txtime_t[loop_count_j].rtc_t.tm_mon, data_dump->txtime_t[loop_count_j].rtc_t.tm_mday,
|
data_dump->txtime_t[loop_count_j].rtc_t.tm_hour, data_dump->txtime_t[loop_count_j].rtc_t.tm_min,
|
data_dump->txtime_t[loop_count_j].rtc_t.tm_sec, data_dump->txtime_t[loop_count_j].tv.tv_nsec * 1000);
|
while (loop_count_i < BT_MAX_DUMP_DATA_LEN) {
|
printk("%02X ", data_dump->tx[loop_count_j][loop_count_i++]);
|
}
|
printk("\n");
|
loop_count_i = 0;
|
}
|
|
loop_count_j = 0;
|
for (; loop_count_j < BT_MAX_DUMP_FRAME_LEN; loop_count_j++) {
|
printk("bt_host_data_printf rxdata[%d]: ", loop_count_j + 1);
|
printk("%d-%d-%d %d:%d:%d.%06ld ", 1900 + data_dump->rxtime_t[loop_count_j].rtc_t.tm_year,
|
1 + data_dump->rxtime_t[loop_count_j].rtc_t.tm_mon, data_dump->rxtime_t[loop_count_j].rtc_t.tm_mday,
|
data_dump->rxtime_t[loop_count_j].rtc_t.tm_hour, data_dump->rxtime_t[loop_count_j].rtc_t.tm_min,
|
data_dump->rxtime_t[loop_count_j].rtc_t.tm_sec, data_dump->rxtime_t[loop_count_j].tv.tv_nsec * 1000);
|
while (loop_count_i < BT_MAX_DUMP_DATA_LEN) {
|
printk("%02X ", data_dump->rx[loop_count_j][loop_count_i++]);
|
}
|
printk("\n");
|
loop_count_i = 0;
|
}
|
}
|
