void dispatch_packet(const void *packet, int len) {
//if (write(filefd, packet, len) > 0)
printf_packet((const unsigned char *) packet, len);
}
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;
struct tm* ptm;
gettimeofday(&curr_time, NULL);
time_t curr_time_secs = curr_time.tv_sec;
switch (dump_format){
case HCI_DUMP_STDOUT: {
/* Obtain the time of day, and convert it to a tm struct. */
ptm = localtime (&curr_time_secs);
/* assert localtime was successful */
if (!ptm) break;
/* 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);
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
// #ifdef HAVE_EMBEDDED_TICK
// uint32_t time_ms = btstack_run_loop_embedded_get_time_ms();
// printf("[%06u] ", time_ms);
// #endif
printf_packet(packet_type, in, packet, len);
#endif
}
