mirror of
https://github.com/polhenarejos/pico-keys-sdk
synced 2026-06-10 11:59:05 +02:00
76 lines
2.4 KiB
C
76 lines
2.4 KiB
C
/*
|
|
* This file is part of the Pico Keys SDK distribution (https://github.com/polhenarejos/pico-keys-sdk).
|
|
* Copyright (c) 2022 Pol Henarejos.
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as published by
|
|
* the Free Software Foundation, version 3.
|
|
*
|
|
* 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
|
|
* Affero General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Affero General Public License
|
|
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#ifndef _DEBUG_H_
|
|
#define _DEBUG_H_
|
|
|
|
#if defined(DEBUG_APDU) && DEBUG_APDU == 1
|
|
#include <inttypes.h>
|
|
#include <stddef.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
|
|
static inline void debug_payload_impl(const char *name, const uint8_t *p, size_t s, const char *file, int line) {
|
|
printf("Payload %s (%zu bytes) [%s:%d]:\n", name, s, file, line);
|
|
for (size_t i = 0; i < s; i += 16) {
|
|
printf("%" PRIxPTR "h : ", (uintptr_t)(p + i));
|
|
for (size_t j = 0; j < 16; j++) {
|
|
if (j < s - i) {
|
|
printf("%02X ", p[i + j]);
|
|
}
|
|
else {
|
|
printf(" ");
|
|
}
|
|
if (j == 7) {
|
|
printf(" ");
|
|
}
|
|
}
|
|
printf(": ");
|
|
for (size_t j = 0; j < 16; j++) {
|
|
if (j < s - i && p[i + j] > 32 && p[i + j] != 127 && p[i + j] < 176) {
|
|
printf("%c", p[i + j]);
|
|
}
|
|
else {
|
|
printf(" ");
|
|
}
|
|
if (j == 7) {
|
|
printf(" ");
|
|
}
|
|
}
|
|
printf("\n");
|
|
}
|
|
printf("\n");
|
|
}
|
|
|
|
static inline void debug_data_impl(const char *name, const uint8_t *p, size_t s, const char *file, int line) {
|
|
printf("Data %s (%zu bytes) [%s:%d]:\n", name, s, file, line);
|
|
for (size_t i = 0; i < s; i++) {
|
|
printf("%02X", p[i]);
|
|
}
|
|
printf("\n");
|
|
}
|
|
|
|
#define DEBUG_PAYLOAD(_p, _s) debug_payload_impl(#_p, (const uint8_t *)(_p), (size_t)(_s), __FILE__, __LINE__)
|
|
#define DEBUG_DATA(_p, _s) debug_data_impl(#_p, (const uint8_t *)(_p), (size_t)(_s), __FILE__, __LINE__)
|
|
|
|
#else
|
|
#define DEBUG_PAYLOAD(_p, _s)
|
|
#define DEBUG_DATA(_p, _s)
|
|
#endif
|
|
|
|
#endif // _DEBUG_H_
|