drv/kdebug.c

   1 /*!
   2  * \file
   3  * <!--
   4  * Copyright 2003,2004 Develer S.r.l. (http://www.develer.com/)
   5  * Copyright 2000,2001,2002 Bernardo Innocenti <bernie@codewiz.org>
   6  * This file is part of DevLib - See devlib/README for information.
   7  * -->
   8  *
   9  * \brief General pourpose debug functions.
  10  *
  11  * \version $Id$
  12  *
  13  * \author Bernardo Innocenti <bernie@develer.com>
  14  * \author Stefano Fedrigo <aleph@develer.com>
  15  */
  16
  17 /*
  18  * $Log$
  19  * Revision 1.7  2004/07/30 14:15:53  rasky
  20  * Nuovo supporto unificato per detect della CPU
  21  *
  22  * Revision 1.6  2004/07/18 21:49:28  bernie
  23  * Add ATmega8 support.
  24  *
  25  * Revision 1.5  2004/06/27 15:20:26  aleph
  26  * Change UNUSED() macro to accept two arguments: type and name;
  27  * Add macro GNUC_PREREQ to detect GCC version during build;
  28  * Some spacing cleanups and typo fix
  29  *
  30  * Revision 1.4  2004/06/06 18:09:51  bernie
  31  * Import DSP56800 changes; Print broken wall bricks in hex.
  32  *
  33  * Revision 1.3  2004/06/03 11:27:09  bernie
  34  * Add dual-license information.
  35  *
  36  * Revision 1.2  2004/05/23 18:21:53  bernie
  37  * Trim CVS logs and cleanup header info.
  38  *
  39  */
  40
  41 #include "kdebug.h"
  42 #include "hw.h"
  43 #include "config.h"
  44
  45 #include <mware/formatwr.h> /* for _formatted_write() */
  46
  47 #ifdef _DEBUG
  48
  49 #if defined(_EMUL)
  50         #include <stdio.h>
  51         #define KDBG_WAIT_READY()      do {/*nop*/} while(0)
  52         #define KDBG_WRITE_CHAR(c)     putchar((c))
  53         #define KDBG_MASK_IRQ(old)     do {/*nop*/} while(0)
  54         #define KDBG_RESTORE_IRQ()     do {/*nop*/} while(0)
  55 #elif CPU_I196
  56         #include "Util196.h"
  57         #define KDBG_WAIT_READY()      do {} while (!(SP_STAT & (SPSF_TX_EMPTY | SPSF_TX_INT)))
  58         #define KDBG_WRITE_CHAR(c)     do { SBUF = (c); } while(0)
  59         #define KDBG_MASK_IRQ(old) \
  60                 do { \
  61                         (old) = INT_MASK1 & INT1F_TI; \
  62                         INT_MASK1 &= ~INT1F_TI; \
  63                 } while(0)
  64         #define KDBG_RESTORE_IRQ(old)  do { INT_MASK1 |= (old); }
  65 #elif CPU_AVR
  66         #include <avr/io.h>
  67         #if CONFIG_KDEBUG_PORT == 0
  68                 #if defined(__AVR_ATmega64__)
  69                         #define UCR UCSR0B
  70                         #define UDR UDR0
  71                         #define USR UCSR0A
  72                 #elif defined(__AVR_ATmega8__)
  73                         #define UCR UCSRB
  74                         #define USR UCSRA
  75                 #endif
  76                 #define KDBG_WAIT_READY()     do { loop_until_bit_is_set(USR, UDRE); } while(0)
  77                 #define KDBG_WRITE_CHAR(c)    do { UCR |= BV(TXEN); UDR = (c); } while(0)
  78                 #define KDBG_MASK_IRQ(old)    do { (old) = UCR & BV(TXCIE); cbi(UCR, TXCIE); } while(0)
  79                 #define KDBG_RESTORE_IRQ(old) do { UCR |= (old); } while(0)
  80         #elif CONFIG_KDEBUG_PORT == 1
  81                 #define KDBG_WAIT_READY()     do { loop_until_bit_is_set(UCSR1A, UDRE); } while(0)
  82                 #define KDBG_WRITE_CHAR(c)    do { UCSR1B |= BV(TXEN); UDR1 = (c); } while(0)
  83                 #define KDBG_MASK_IRQ(old)    do { (old) = UCSR1B & BV(TXCIE); cbi(UCSR1B, TXCIE); } while(0)
  84                 #define KDBG_RESTORE_IRQ(old) do { UCSR1B |= (old); } while(0)
  85         #else
  86                 #error CONFIG_KDEBUG_PORT should be either 0 or 1
  87         #endif
  88 #elif defined(__MWERKS__) && CPU_DSP56K
  89         /* Debugging go through the JTAG interface. The MSL library already
  90            implements the console I/O correctly. */
  91         #include <stdio.h>
  92         #define KDBG_WAIT_READY()
  93         #define KDBG_WRITE_CHAR(c)        do { char ch=c; fwrite(&ch,1,1,stdout); } while (0)
  94         #define KDBG_MASK_IRQ(old)
  95         #define KDBG_RESTORE_IRQ(old)
  96 #else
  97         #error Unknown architecture
  98 #endif
  99
 100
 101 void kdbg_init(void)
 102 {
 103 #if CPU_I196
 104
 105         /* Set serial port for 19200bps 8N1 */
 106         INT_MASK1 &= ~(INT1F_TI | INT1F_RI);
 107         SP_CON = SPCF_RECEIVE_ENABLE | SPCF_MODE1;
 108         ioc1_img |= IOC1F_TXD_SEL | IOC1F_EXTINT_SRC;
 109         IOC1 = ioc1_img;
 110         BAUD_RATE = 0x33;
 111         BAUD_RATE = 0x80;
 112
 113 #elif CPU_AVR
 114
 115         /* Compute the baud rate */
 116         uint16_t period = (((CLOCK_FREQ / 16UL) + (CONFIG_KDEBUG_BAUDRATE / 2)) / CONFIG_KDEBUG_BAUDRATE) - 1;
 117
 118         #if defined(__AVR_ATmega64__)
 119                 #if CONFIG_KDEBUG_PORT == 0
 120                         UBRR0H = (uint8_t)(period>>8);
 121                         UBRR0L = (uint8_t)period;
 122                 #elif CONFIG_KDEBUG_PORT == 1
 123                         UBRR1H = (uint8_t)(period>>8);
 124                         UBRR1L = (uint8_t)period;
 125                 #else
 126                         #error CONFIG_KDEBUG_PORT must be either 0 or 1
 127                 #endif
 128         #elif defined(__AVR_ATmega8__)
 129                 UBRRH = (uint8_t)(period>>8);
 130                 UBRRL = (uint8_t)period;
 131         #elif defined(__AVR_ATmega103__)
 132                 UBRR = (uint8_t)period;
 133         #else
 134                 #error Unknown arch
 135         #endif
 136
 137 #endif /* !CPU_I196 && !CPU_AVR */
 138
 139         kputs("\n\n*** DBG START ***\n");
 140 }
 141
 142
 143 /*!
 144  * Output one character to the debug console
 145  */
 146 static void kputchar(char c, UNUSED(void *, unused))
 147 {
 148         /* Poll while serial buffer is still busy */
 149         KDBG_WAIT_READY();
 150
 151         /* Send '\n' as '\r\n' for dumb terminals */
 152         if (c == '\n')
 153         {
 154                 KDBG_WRITE_CHAR('\r');
 155                 KDBG_WAIT_READY();
 156         }
 157
 158         KDBG_WRITE_CHAR(c);
 159 }
 160
 161
 162 void PGM_FUNC(kprintf)(const char * PGM_ATTR fmt, ...)
 163 {
 164         va_list ap;
 165
 166         /* Mask serial TX intr */
 167         unsigned char irqsave;
 168         KDBG_MASK_IRQ(irqsave);
 169
 170         va_start(ap, fmt);
 171         PGM_FUNC(_formatted_write)(fmt, kputchar, 0, ap);
 172         va_end(ap);
 173
 174         /* Restore serial TX intr */
 175         KDBG_RESTORE_IRQ(irqsave);
 176 }
 177
 178
 179 void PGM_FUNC(kputs)(const char * PGM_ATTR str)
 180 {
 181         char c;
 182
 183         /* Mask serial TX intr */
 184         unsigned char irqsave;
 185         KDBG_MASK_IRQ(irqsave);
 186
 187         while ((c = PGM_READ_CHAR(str++)))
 188                 kputchar(c, 0);
 189
 190         KDBG_RESTORE_IRQ(irqsave);
 191 }
 192
 193
 194 int PGM_FUNC(__assert)(const char * PGM_ATTR cond, const char *file, int line)
 195 {
 196         PGM_FUNC(kputs)(file);
 197         PGM_FUNC(kprintf)(PSTR(":%d: Assertion failed: \""), line);
 198         PGM_FUNC(kputs)(cond);
 199         PGM_FUNC(kputs)(PSTR("\"\n"));
 200         return 1;
 201 }
 202
 203
 204 int PGM_FUNC(__invalid_ptr)(void *value, const char * PGM_ATTR name, const char * PGM_ATTR file, int line)
 205 {
 206         PGM_FUNC(kputs)(file);
 207         PGM_FUNC(kprintf)(PSTR(":%d: Invalid pointer: "), line);
 208         PGM_FUNC(kputs)(name);
 209         PGM_FUNC(kprintf)(PSTR(" = 0x%x\n"), value);
 210         return 1;
 211 }
 212
 213
 214 void __init_wall(long *wall, int size)
 215 {
 216         while(size--)
 217                 *wall++ = WALL_VALUE;
 218 }
 219
 220
 221 int __check_wall(long *wall, int size, const char *name, const char *file, int line)
 222 {
 223         int i, fail = 0;
 224
 225         for (i = 0; i < size; i++)
 226         {
 227                 if (wall[i] != WALL_VALUE)
 228                 {
 229                         kprintf("%s:%d: Wall broken: %s[%d] (0x%p) = 0x%lx\n",
 230                                 file, line, name, i, wall + i, wall[i]);
 231                         fail = 1;
 232                 }
 233         }
 234
 235         return fail;
 236 }
 237
 238
 239 /*!
 240  * Dump binary data in hex
 241  */
 242 void kdump(const void *_buf, size_t len)
 243 {
 244         const unsigned char *buf = (const unsigned char *)_buf;
 245
 246         while (len--)
 247                 kprintf("%02X", *buf++);
 248         kputs("\n");
 249 }
 250
 251 #endif /* _DEBUG */