mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2024-09-20 23:36:31 +08:00
144 lines
3.9 KiB
C
144 lines
3.9 KiB
C
//-----------------------------------------------------------------------------
|
|
// Copyright (C) Jonathan Westhues, Mar 2006
|
|
// Copyright (C) Gerhard de Koning Gans, Sep 2007
|
|
//
|
|
// This program is free software: you can redistribute it and/or modify
|
|
// it under the terms of the GNU General Public License as published by
|
|
// the Free Software Foundation, either version 3 of the License, or
|
|
// (at your option) any later version.
|
|
//
|
|
// 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.
|
|
//
|
|
// See LICENSE.txt for the text of the license.
|
|
//-----------------------------------------------------------------------------
|
|
|
|
#include "dbprint.h"
|
|
|
|
#include "string.h"
|
|
#include "cmd.h"
|
|
#include "printf.h"
|
|
|
|
#define DEBUG 1
|
|
#define DEBUG_MAX_MSG_SIZE 200
|
|
//=============================================================================
|
|
// Debug print functions, to go out over USB, to the usual PC-side client.
|
|
//=============================================================================
|
|
|
|
void DbpStringEx(uint32_t flags, const char *src, size_t srclen) {
|
|
#if DEBUG
|
|
struct {
|
|
uint16_t flag;
|
|
uint8_t buf[DEBUG_MAX_MSG_SIZE];
|
|
} PACKED data;
|
|
data.flag = flags;
|
|
uint16_t len = MIN(srclen, sizeof(data.buf));
|
|
memcpy(data.buf, src, len);
|
|
reply_ng(CMD_DEBUG_PRINT_STRING, PM3_SUCCESS, (uint8_t *)&data, sizeof(data.flag) + len);
|
|
#endif
|
|
}
|
|
|
|
void DbpString(const char *str) {
|
|
#if DEBUG
|
|
DbpStringEx(FLAG_LOG, str, strlen(str));
|
|
#endif
|
|
}
|
|
|
|
void DbprintfEx(uint32_t flags, const char *fmt, ...) {
|
|
#if DEBUG
|
|
// should probably limit size here; oh well, let's just use a big buffer
|
|
char s[DEBUG_MAX_MSG_SIZE] = {0x00};
|
|
va_list ap;
|
|
va_start(ap, fmt);
|
|
kvsprintf(fmt, s, 10, ap);
|
|
va_end(ap);
|
|
|
|
DbpStringEx(flags, s, strlen(s));
|
|
#endif
|
|
}
|
|
|
|
void Dbprintf(const char *fmt, ...) {
|
|
#if DEBUG
|
|
// should probably limit size here; oh well, let's just use a big buffer
|
|
char output_string[DEBUG_MAX_MSG_SIZE] = {0x00};
|
|
va_list ap;
|
|
|
|
va_start(ap, fmt);
|
|
kvsprintf(fmt, output_string, 10, ap);
|
|
va_end(ap);
|
|
|
|
DbpString(output_string);
|
|
#endif
|
|
}
|
|
|
|
// prints HEX & ASCII
|
|
void Dbhexdump(int len, const uint8_t *d, bool bAsci) {
|
|
#if DEBUG
|
|
char ascii[17];
|
|
|
|
while (len > 0) {
|
|
|
|
int l = (len > 16) ? 16 : len;
|
|
|
|
memcpy(ascii, d, l);
|
|
ascii[l] = 0;
|
|
|
|
// filter safe ascii
|
|
for (int i = 0; i < l; i++) {
|
|
if (ascii[i] < 32 || ascii[i] > 126) {
|
|
ascii[i] = '.';
|
|
}
|
|
}
|
|
|
|
if (bAsci)
|
|
Dbprintf("%-8s %*D", ascii, l, d, " ");
|
|
else
|
|
Dbprintf("%*D", l, d, " ");
|
|
|
|
len -= 16;
|
|
d += 16;
|
|
}
|
|
#endif
|
|
}void print_result(const char *name, const uint8_t *d, size_t
|
|
|
|
n) {
|
|
|
|
const uint8_t *p = d;
|
|
uint16_t tmp = n & 0xFFF0;
|
|
|
|
for (; p - d < tmp; p += 16) {
|
|
Dbprintf("[%s: %02d/%02d] %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
|
|
name,
|
|
p - d,
|
|
n,
|
|
p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7], p[8], p[9], p[10], p[11], p[12], p[13], p[14], p[15]
|
|
);
|
|
}
|
|
|
|
if (n % 16 != 0) {
|
|
char s[46] = {0};
|
|
char *sp = s;
|
|
for (; p - d < n; p++) {
|
|
sprintf(sp, "%02x ", p[0]);
|
|
sp += 3;
|
|
}
|
|
Dbprintf("[%s: %02d/%02d] %s", name, p - d, n, s);
|
|
}
|
|
}
|
|
|
|
// Prints message and hexdump
|
|
void print_dbg(const char *msg, const uint8_t *d, uint16_t n) {
|
|
if (g_dbglevel == DBG_DEBUG) {
|
|
print_result(msg, d, n);
|
|
}
|
|
}
|
|
|
|
/* useful when debugging new protocol implementations like FeliCa
|
|
void PrintToSendBuffer(void) {
|
|
DbpString("Printing ToSendBuffer:");
|
|
Dbhexdump(ToSendMax, ToSend, 0);
|
|
}
|
|
*/
|