recipes/i2c/files/DumpMem.c

   1 /****************************************************************************
   2 *
   3 *   Copyright (c) 2006 Dave Hylands     <dhylands@gmail.com>
   4 *
   5 *   This program is free software; you can redistribute it and/or modify
   6 *   it under the terms of the GNU General Public License version 2 as
   7 *   published by the Free Software Foundation.
   8 *
   9 *   Alternatively, this software may be distributed under the terms of BSD
  10 *   license.
  11 *
  12 *   See README and COPYING for more details.
  13 *
  14 ****************************************************************************/
  15 /**
  16 *
  17 *   @file   DumpMem.c
  18 *
  19 *   @brief  Memmory dump routine
  20 *
  21 ****************************************************************************/
  22
  23 // ---- Include Files -------------------------------------------------------
  24
  25 #include <inttypes.h>
  26 #include "DumpMem.h"
  27 #include "Log.h"
  28
  29 // ---- Public Variables ----------------------------------------------------
  30 // ---- Private Constants and Types -----------------------------------------
  31 // ---- Private Variables ---------------------------------------------------
  32 // ---- Private Function Prototypes -----------------------------------------
  33 // ---- Functions -----------------------------------------------------------
  34
  35 /**************************************************************************/
  36 /**
  37 *   Dumps a page of output for debugging purposes.
  38 */
  39
  40 void DumpMem( const char *prefix, unsigned address, const void *inData, unsigned numBytes )
  41 {
  42     const uint8_t  *data = (const uint8_t *)inData;
  43     unsigned        byteOffset;
  44
  45     if ( numBytes == 0 )
  46     {
  47         Log( "%s: No data\n", prefix );
  48         return;
  49     }
  50
  51 #define LINE_WIDTH  16
  52
  53     for ( byteOffset = 0; byteOffset < numBytes; byteOffset += LINE_WIDTH )
  54     {
  55         unsigned    i;
  56
  57         Log( "%s: %04x: ", prefix, address + byteOffset );
  58
  59         for ( i = 0; i < LINE_WIDTH; i++ )
  60         {
  61             if (( byteOffset + i ) < numBytes )
  62             {
  63                 Log( "%02.2X ", data[ byteOffset + i ] );
  64             }
  65             else
  66             {
  67                 Log( "   " );
  68             }
  69         }
  70         for ( i = 0; i < LINE_WIDTH; i++ )
  71         {
  72             if (( byteOffset + i ) < numBytes )
  73             {
  74                 unsigned char ch = data[ byteOffset + i ];
  75                 if (( ch < ' ' ) || ( ch > '~' ))
  76                 {
  77                     Log( "." );
  78                 }
  79                 else
  80                 {
  81                     Log( "%c", ch );
  82                 }
  83             }
  84             else
  85             {
  86                 break;
  87             }
  88         }
  89         Log( "\n" );
  90     }
  91
  92 } // DumpMem
  93