forked from Imagelibrary/rtems
48 lines
1.1 KiB
C
48 lines
1.1 KiB
C
/**
|
|
* @file
|
|
*
|
|
* @ingroup RTEMSBSPsARMTMS570
|
|
*
|
|
* @brief Reset code.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 2015 Taller Technologies.
|
|
*
|
|
* @author Martin Galvan <martin.galvan@tallertechnologies.com>
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
* http://www.rtems.org/license/LICENSE.
|
|
*/
|
|
|
|
#include <bsp.h>
|
|
#include <bsp/bootcard.h>
|
|
#include <bsp/tms570.h>
|
|
#include <bsp/start.h>
|
|
|
|
static void handle_esm_errors(uint32_t esm_irq_channel)
|
|
{
|
|
/* ESMR3 errors don't generate interrupts. */
|
|
if (esm_irq_channel < 0x20u) {
|
|
TMS570_ESM.SR[0] = 1 << esm_irq_channel;
|
|
} else if (esm_irq_channel < 0x40u) {
|
|
TMS570_ESM.SR[1] = 1 << (esm_irq_channel - 32u);
|
|
} else if (esm_irq_channel < 0x60u) {
|
|
TMS570_ESM.SR4 = 1 << (esm_irq_channel - 64u);
|
|
}
|
|
}
|
|
|
|
void bsp_reset(void)
|
|
{
|
|
uint32_t esm_irq_channel = TMS570_ESM.IOFFHR - 1;
|
|
|
|
if (esm_irq_channel) {
|
|
handle_esm_errors(esm_irq_channel);
|
|
}
|
|
|
|
/* Reset the board */
|
|
/* write of value other than 1 cause system reset */
|
|
TMS570_SYS1.SYSECR = TMS570_SYS1_SYSECR_RESET(2);
|
|
}
|