mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-03-24 13:43:38 +00:00
Code Issues Packages Projects Releases Wiki Activity

msp432p401lp-cc256x: remove local hci_dump.c copy

Browse Source
This commit is contained in:
Matthias Ringwald 2020-11-26 23:08:10 +01:00
parent 6ea4c31d9c
commit 520b0a5f5f
1 changed files with 0 additions and 386 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

386
port/msp432p401lp-cc256x/hci_dump.c
View File

@ -1,386 +0,0 @@
/*
* Copyright (C) 2014 BlueKitchen GmbH
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of the copyright holders nor the names of
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
* 4. Any redistribution, use, or modification is done solely for
* personal benefit and not for any commercial purpose or for
* monetary gain.
*
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* Please inquire about commercial licensing options at
* contact@bluekitchen-gmbh.com
*
*/
#define __BTSTACK_FILE__ "hci_dump.c"
/*
* hci_dump.c
*
* Dump HCI trace in various formats:
*
* - BlueZ's hcidump format
* - Apple's PacketLogger
* - stdout hexdump
*
* Created by Matthias Ringwald on 5/26/09.
*/
#include "btstack_config.h"
#include "hci_dump.h"
#include "hci.h"
#include "hci_transport.h"
#include "hci_cmd.h"
#include "btstack_run_loop.h"
#include <stdio.h>
#ifdef HAVE_POSIX_FILE_IO
#include <fcntl.h> // open
#include <unistd.h> // write
#include <time.h>
#include <sys/time.h> // for timestamps
#include <sys/stat.h> // for mode flags
#endif
#ifdef ENABLE_SEGGER_RTT
#include "SEGGER_RTT.h"
int SEGGER_RTT_vprintf(unsigned BufferIndex, const char * sFormat, va_list * pParamList);
#endif
// BLUEZ hcidump - struct not used directly, but left here as documentation
typedef struct {
uint16_t len;
uint8_t in;
uint8_t pad;
uint32_t ts_sec;
uint32_t ts_usec;
uint8_t packet_type;
}
hcidump_hdr;
#define HCIDUMP_HDR_SIZE 13
// APPLE PacketLogger - struct not used directly, but left here as documentation
typedef struct {
uint32_t len;
uint32_t ts_sec;
uint32_t ts_usec;
uint8_t type; // 0xfc for note
}
pktlog_hdr;
#define PKTLOG_HDR_SIZE 13
static int dump_file = -1;
#ifdef HAVE_POSIX_FILE_IO
static int dump_format;
static uint8_t header_bluez[HCIDUMP_HDR_SIZE];
static uint8_t header_packetlogger[PKTLOG_HDR_SIZE];
static char time_string[40];
static int max_nr_packets = -1;
static int nr_packets = 0;
static char log_message_buffer[256];
#endif
// levels: debug, info, error
static int log_level_enabled[3] = { 1, 1, 1};
void hci_dump_open(const char *filename, hci_dump_format_t format){
#ifdef HAVE_POSIX_FILE_IO
dump_format = format;
if (dump_format == HCI_DUMP_STDOUT) {
dump_file = fileno(stdout);
} else {
int oflags = O_WRONLY | O_CREAT | O_TRUNC;
#ifdef _WIN32
oflags |= O_BINARY;
#endif
dump_file = open(filename, oflags, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH );
if (dump_file < 0){
printf("hci_dump_open: failed to open file %s\n", filename);
}
}
#else
UNUSED(filename);
UNUSED(format);
dump_file = 1;
#endif
}
#ifdef HAVE_POSIX_FILE_IO
void hci_dump_set_max_packets(int packets){
max_nr_packets = packets;
}
#endif
#ifdef ENABLE_SEGGER_RTT
static void printf_packet(uint8_t packet_type, uint8_t in, uint8_t * packet, uint16_t len){
switch (packet_type){
case HCI_COMMAND_DATA_PACKET:
SEGGER_RTT_printf(0, "CMD => ");
break;
case HCI_EVENT_PACKET:
SEGGER_RTT_printf(0, "EVT <= ");
break;
case HCI_ACL_DATA_PACKET:
if (in) {
SEGGER_RTT_printf(0, "ACL <= ");
} else {
SEGGER_RTT_printf(0, "ACL => ");
}
break;
case HCI_SCO_DATA_PACKET:
if (in) {
SEGGER_RTT_printf(0, "SCO <= ");
} else {
SEGGER_RTT_printf(0, "SCO => ");
}
break;
case LOG_MESSAGE_PACKET:
SEGGER_RTT_printf(0, "LOG -- %s\n", (char*) packet);
return;
default:
return;
}
// printf_hexdump(packet, len);
uint16_t pos;
for (pos=0;pos<len;pos++){
SEGGER_RTT_printf(0, "%02x ", *packet++);
}
SEGGER_RTT_printf(0, "\n");
}
#else
static void printf_packet(uint8_t packet_type, uint8_t in, uint8_t * packet, uint16_t len){
switch (packet_type){
case HCI_COMMAND_DATA_PACKET:
printf("CMD => ");
break;
case HCI_EVENT_PACKET:
printf("EVT <= ");
break;
case HCI_ACL_DATA_PACKET:
if (in) {
printf("ACL <= ");
} else {
printf("ACL => ");
}
break;
case HCI_SCO_DATA_PACKET:
if (in) {
printf("SCO <= ");
} else {
printf("SCO => ");
}
break;
case LOG_MESSAGE_PACKET:
printf("LOG -- %s\n", (char*) packet);
return;
default:
return;
}
printf_hexdump(packet, len);
}
#endif
static void printf_timestamp(void){
#ifdef HAVE_POSIX_FILE_IO
struct tm* ptm;
struct timeval curr_time;
gettimeofday(&curr_time, NULL);
time_t curr_time_secs = curr_time.tv_sec;
/* Obtain the time of day, and convert it to a tm struct. */
ptm = localtime (&curr_time_secs);
/* assert localtime was successful */
if (!ptm) return;
/* Format the date and time, down to a single second. */
strftime (time_string, sizeof (time_string), "[%Y-%m-%d %H:%M:%S", ptm);
/* Compute milliseconds from microseconds. */
uint16_t milliseconds = curr_time.tv_usec / 1000;
/* Print the formatted time, in seconds, followed by a decimal point and the milliseconds. */
printf ("%s.%03u] ", time_string, milliseconds);
#else
uint32_t time_ms = btstack_run_loop_get_time_ms();
int seconds = time_ms / 1000;
int minutes = seconds / 60;
unsigned int hours = minutes / 60;
uint16_t p_ms = time_ms - (seconds * 1000);
uint16_t p_seconds = seconds - (minutes * 60);
uint16_t p_minutes = minutes - (hours * 60);
#ifdef ENABLE_SEGGER_RTT
SEGGER_RTT_printf(0, "[%02u:%02u:%02u.%03u] ", hours, p_minutes, p_seconds, p_ms);
#else
printf("[%02u:%02u:%02u.%03u] ", hours, p_minutes, p_seconds, p_ms);
#endif
#endif
}
void hci_dump_packet(uint8_t packet_type, uint8_t in, uint8_t *packet, uint16_t len) {
if (dump_file < 0) return; // not activated yet
#ifdef HAVE_POSIX_FILE_IO
// don't grow bigger than max_nr_packets
if (dump_format != HCI_DUMP_STDOUT && max_nr_packets > 0){
if (nr_packets >= max_nr_packets){
lseek(dump_file, 0, SEEK_SET);
ftruncate(dump_file, 0);
nr_packets = 0;
}
nr_packets++;
}
// get time
struct timeval curr_time;
gettimeofday(&curr_time, NULL);
switch (dump_format){
case HCI_DUMP_STDOUT: {
printf_timestamp();
printf_packet(packet_type, in, packet, len);
break;
}
case HCI_DUMP_BLUEZ:
little_endian_store_16( header_bluez, 0, 1 + len);
header_bluez[2] = in;
header_bluez[3] = 0;
little_endian_store_32( header_bluez, 4, (uint32_t) curr_time.tv_sec);
little_endian_store_32( header_bluez, 8, curr_time.tv_usec);
header_bluez[12] = packet_type;
write (dump_file, header_bluez, HCIDUMP_HDR_SIZE);
write (dump_file, packet, len );
break;
case HCI_DUMP_PACKETLOGGER:
big_endian_store_32( header_packetlogger, 0, PKTLOG_HDR_SIZE - 4 + len);
big_endian_store_32( header_packetlogger, 4, (uint32_t) curr_time.tv_sec);
big_endian_store_32( header_packetlogger, 8, curr_time.tv_usec);
switch (packet_type){
case HCI_COMMAND_DATA_PACKET:
header_packetlogger[12] = 0x00;
break;
case HCI_ACL_DATA_PACKET:
if (in) {
header_packetlogger[12] = 0x03;
} else {
header_packetlogger[12] = 0x02;
}
break;
case HCI_SCO_DATA_PACKET:
if (in) {
header_packetlogger[12] = 0x09;
} else {
header_packetlogger[12] = 0x08;
}
break;
case HCI_EVENT_PACKET:
header_packetlogger[12] = 0x01;
break;
case LOG_MESSAGE_PACKET:
header_packetlogger[12] = 0xfc;
break;
default:
return;
}
write (dump_file, &header_packetlogger, PKTLOG_HDR_SIZE);
write (dump_file, packet, len );
break;
default:
break;
}
#else
printf_timestamp();
printf_packet(packet_type, in, packet, len);
#endif
}
static int hci_dump_log_level_active(int log_level){
if (log_level < HCI_DUMP_LOG_LEVEL_DEBUG) return 0;
if (log_level > HCI_DUMP_LOG_LEVEL_ERROR) return 0;
return log_level_enabled[log_level];
}
void hci_dump_log_va_arg(int log_level, const char * format, va_list argptr){
if (!hci_dump_log_level_active(log_level)) return;
#ifdef HAVE_POSIX_FILE_IO
if (dump_file >= 0){
int len = vsnprintf(log_message_buffer, sizeof(log_message_buffer), format, argptr);
hci_dump_packet(LOG_MESSAGE_PACKET, 0, (uint8_t*) log_message_buffer, len);
return;
}
#endif
printf_timestamp();
#ifdef ENABLE_SEGGER_RTT
SEGGER_RTT_printf(0, "LOG -- ");
SEGGER_RTT_vprintf(0, format, &argptr);
SEGGER_RTT_printf(0, "\n");
#else
printf("LOG -- ");
vprintf(format, argptr);
printf("\n");
#endif
}
void hci_dump_log(int log_level, const char * format, ...){
va_list argptr;
va_start(argptr, format);
hci_dump_log_va_arg(log_level, format, argptr);
va_end(argptr);
}
#ifdef __AVR__
void hci_dump_log_P(int log_level, PGM_P format, ...){
if (!hci_dump_log_level_active(log_level)) return;
va_list argptr;
va_start(argptr, format);
printf_P(PSTR("LOG -- "));
vfprintf_P(stdout, format, argptr);
printf_P(PSTR("\n"));
va_end(argptr);
}
#endif
void hci_dump_close(void){
#ifdef HAVE_POSIX_FILE_IO
close(dump_file);
#endif
dump_file = -1;
}
void hci_dump_enable_log_level(int log_level, int enable){
if (log_level < HCI_DUMP_LOG_LEVEL_DEBUG) return;
if (log_level > HCI_DUMP_LOG_LEVEL_ERROR) return;
log_level_enabled[log_level] = enable;
}