mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-12 07:57:21 +00:00
c0e9535e1d
To disable interrupts we need to reset corresponding flags in STATUS32 register. For this we need to OR flags for interrupts level1 and level2 and then AND with current value in STATUS32. Before that implementation was incorrect. Signed-off-by: Alexey Brodkin <abrodkin@synopsys.com> Signed-off-by: Igor Guryanov <guryanov@synopsys.com>
143 lines
3.1 KiB
C
143 lines
3.1 KiB
C
/*
|
|
* Copyright (C) 2013-2014 Synopsys, Inc. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/arcregs.h>
|
|
#include <asm/ptrace.h>
|
|
|
|
/* Bit values in STATUS32 */
|
|
#define E1_MASK (1 << 1) /* Level 1 interrupts enable */
|
|
#define E2_MASK (1 << 2) /* Level 2 interrupts enable */
|
|
|
|
int interrupt_init(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* returns true if interrupts had been enabled before we disabled them
|
|
*/
|
|
int disable_interrupts(void)
|
|
{
|
|
int status = read_aux_reg(ARC_AUX_STATUS32);
|
|
int state = (status & (E1_MASK | E2_MASK)) ? 1 : 0;
|
|
|
|
status &= ~(E1_MASK | E2_MASK);
|
|
/* STATUS32 register is updated indirectly with "FLAG" instruction */
|
|
__asm__("flag %0" : : "r" (status));
|
|
return state;
|
|
}
|
|
|
|
void enable_interrupts(void)
|
|
{
|
|
unsigned int status = read_aux_reg(ARC_AUX_STATUS32);
|
|
|
|
status |= E1_MASK | E2_MASK;
|
|
/* STATUS32 register is updated indirectly with "FLAG" instruction */
|
|
__asm__("flag %0" : : "r" (status));
|
|
}
|
|
|
|
static void print_reg_file(long *reg_rev, int start_num)
|
|
{
|
|
unsigned int i;
|
|
|
|
/* Print 3 registers per line */
|
|
for (i = start_num; i < start_num + 25; i++) {
|
|
printf("r%02u: 0x%08lx\t", i, (unsigned long)*reg_rev);
|
|
if (((i + 1) % 3) == 0)
|
|
printf("\n");
|
|
|
|
/* Because pt_regs has registers reversed */
|
|
reg_rev--;
|
|
}
|
|
|
|
/* Add new-line if none was inserted in the end of loop above */
|
|
if (((i + 1) % 3) != 0)
|
|
printf("\n");
|
|
}
|
|
|
|
void show_regs(struct pt_regs *regs)
|
|
{
|
|
printf("ECR:\t0x%08lx\n", regs->ecr);
|
|
printf("RET:\t0x%08lx\nBLINK:\t0x%08lx\nSTAT32:\t0x%08lx\n",
|
|
regs->ret, regs->blink, regs->status32);
|
|
printf("GP: 0x%08lx\t r25: 0x%08lx\t\n", regs->r26, regs->r25);
|
|
printf("BTA: 0x%08lx\t SP: 0x%08lx\t FP: 0x%08lx\n", regs->bta,
|
|
regs->sp, regs->fp);
|
|
printf("LPS: 0x%08lx\tLPE: 0x%08lx\tLPC: 0x%08lx\n", regs->lp_start,
|
|
regs->lp_end, regs->lp_count);
|
|
|
|
print_reg_file(&(regs->r0), 0);
|
|
}
|
|
|
|
void bad_mode(struct pt_regs *regs)
|
|
{
|
|
if (regs)
|
|
show_regs(regs);
|
|
|
|
panic("Resetting CPU ...\n");
|
|
}
|
|
|
|
void do_memory_error(unsigned long address, struct pt_regs *regs)
|
|
{
|
|
printf("Memory error exception @ 0x%lx\n", address);
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_instruction_error(unsigned long address, struct pt_regs *regs)
|
|
{
|
|
printf("Instruction error exception @ 0x%lx\n", address);
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_machine_check_fault(unsigned long address, struct pt_regs *regs)
|
|
{
|
|
printf("Machine check exception @ 0x%lx\n", address);
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_interrupt_handler(void)
|
|
{
|
|
printf("Interrupt fired\n");
|
|
bad_mode(0);
|
|
}
|
|
|
|
void do_itlb_miss(struct pt_regs *regs)
|
|
{
|
|
printf("I TLB miss exception\n");
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_dtlb_miss(struct pt_regs *regs)
|
|
{
|
|
printf("D TLB miss exception\n");
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_tlb_prot_violation(unsigned long address, struct pt_regs *regs)
|
|
{
|
|
printf("TLB protection violation or misaligned access @ 0x%lx\n",
|
|
address);
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_privilege_violation(struct pt_regs *regs)
|
|
{
|
|
printf("Privilege violation exception\n");
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_trap(struct pt_regs *regs)
|
|
{
|
|
printf("Trap exception\n");
|
|
bad_mode(regs);
|
|
}
|
|
|
|
void do_extension(struct pt_regs *regs)
|
|
{
|
|
printf("Extension instruction exception\n");
|
|
bad_mode(regs);
|
|
}
|