1bf215546Sopenharmony_ci/* 2bf215546Sopenharmony_ci * Copyright (C) 2021 Alyssa Rosenzweig <alyssa@rosenzweig.io> 3bf215546Sopenharmony_ci * 4bf215546Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a 5bf215546Sopenharmony_ci * copy of this software and associated documentation files (the "Software"), 6bf215546Sopenharmony_ci * to deal in the Software without restriction, including without limitation 7bf215546Sopenharmony_ci * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8bf215546Sopenharmony_ci * and/or sell copies of the Software, and to permit persons to whom the 9bf215546Sopenharmony_ci * Software is furnished to do so, subject to the following conditions: 10bf215546Sopenharmony_ci * 11bf215546Sopenharmony_ci * The above copyright notice and this permission notice (including the next 12bf215546Sopenharmony_ci * paragraph) shall be included in all copies or substantial portions of the 13bf215546Sopenharmony_ci * Software. 14bf215546Sopenharmony_ci * 15bf215546Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 16bf215546Sopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 17bf215546Sopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 18bf215546Sopenharmony_ci * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 19bf215546Sopenharmony_ci * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 20bf215546Sopenharmony_ci * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 21bf215546Sopenharmony_ci * SOFTWARE. 22bf215546Sopenharmony_ci */ 23bf215546Sopenharmony_ci 24bf215546Sopenharmony_ci#ifndef __HEXDUMP_H 25bf215546Sopenharmony_ci#define __HEXDUMP_H 26bf215546Sopenharmony_ci 27bf215546Sopenharmony_cistatic void 28bf215546Sopenharmony_cihexdump(FILE *fp, const uint8_t *hex, size_t cnt, bool with_strings) 29bf215546Sopenharmony_ci{ 30bf215546Sopenharmony_ci for (unsigned i = 0; i < cnt; ++i) { 31bf215546Sopenharmony_ci if ((i & 0xF) == 0) 32bf215546Sopenharmony_ci fprintf(fp, "%06X ", i); 33bf215546Sopenharmony_ci 34bf215546Sopenharmony_ci uint8_t v = hex[i]; 35bf215546Sopenharmony_ci 36bf215546Sopenharmony_ci if (v == 0 && (i & 0xF) == 0) { 37bf215546Sopenharmony_ci /* Check if we're starting an aligned run of zeroes */ 38bf215546Sopenharmony_ci unsigned zero_count = 0; 39bf215546Sopenharmony_ci 40bf215546Sopenharmony_ci for (unsigned j = i; j < cnt; ++j) { 41bf215546Sopenharmony_ci if (hex[j] == 0) 42bf215546Sopenharmony_ci zero_count++; 43bf215546Sopenharmony_ci else 44bf215546Sopenharmony_ci break; 45bf215546Sopenharmony_ci } 46bf215546Sopenharmony_ci 47bf215546Sopenharmony_ci if (zero_count >= 32) { 48bf215546Sopenharmony_ci fprintf(fp, "*\n"); 49bf215546Sopenharmony_ci i += (zero_count & ~0xF) - 1; 50bf215546Sopenharmony_ci continue; 51bf215546Sopenharmony_ci } 52bf215546Sopenharmony_ci } 53bf215546Sopenharmony_ci 54bf215546Sopenharmony_ci fprintf(fp, "%02X ", hex[i]); 55bf215546Sopenharmony_ci if ((i & 0xF) == 0xF && with_strings) { 56bf215546Sopenharmony_ci fprintf(fp, " | "); 57bf215546Sopenharmony_ci for (unsigned j = i & ~0xF; j <= i; ++j) { 58bf215546Sopenharmony_ci uint8_t c = hex[j]; 59bf215546Sopenharmony_ci fputc((c < 32 || c > 128) ? '.' : c, fp); 60bf215546Sopenharmony_ci } 61bf215546Sopenharmony_ci } 62bf215546Sopenharmony_ci 63bf215546Sopenharmony_ci if ((i & 0xF) == 0xF) 64bf215546Sopenharmony_ci fprintf(fp, "\n"); 65bf215546Sopenharmony_ci } 66bf215546Sopenharmony_ci 67bf215546Sopenharmony_ci fprintf(fp, "\n"); 68bf215546Sopenharmony_ci} 69bf215546Sopenharmony_ci 70bf215546Sopenharmony_ci#endif 71