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 #include <delay.h>
  26 #include <fx2regs.h>
  27 #include <fx2macros.h>
  28 #include "debug.h"
  29
  30 #define MESSAGE_LENGTH_MAX 64
  31
  32 void debugf(const char *format, ...)
  33 {
  34         va_list arg;
  35         int count;
  36
  37         /* Format the string. */
  38         va_start(arg, format);
  39         count = vsprintf(EP6FIFOBUF, format, arg);
  40         va_end(arg);
  41
  42         /* Zero out the rest of the buffer. */
  43         while (count < MESSAGE_LENGTH_MAX)
  44                 EP6FIFOBUF[count++] = '\0';
  45
  46         /* Send the buffer. */
  47         count = 32;
  48         EP6BCH = MSB(count);
  49         SYNCDELAY4;
  50         EP6BCL = LSB(count);
  51         SYNCDELAY4;
  52 }
  53
  54 void _assert(char *expr, const char *filename, unsigned int linenumber)
  55 {
  56         debugf("Assert(%s) failed at line %u in file %s.\n",
  57                expr, linenumber, filename);
  58         while (1);
  59 }
  60
  61 #endif