Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/debug.c
Linus Nielsen Feltzing b9e69e2b6f Added Player debug menu 
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@1329 a1c6a512-1295-4272-9138-f99709370657
2002-07-04 13:38:49 +00:00

413 lines
9.5 KiB
C
Raw Blame History

/***************************************************************************
* __________ __ ___.
* 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>
#include "config.h"
#ifdef DEBUG
static char debugmembuf[100];
static char debugbuf[200];
#endif
#ifndef SIMULATOR /* allow non archos platforms to display output */
#include "kernel.h"
#include "button.h"
#include "system.h"
#include "lcd.h"
#include "adc.h"
void debug_init(void)
{
/* Clear it all! */
SSR1 &= ~(SCI_RDRF | SCI_ORER | SCI_PER | SCI_FER);
/* This enables the serial Rx interrupt, to be able to exit into the
debugger when you hit CTRL-C */
SCR1 |= 0x40;
SCR1 &= ~0x80;
IPRE |= 0xf000; /* Set to highest priority */
}
#ifdef DEBUG
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)
{
(void)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;
while (!debug_rx_ready())
{
;
}
ch = RDR1;
SSR1 &= ~SCI_RDRF;
ssr = SSR1 & (SCI_PER | SCI_FER | SCI_ORER);
if (ssr)
debug_handle_error (ssr);
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;
/* Special debug hack. Shut off the Rx IRQ during I/O to prevent the debug
stub from interrupting the message */
SCR1 &= ~0x40;
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();
/* Special debug hack. Enable the IRQ again */
SCR1 |= 0x40;
}
/* 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);
}
static void debug(char *msg)
{
debugbuf[0] = 'O';
mem2hex(msg, &debugbuf[1], strlen(msg));
putpacket(debugbuf);
}
#endif /* end of DEBUG section */
void debugf(char *fmt, ...)
{
#ifdef DEBUG
va_list ap;
va_start(ap, fmt);
vsnprintf(debugmembuf, sizeof(debugmembuf), fmt, ap);
va_end(ap);
debug(debugmembuf);
#else
(void)fmt;
#endif
}
/*---------------------------------------------------*/
/* SPECIAL DEBUG STUFF */
/*---------------------------------------------------*/
extern int ata_device;
extern int ata_io_address;
#ifdef ARCHOS_RECORDER
/* Test code!!! */
void dbg_ports(void)
{
unsigned short porta;
unsigned short portb;
unsigned char portc;
char buf[32];
int button;
int battery_voltage;
int batt_int, batt_frac;
lcd_clear_display();
while(1)
{
porta = PADR;
portb = PBDR;
portc = PCDR;
snprintf(buf, 32, "PADR: %04x", porta);
lcd_puts(0, 0, buf);
snprintf(buf, 32, "PBDR: %04x", portb);
lcd_puts(0, 1, buf);
snprintf(buf, 32, "AN0: %03x AN4: %03x", adc_read(0), adc_read(4));
lcd_puts(0, 2, buf);
snprintf(buf, 32, "AN1: %03x AN5: %03x", adc_read(1), adc_read(5));
lcd_puts(0, 3, buf);
snprintf(buf, 32, "AN2: %03x AN6: %03x", adc_read(2), adc_read(6));
lcd_puts(0, 4, buf);
snprintf(buf, 32, "AN3: %03x AN7: %03x", adc_read(3), adc_read(7));
lcd_puts(0, 5, buf);
battery_voltage = (adc_read(6) * BATTERY_SCALE_FACTOR) / 10000;
batt_int = battery_voltage / 100;
batt_frac = battery_voltage % 100;
snprintf(buf, 32, "Battery: %d.%02dV", batt_int, batt_frac);
lcd_puts(0, 6, buf);
snprintf(buf, 32, "ATA: %s, 0x%x",
ata_device?"slave":"master", ata_io_address);
lcd_puts(0, 7, buf);
lcd_update();
sleep(HZ/10);
button = button_get(false);
switch(button)
{
case BUTTON_ON:
/* Toggle the charger */
PBDR ^= 0x20;
break;
case BUTTON_UP:
/* Toggle the IDE power */
PADR ^= 0x20;
break;
case BUTTON_OFF:
/* Disable the charger */
PBDR |= 0x20;
/* Enable the IDE power */
PADR |= 0x20;
return;
}
}
}
#else
void dbg_ports(void)
{
unsigned short porta;
unsigned short portb;
unsigned char portc;
char buf[32];
int button;
int battery_voltage;
int batt_int, batt_frac;
int currval = 0;
lcd_clear_display();
while(1)
{
porta = PADR;
portb = PBDR;
portc = PCDR;
switch(currval)
{
case 0:
snprintf(buf, 32, "PADR: %04x ", porta);
break;
case 1:
snprintf(buf, 32, "PBDR: %04x ", portb);
break;
case 2:
snprintf(buf, 32, "AN0: %03x ", adc_read(0));
break;
case 3:
snprintf(buf, 32, "AN1: %03x ", adc_read(1));
break;
case 4:
snprintf(buf, 32, "AN2: %03x ", adc_read(2));
break;
case 5:
snprintf(buf, 32, "AN3: %03x ", adc_read(3));
break;
case 6:
snprintf(buf, 32, "AN4: %03x ", adc_read(4));
break;
case 7:
snprintf(buf, 32, "AN5: %03x ", adc_read(5));
break;
case 8:
snprintf(buf, 32, "AN6: %03x ", adc_read(6));
break;
case 9:
snprintf(buf, 32, "AN7: %03x ", adc_read(7));
break;
case 10:
snprintf(buf, 32, "%s, 0x%x ",
ata_device?"slv":"mst", ata_io_address);
break;
}
lcd_puts(0, 0, buf);
battery_voltage = (adc_read(6) * BATTERY_SCALE_FACTOR) / 10000;
batt_int = battery_voltage / 100;
batt_frac = battery_voltage % 100;
snprintf(buf, 32, "Batt: %d.%02dV", batt_int, batt_frac);
lcd_puts(0, 1, buf);
sleep(HZ/5);
button = button_get(false);
switch(button)
{
#ifndef ARCHOS_PLAYER_OLD
case BUTTON_ON:
/* Toggle the charger */
PBDR ^= 0x20;
break;
case BUTTON_PLAY:
/* Toggle the IDE power */
PADR ^= 0x20;
break;
#endif
case BUTTON_STOP:
#ifndef ARCHOS_PLAYER_OLD
/* Disable the charger */
PBDR |= 0x20;
/* Enable the IDE power */
PADR |= 0x20;
#endif
return;
case BUTTON_LEFT:
currval--;
if(currval < 0)
currval = 10;
break;
case BUTTON_RIGHT:
currval++;
if(currval > 10)
currval = 0;
break;
}
}
}
#endif
#else /* SIMULATOR code coming up */
void debug_init(void)
{
}
void debugf(char *fmt, ...)
{
va_list ap;
va_start( ap, fmt );
vfprintf( stderr, fmt, ap );
va_end( ap );
}
#endif
Reference in a new issue View git blame Copy permalink