hl_debug.c

Go to the documentation of this file.

/*
 * Copyright (c) 2012, Leonardo Guardati <leonardo@guardati.it>
 *
 * Permission  to  use,  copy,  modify,  and/or distribute this
 * software  for  any  purpose  with  or  without fee is hereby
 * granted,  provided  that the above copyright notice and this
 * permission notice appear in all copies.
 *
 * THE  SOFTWARE  IS  PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS
 * ALL  WARRANTIES  WITH  REGARD TO THIS SOFTWARE INCLUDING ALL
 * IMPLIED  WARRANTIES  OF  MERCHANTABILITY  AND FITNESS. IN NO
 * EVENT  SHALL  THE  AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
 * INDIRECT,   OR   CONSEQUENTIAL   DAMAGES   OR   ANY  DAMAGES
 * WHATSOEVER  RESULTING  FROM  LOSS  OF  USE, DATA OR PROFITS,
 * WHETHER  IN  AN  ACTION  OF  CONTRACT,  NEGLIGENCE  OR OTHER
 * TORTIOUS  ACTION,  ARISING  OUT OF OR IN CONNECTION WITH THE
 * USE OR PERFORMANCE OF THIS SOFTWARE.
 *
 */
#ifndef HL_DEBUG
#define HL_DEBUG
#undef  HL_DEBUG
#endif

#include "hl_debug.h"

#ifdef HL_DEBUG

uint32_t send_int(uint32_t val)
{
        uint8_t i=0;
        uint8_t front_pad_skip = 1;
        uint8_t str_val[8] = { 0,0,0,0,0,0,0,0 };

        // Print in hex format.
        for( i=0 ; i<8 ; i++ )
        {
                str_val[i] = (uint8_t) ( ( val >> (4*(7-i)) ) & 0xF ) ;
                str_val[i] += ( str_val[i] > 9  ) ? ( 65 - 10 ) : 48 ;
        }

        send_char('0');
        send_char('x');

        for(i=0;i<8;i++)
        {
                if( front_pad_skip && str_val[i] == '0' && i != 7)
                {
                        //Skip useless 0x00000...zeros
                }
                else {
                        send_char( str_val[i] );
                        front_pad_skip = 0;
                }

                str_val[i] = 0;
        }

        // For small number, print the decimal value too.
        if( val < 10 )
                str_val[0] = (uint8_t) ( val + 48 );
        else if ( val < 100 )
        {
                str_val[0] = (uint8_t) ( val/10 + 48 );
                str_val[1] = (uint8_t) ( val%10 + 48 );
        }
        else if ( val < 1000 )
        {
                str_val[0] = (uint8_t) (  val/100     + 48 );
                str_val[1] = (uint8_t) ( (val%100)/10 + 48 );
                str_val[2] = (uint8_t) ( (val%100)%10 + 48 );
        }
        else if ( val < 10000 )
        {
                str_val[0] = (uint8_t) (   val/1000          + 48 );
                str_val[1] = (uint8_t) (  (val%1000)/100     + 48 );
                str_val[2] = (uint8_t) ( ((val%1000)%100)/10 + 48 );
                str_val[3] = (uint8_t) ( ((val%1000)%100)%10 + 48 );
        }
        else if (val < 100000 )
        {
                str_val[0] = (uint8_t) (    val/10000                + 48 );
                str_val[1] = (uint8_t) (   (val%10000)/1000          + 48 );
                str_val[2] = (uint8_t) (  ((val%10000)%1000)/100     + 48 );
                str_val[3] = (uint8_t) ( (((val%10000)%1000)%100)/10 + 48 );
                str_val[4] = (uint8_t) ( (((val%10000)%1000)%100)%10 + 48 );
        }

        send_char(' ');
        send_char('(');
        for(i=0;i<8;i++)
        {
                send_char( str_val[i] );
                str_val[i] = 0;
        }
        send_char(')');

        return val;
}

void send_string(char *string)
{
        uint8_t i=0;
        while( string[i] != 0 && i < 255 )
                send_char(string[i++]);
}
#endif