radio/src/dump.cpp

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #include "opentx.h"
  22
  23 #if defined(SIMU)
  24 #define dumpPrintf(...) debugPrintf(__VA_ARGS__)
  25 #else
  26 #define dumpPrintf(...) serialPrintf(__VA_ARGS__)
  27 #endif
  28
  29 uint8_t dumpPosition;
  30
  31 void dumpStart(unsigned int size)
  32 {
  33   dumpPrintf("DUMP %d bytes ...\n\r", size);
  34   dumpPosition = 0;
  35 }
  36
  37 void dumpBody(const void *data, unsigned int size)
  38 {
  39   for (unsigned int i=0; i<size; i++) {
  40     dumpPrintf("%.2X ", ((uint8_t *)data)[i]);
  41     dumpPosition++;
  42     if ((dumpPosition & (32-1)) == 0) {
  43       dumpPrintf("\r\n");
  44     }
  45   }
  46 }
  47
  48 void dumpEnd()
  49 {
  50   dumpPrintf("\r\n");
  51 }
  52
  53 #if defined(DEBUG) || defined(CLI)
  54 void dump(const void * data, unsigned int size)
  55 {
  56   dumpStart(size);
  57   dumpBody(data, size);
  58   dumpEnd();
  59 }
  60 #endif