Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/debug.c
Linus Nielsen Feltzing 5b4221b279 Now uses power.c/h 
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@1334 a1c6a512-1295-4272-9138-f99709370657
2002-07-04 16:09:53 +00:00

405 lines
9.4 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"
#include "mas.h"
#include "power.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;
bool charge_status = false;
bool ide_status = true;
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, "Batt: %d.%02dV %d%% ", batt_int, batt_frac,
battery_level());
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:
charge_status = charge_status?false:true;
charger_enable(charge_status);
break;
case BUTTON_UP:
ide_status = ide_status?false:true;
ide_power_enable(ide_status);
break;
case BUTTON_OFF:
charger_enable(false);
ide_power_enable(true);
return;
}
}
}
#else
void dbg_ports(void)
{
unsigned short porta;
unsigned short portb;
unsigned char portc;
char buf[32];
unsigned long crc_count;
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;
case 11:
mas_readmem(MAS_BANK_D0, 0x303, &crc_count, 1);
snprintf(buf, 32, "CRC: %d ", crc_count);
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)
{
case BUTTON_STOP:
return;
case BUTTON_LEFT:
currval--;
if(currval < 0)
currval = 11;
break;
case BUTTON_RIGHT:
currval++;
if(currval > 11)
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