blob: 1ec02023b49085b0923fe3cee4023aeeaa92d3d0 [file] [log] [blame]
/*
* Copyright (c) 2012-2018 Rob Clark <robdclark@gmail.com>
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the "Software"),
* to deal in the Software without restriction, including without limitation
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
* and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice (including the next
* paragraph) shall be included in all copies or substantial portions of the
* Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*/
#ifndef __UTIL_H__
#define __UTIL_H__
#include <ctype.h>
#include <stdint.h>
#include <stdio.h>
/* old-style program binary XOR'd ascii w/ 0xff */
#ifndef ASCII_XOR
# define ASCII_XOR 0
#endif
static inline const char *tab(int lvl)
{
const char *TAB = "\t\t\t\t\t\t\t\t\0";
return &TAB[strlen(TAB) - lvl];
}
/* convert float to dword */
static inline float d2f(uint32_t d)
{
union {
float f;
uint32_t d;
} u = {
.d = d,
};
return u.f;
}
static inline void dump_hex(const void *buf, int sz)
{
uint8_t *ptr = (uint8_t *)buf;
uint8_t *end = ptr + sz;
int i = 0;
while (ptr < end) {
uint32_t d = 0;
printf((i % 8) ? " " : "\t");
d |= *(ptr++) << 0;
d |= *(ptr++) << 8;
d |= *(ptr++) << 16;
d |= *(ptr++) << 24;
printf("%08x", d);
if ((i % 8) == 7) {
printf("\n");
}
i++;
}
if (i % 8) {
printf("\n");
}
}
static inline void
dump_float(const void *buf, int sz)
{
uint8_t *ptr = (uint8_t *)buf;
uint8_t *end = ptr + sz - 3;
int i = 0;
while (ptr < end) {
uint32_t d = 0;
printf((i % 8) ? " " : "\t");
d |= *(ptr++) << 0;
d |= *(ptr++) << 8;
d |= *(ptr++) << 16;
d |= *(ptr++) << 24;
printf("%8f", d2f(d));
if ((i % 8) == 7) {
printf("\n");
}
i++;
}
if (i % 8) {
printf("\n");
}
}
#define is_ok_ascii(c) \
(isascii(c) && ((c == '\t') || !iscntrl(c)))
static inline void
clean_ascii(char *buf, int sz)
{
uint8_t *ptr = (uint8_t *)buf;
uint8_t *end = ptr + sz;
while (ptr < end) {
*(ptr++) ^= ASCII_XOR;
}
}
static inline void
dump_ascii(const void *buf, int sz)
{
uint8_t *ptr = (uint8_t *)buf;
uint8_t *end = ptr + sz;
printf("\t");
while (ptr < end) {
uint8_t c = *(ptr++) ^ ASCII_XOR;
if (c == '\n') {
printf("\n\t");
} else if (c == '\0') {
printf("\n\t-----------------------------------\n\t");
} else if (is_ok_ascii(c)) {
printf("%c", c);
} else {
printf("?");
}
}
printf("\n");
}
static inline void
dump_hex_ascii(const void *buf, int sz, int level)
{
uint8_t *ptr = (uint8_t *)buf;
uint8_t *end = ptr + sz;
uint8_t *ascii = ptr;
int i = 0;
printf("%s-----------------------------------------------\n", tab(level));
printf("%s%d (0x%x) bytes\n", tab(level), sz, sz);
while (ptr < end) {
uint32_t d = 0;
if (i % 4) {
printf(" ");
} else {
printf("%s%06x: ", tab(level), (uint32_t)(ptr - (uint8_t *)buf));
}
d |= *(ptr++) << 0;
d |= *(ptr++) << 8;
d |= *(ptr++) << 16;
d |= *(ptr++) << 24;
printf("%08x", d);
if ((i % 4) == 3) {
int j;
printf("\t|");
for (j = 0; j < 16; j++) {
uint8_t c = *(ascii++);
c ^= ASCII_XOR;
printf("%c", (isascii(c) && !iscntrl(c)) ? c : '.');
}
printf("|\n");
}
i++;
}
if (i % 4) {
for (int j = 4 - (i % 4); j > 0; j--) {
printf(" ");
}
printf("\t|");
while (ascii < end) {
uint8_t c = *(ascii++);
c ^= ASCII_XOR;
printf("%c", (isascii(c) && !iscntrl(c)) ? c : '.');
}
printf("|\n");
}
}
#endif /* __UTIL_H__ */