242 lines
7.4 KiB
C
242 lines
7.4 KiB
C
//*----------------------------------------------------------------------------
|
|
//* ATMEL Microcontroller Software Support - ROUSSET -
|
|
//*----------------------------------------------------------------------------
|
|
//* The software is delivered "AS IS" without warranty or condition of any
|
|
//* kind, either express, implied or statutory. This includes without
|
|
//* limitation any warranty or condition with respect to merchantability or
|
|
//* fitness for any particular purpose, or against the infringements of
|
|
//* intellectual property rights of others.
|
|
//*----------------------------------------------------------------------------
|
|
//* File Name : Debug.c
|
|
//* Object : Debug menu
|
|
//* Creation : JPP 14/Sep/2004
|
|
//* 1.1 29/Aug/05 JPP : Update AIC definion
|
|
//*----------------------------------------------------------------------------
|
|
|
|
// modified for WinARM example (remove scanf-function)
|
|
// by Martin Thomas
|
|
|
|
// Include Standard files
|
|
#include "Board.h"
|
|
#include "dbgu.h"
|
|
#include "rc632.h"
|
|
#include "openpcd.h"
|
|
#define USART_SYS_LEVEL 4
|
|
/*---------------------------- Global Variable ------------------------------*/
|
|
//*--------------------------1--------------------------------------------------
|
|
//* \fn AT91F_DBGU_Printk
|
|
//* \brief This function is used to send a string through the DBGU channel
|
|
//*----------------------------------------------------------------------------
|
|
void AT91F_DBGU_Ready(void)
|
|
{
|
|
while (!(AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_TXEMPTY)) ;
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* Function Name : Send_reset
|
|
//* Object : Acknoledeg AIC and send reset
|
|
//*----------------------------------------------------------------------------
|
|
static void Send_reset(void)
|
|
{
|
|
void (*pfct) (void) = (void (*)(void))0x00000000;
|
|
|
|
// Acknoledge the interrupt
|
|
// Mark the End of Interrupt on the AIC
|
|
AT91C_BASE_AIC->AIC_EOICR = 0;
|
|
AT91F_DBGU_Ready();
|
|
// Jump in reset
|
|
pfct();
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* Function Name : DBGU_irq_handler
|
|
//* Object : C handler interrupt function called by the interrupts
|
|
//* assembling routine
|
|
//*----------------------------------------------------------------------------
|
|
static void DBGU_irq_handler(void)
|
|
{
|
|
char value;
|
|
|
|
AT91F_DBGU_Get(&value);
|
|
switch (value) {
|
|
case '0': //* info
|
|
AT91F_DBGU_Frame("Set Pull up\n\r");
|
|
// Set
|
|
AT91F_PIO_ClearOutput(AT91C_BASE_PIOA, AT91C_PIO_UDP_PUP);
|
|
break;
|
|
case '1': //* info
|
|
AT91F_PIO_SetOutput(AT91C_BASE_PIOA, AT91C_PIO_UDP_PUP);
|
|
AT91F_DBGU_Printk("Clear Pull up\n\r");
|
|
// Reset Application
|
|
Send_reset();
|
|
break;
|
|
case '2':
|
|
AT91F_DBGU_Printk("Toggling LED 1\n\r");
|
|
led_toggle(1);
|
|
break;
|
|
case '3':
|
|
AT91F_DBGU_Printk("Toggling LED 2\n\r");
|
|
led_toggle(2);
|
|
break;
|
|
case '4':
|
|
AT91F_DBGU_Printk("Testing RC632 : ");
|
|
if (rc632_test() == 0)
|
|
AT91F_DBGU_Printk("SUCCESS!\n\r");
|
|
else
|
|
AT91F_DBGU_Printk("ERROR!\n\r");
|
|
|
|
break;
|
|
case '5':
|
|
DEBUGPCR("Reading RC632 Reg RxWait: 0x%02xr",
|
|
rc632_reg_read(RC632_REG_RX_WAIT));
|
|
|
|
break;
|
|
case '6':
|
|
DEBUGPCR("Writing RC632 Reg RxWait: 0x%02x",
|
|
rc632_reg_write(RC632_REG_RX_WAIT, 0x55));
|
|
break;
|
|
case '7':
|
|
rc632_dump();
|
|
break;
|
|
default:
|
|
AT91F_DBGU_Printk("\n\r");
|
|
break;
|
|
} // end switch
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* \fn AT91F_DBGU_Init
|
|
//* \brief This function is used to send a string through the DBGU channel (Very low level debugging)
|
|
//*----------------------------------------------------------------------------
|
|
void AT91F_DBGU_Init(void)
|
|
{
|
|
//* Open PIO for DBGU
|
|
AT91F_DBGU_CfgPIO();
|
|
//* Enable Transmitter & receivier
|
|
((AT91PS_USART) AT91C_BASE_DBGU)->US_CR =
|
|
AT91C_US_RSTTX | AT91C_US_RSTRX;
|
|
|
|
//* Configure DBGU
|
|
AT91F_US_Configure((AT91PS_USART) AT91C_BASE_DBGU, // DBGU base address
|
|
MCK, AT91C_US_ASYNC_MODE, // Mode Register to be programmed
|
|
AT91C_DBGU_BAUD, // Baudrate to be programmed
|
|
0); // Timeguard to be programmed
|
|
|
|
//* Enable Transmitter & receivier
|
|
((AT91PS_USART) AT91C_BASE_DBGU)->US_CR = AT91C_US_RXEN | AT91C_US_TXEN;
|
|
|
|
//* Enable USART IT error and AT91C_US_ENDRX
|
|
AT91F_US_EnableIt((AT91PS_USART) AT91C_BASE_DBGU, AT91C_US_RXRDY);
|
|
|
|
//* open interrupt
|
|
AT91F_AIC_ConfigureIt(AT91C_BASE_AIC, AT91C_ID_SYS, USART_SYS_LEVEL,
|
|
AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL,
|
|
DBGU_irq_handler);
|
|
AT91F_AIC_EnableIt(AT91C_BASE_AIC, AT91C_ID_SYS);
|
|
|
|
AT91F_DBGU_Printk
|
|
("\n\r-I- OpenPCD test mode\n\r 0) Set Pull-up 1) Clear Pull-up "
|
|
"2) Toggle LED1 3) Toggle LED2 4) Test RC632\n\r"
|
|
"5) Read RxWait 6) Write RxWait 7) Dump RC632 Regs\n\r");
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* \fn AT91F_DBGU_Printk
|
|
//* \brief This function is used to send a string through the DBGU channel (Very low level debugging)
|
|
//*----------------------------------------------------------------------------
|
|
void AT91F_DBGU_Printk(char *buffer)
|
|
{
|
|
while (*buffer != '\0') {
|
|
while (!AT91F_US_TxReady((AT91PS_USART) AT91C_BASE_DBGU)) ;
|
|
AT91F_US_PutChar((AT91PS_USART) AT91C_BASE_DBGU, *buffer++);
|
|
}
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* \fn AT91F_DBGU_Frame
|
|
//* \brief This function is used to send a string through the DBGU channel
|
|
//*----------------------------------------------------------------------------
|
|
void AT91F_DBGU_Frame(char *buffer)
|
|
{
|
|
unsigned char len;
|
|
|
|
for (len = 0; buffer[len] != '\0'; len++) {
|
|
}
|
|
AT91F_US_SendFrame((AT91PS_USART) AT91C_BASE_DBGU, buffer, len, 0, 0);
|
|
|
|
}
|
|
|
|
//*----------------------------------------------------------------------------
|
|
//* \fn AT91F_US_Get
|
|
//* \brief Get a Char to USART
|
|
//*----------------------------------------------------------------------------
|
|
int AT91F_DBGU_Get(char *val)
|
|
{
|
|
if ((AT91F_US_RxReady((AT91PS_USART) AT91C_BASE_DBGU)) == 0)
|
|
return (false);
|
|
else {
|
|
*val = AT91F_US_GetChar((AT91PS_USART) AT91C_BASE_DBGU);
|
|
return (true);
|
|
}
|
|
}
|
|
|
|
// mthomas: function not used in this application. avoid
|
|
// linking huge newlib code for sscanf.
|
|
|
|
#ifndef __WinARM__
|
|
//*----------------------------------------------------------------------------
|
|
//* \fn AT91F_DBGU_scanf
|
|
//* \brief Get a string to USART manage Blackspace and echo
|
|
//*----------------------------------------------------------------------------
|
|
void AT91F_DBGU_scanf(char *type, unsigned int *val)
|
|
{ //* Begin
|
|
unsigned int read = 0;
|
|
char buff[10];
|
|
unsigned int nb_read = 0;
|
|
|
|
while ((read != 0x0D) & (nb_read != sizeof(buff))) {
|
|
//* wait the USART Ready for reception
|
|
while ((AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_RXRDY) == 0) ;
|
|
//* Get a char
|
|
read = AT91C_BASE_DBGU->DBGU_RHR;
|
|
buff[nb_read] = (char)read;
|
|
//* Manage Blackspace
|
|
while ((AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_TXRDY) == 0) {
|
|
}
|
|
if ((char)read == 0x08) {
|
|
if (nb_read != 0) {
|
|
nb_read--;
|
|
AT91C_BASE_DBGU->DBGU_THR = read;
|
|
}
|
|
} else {
|
|
//* echo
|
|
AT91C_BASE_DBGU->DBGU_THR = read;
|
|
nb_read++;
|
|
}
|
|
}
|
|
//* scan the value
|
|
sscanf(buff, type, val);
|
|
} //* End
|
|
|
|
#endif
|
|
|
|
#ifdef DEBUG
|
|
#include <stdio.h>
|
|
#include <stdarg.h>
|
|
#include <string.h>
|
|
static char dbg_buf[256];
|
|
void debugp(const char *format, ...)
|
|
{
|
|
va_list ap;
|
|
|
|
va_start(ap, format);
|
|
vsnprintf(dbg_buf, sizeof(dbg_buf)-1, format, ap);
|
|
va_end(ap);
|
|
|
|
dbg_buf[sizeof(dbg_buf)-1] = '\0'; \
|
|
AT91F_DBGU_Printk(dbg_buf); \
|
|
}
|
|
#endif
|
|
|
|
|