debug.c

   1 /*
   2  * This file is part of the fx2lafw project.
   3  *
   4  * Copyright (C) 2012 Joel Holdsworth <joel@airwebreathe.org.uk>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  19  */
  20
  21 #ifdef DEBUG
  22
  23 #include <stdarg.h>
  24 #include <stdio.h>
  25
  26 #include <delay.h>
  27 #include <fx2regs.h>
  28 #include <fx2macros.h>
  29
  30 #include "debug.h"
  31
  32 #define MESSAGE_LENGTH_MAX 64
  33
  34 void debugf(const char *format, ...) {
  35         va_list arg;
  36         int count;
  37
  38         // Format the string
  39         va_start (arg, format);
  40         count = vsprintf(EP6FIFOBUF, format, arg);
  41         va_end (arg);
  42
  43         // Zero out the rest of the buffer
  44         while(count < MESSAGE_LENGTH_MAX)
  45                 EP6FIFOBUF[count++] = '\0';
  46
  47         // Send the buffer
  48         count = 32;
  49         EP6BCH = MSB(count);
  50         SYNCDELAY4;
  51         EP6BCL = LSB(count);
  52 }
  53
  54 void _assert(char *expr, const char *filename, unsigned int linenumber) {
  55         debugf("Assert(%s) failed at line %u in file %s.\n",
  56                 expr, linenumber, filename);
  57         while(1);
  58 }
  59
  60 #endif