127 lines
3.8 KiB
C
127 lines
3.8 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2009 by David Brownell *
|
|
* *
|
|
* This program is free software; you can redistribute it and/or modify *
|
|
* it under the terms of the GNU General Public License as published by *
|
|
* the Free Software Foundation; either version 2 of the License, or *
|
|
* (at your option) any later version. *
|
|
* *
|
|
* This program is distributed in the hope that it will be useful, *
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
|
* GNU General Public License for more details. *
|
|
* *
|
|
* You should have received a copy of the GNU General Public License *
|
|
* along with this program; if not, write to the *
|
|
* Free Software Foundation, Inc., *
|
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
|
***************************************************************************/
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <helper/replacements.h>
|
|
|
|
#include "armv7a.h"
|
|
#include "arm_disassembler.h"
|
|
|
|
#include "register.h"
|
|
#include <helper/binarybuffer.h>
|
|
#include <helper/command.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
#include "arm_opcodes.h"
|
|
|
|
|
|
static void armv7a_show_fault_registers(struct target *target)
|
|
{
|
|
uint32_t dfsr, ifsr, dfar, ifar;
|
|
struct armv7a_common *armv7a = target_to_armv7a(target);
|
|
struct arm_dpm *dpm = armv7a->armv4_5_common.dpm;
|
|
int retval;
|
|
|
|
retval = dpm->prepare(dpm);
|
|
if (retval != ERROR_OK)
|
|
return;
|
|
|
|
/* ARMV4_5_MRC(cpnum, op1, r0, CRn, CRm, op2) */
|
|
|
|
/* c5/c0 - {data, instruction} fault status registers */
|
|
retval = dpm->instr_read_data_r0(dpm,
|
|
ARMV4_5_MRC(15, 0, 0, 5, 0, 0),
|
|
&dfsr);
|
|
if (retval != ERROR_OK)
|
|
goto done;
|
|
|
|
retval = dpm->instr_read_data_r0(dpm,
|
|
ARMV4_5_MRC(15, 0, 0, 5, 0, 1),
|
|
&ifsr);
|
|
if (retval != ERROR_OK)
|
|
goto done;
|
|
|
|
/* c6/c0 - {data, instruction} fault address registers */
|
|
retval = dpm->instr_read_data_r0(dpm,
|
|
ARMV4_5_MRC(15, 0, 0, 6, 0, 0),
|
|
&dfar);
|
|
if (retval != ERROR_OK)
|
|
goto done;
|
|
|
|
retval = dpm->instr_read_data_r0(dpm,
|
|
ARMV4_5_MRC(15, 0, 0, 6, 0, 2),
|
|
&ifar);
|
|
if (retval != ERROR_OK)
|
|
goto done;
|
|
|
|
LOG_USER("Data fault registers DFSR: %8.8" PRIx32
|
|
", DFAR: %8.8" PRIx32, dfsr, dfar);
|
|
LOG_USER("Instruction fault registers IFSR: %8.8" PRIx32
|
|
", IFAR: %8.8" PRIx32, ifsr, ifar);
|
|
|
|
done:
|
|
/* (void) */ dpm->finish(dpm);
|
|
}
|
|
|
|
int armv7a_arch_state(struct target *target)
|
|
{
|
|
static const char *state[] =
|
|
{
|
|
"disabled", "enabled"
|
|
};
|
|
|
|
struct armv7a_common *armv7a = target_to_armv7a(target);
|
|
struct arm *armv4_5 = &armv7a->armv4_5_common;
|
|
|
|
if (armv7a->common_magic != ARMV7_COMMON_MAGIC)
|
|
{
|
|
LOG_ERROR("BUG: called for a non-ARMv7A target");
|
|
return ERROR_INVALID_ARGUMENTS;
|
|
}
|
|
|
|
arm_arch_state(target);
|
|
|
|
LOG_USER("MMU: %s, D-Cache: %s, I-Cache: %s",
|
|
state[armv7a->armv4_5_mmu.mmu_enabled],
|
|
state[armv7a->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled],
|
|
state[armv7a->armv4_5_mmu.armv4_5_cache.i_cache_enabled]);
|
|
|
|
if (armv4_5->core_mode == ARM_MODE_ABT)
|
|
armv7a_show_fault_registers(target);
|
|
if (target->debug_reason == DBG_REASON_WATCHPOINT)
|
|
LOG_USER("Watchpoint triggered at PC %#08x",
|
|
(unsigned) armv7a->dpm.wp_pc);
|
|
|
|
return ERROR_OK;
|
|
}
|
|
|
|
|
|
const struct command_registration armv7a_command_handlers[] = {
|
|
{
|
|
.chain = dap_command_handlers,
|
|
},
|
|
COMMAND_REGISTRATION_DONE
|
|
};
|
|
|