summaryrefslogtreecommitdiffstats
path: root/firmware/debug.c
diff options
context:
space:
mode:
authorLinus Nielsen Feltzing <linus@haxx.se>2002-04-20 23:01:30 +0000
committerLinus Nielsen Feltzing <linus@haxx.se>2002-04-20 23:01:30 +0000
commitd057c07154b02a067051f8a4711b19e4011a16aa (patch)
treef9c6036c2e45336cff8c59dd5b70f91b7c46a8ab /firmware/debug.c
parent432ba31511bc1a00803657b4b4c60f27791608ba (diff)
downloadrockbox-d057c07154b02a067051f8a4711b19e4011a16aa.tar.gz
rockbox-d057c07154b02a067051f8a4711b19e4011a16aa.tar.bz2
rockbox-d057c07154b02a067051f8a4711b19e4011a16aa.zip
First commit
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@156 a1c6a512-1295-4272-9138-f99709370657
Diffstat (limited to 'firmware/debug.c')
-rw-r--r--firmware/debug.c181
1 files changed, 181 insertions, 0 deletions
diff --git a/firmware/debug.c b/firmware/debug.c
new file mode 100644
index 0000000000..d78fa17528
--- /dev/null
+++ b/firmware/debug.c
@@ -0,0 +1,181 @@
+/***************************************************************************
+ * __________ __ ___.
+ * Open \______ \ ____ ____ | | _\_ |__ _______ ___
+ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
+ * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
+ * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
+ * \/ \/ \/ \/ \/
+ * $Id$
+ *
+ * Copyright (C) 2002 by Linus Nielsen Feltzing
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+#include "sh7034.h"
+#include <string.h>
+#include <stdio.h>
+#include <stdarg.h>
+
+char debugmembuf[100];
+char debugbuf[200];
+
+static int debug_tx_ready(void)
+{
+ return (SSR1 & SCI_TDRE);
+}
+
+static void debug_tx_char(char ch)
+{
+ while (!debug_tx_ready())
+ {
+ ;
+ }
+
+ /*
+ * Write data into TDR and clear TDRE
+ */
+ TDR1 = ch;
+ SSR1 &= ~SCI_TDRE;
+}
+
+static void debug_handle_error(char ssr)
+{
+ SSR1 &= ~(SCI_ORER | SCI_PER | SCI_FER);
+}
+
+static int debug_rx_ready(void)
+{
+ char ssr;
+
+ ssr = SSR1 & ( SCI_PER | SCI_FER | SCI_ORER );
+ if ( ssr )
+ debug_handle_error ( ssr );
+ return SSR1 & SCI_RDRF;
+}
+
+static char debug_rx_char(void)
+{
+ char ch;
+ char ssr;
+
+ /* Special debug hack. Shut off the IRQ while polling, to prevent the debug
+ stub from catching the IRQ */
+ SCR1 &= ~0x40;
+
+ while (!debug_rx_ready())
+ {
+ ;
+ }
+
+ ch = RDR1;
+ SSR1 &= ~SCI_RDRF;
+
+ ssr = SSR1 & (SCI_PER | SCI_FER | SCI_ORER);
+
+ if (ssr)
+ debug_handle_error (ssr);
+
+ /* Special debug hack. Enable the IRQ again */
+ SCR1 |= 0x40;
+ return ch;
+}
+
+static const char hexchars[] = "0123456789abcdef";
+
+static char highhex(int x)
+{
+ return hexchars[(x >> 4) & 0xf];
+}
+
+static char lowhex(int x)
+{
+ return hexchars[x & 0xf];
+}
+
+static void putpacket (char *buffer)
+{
+ register int checksum;
+
+ char *src = buffer;
+ debug_tx_char ('$');
+ checksum = 0;
+
+ while (*src)
+ {
+ int runlen;
+
+ /* Do run length encoding */
+ for (runlen = 0; runlen < 100; runlen ++)
+ {
+ if (src[0] != src[runlen])
+ {
+ if (runlen > 3)
+ {
+ int encode;
+ /* Got a useful amount */
+ debug_tx_char (*src);
+ checksum += *src;
+ debug_tx_char ('*');
+ checksum += '*';
+ checksum += (encode = runlen + ' ' - 4);
+ debug_tx_char (encode);
+ src += runlen;
+ }
+ else
+ {
+ debug_tx_char (*src);
+ checksum += *src;
+ src++;
+ }
+ break;
+ }
+ }
+ }
+
+
+ debug_tx_char ('#');
+ debug_tx_char (highhex(checksum));
+ debug_tx_char (lowhex(checksum));
+
+ /* Wait for the '+' */
+ debug_rx_char();
+}
+
+/* convert the memory, pointed to by mem into hex, placing result in buf */
+/* return a pointer to the last char put in buf (null) */
+static char *mem2hex (char *mem, char *buf, int count)
+{
+ int i;
+ int ch;
+ for (i = 0; i < count; i++)
+ {
+ ch = *mem++;
+ *buf++ = highhex (ch);
+ *buf++ = lowhex (ch);
+ }
+ *buf = 0;
+ return (buf);
+}
+
+void debug(char *msg)
+{
+ debugbuf[0] = 'O';
+
+ mem2hex(msg, &debugbuf[1], strlen(msg));
+ putpacket(debugbuf);
+}
+
+void debugf(char *fmt, ...)
+{
+ va_list ap;
+
+ va_start(ap, fmt);
+ vsprintf(debugmembuf, fmt, ap);
+ va_end(ap);
+ debug(debugmembuf);
+}