[PATCH v4] cpukit/aarch64: Add ESR register decoding
Gedare Bloom
gedare at rtems.org
Tue Mar 23 15:38:24 UTC 2021
On Mon, Mar 22, 2021 at 3:32 PM Alex White <alex.white at oarcorp.com> wrote:
>
> ---
> .../aarch64/aarch64-exception-frame-print.c | 105 +++++++++++++++++-
> 1 file changed, 101 insertions(+), 4 deletions(-)
>
> diff --git a/cpukit/score/cpu/aarch64/aarch64-exception-frame-print.c b/cpukit/score/cpu/aarch64/aarch64-exception-frame-print.c
> index 59b5d06032..348151a468 100644
> --- a/cpukit/score/cpu/aarch64/aarch64-exception-frame-print.c
> +++ b/cpukit/score/cpu/aarch64/aarch64-exception-frame-print.c
> @@ -45,8 +45,90 @@
> #include <inttypes.h>
>
> #include <rtems/score/cpu.h>
> +#include <rtems/score/io.h>
> #include <rtems/bspIo.h>
>
> +static const char* _exception_class_to_string( uint16_t exception_class );
static symbol shouldn't need an _. An _ generally is reserved. I don't
know what our rules say about this, but anyway it is not needed here.
> +
> +static void _binary_sprintf(
ditto.
> + char *s,
> + size_t maxlen,
> + uint32_t num_bits,
> + uint32_t value
> +);
> +
> +static const char* _exception_class_to_string( uint16_t exception_class )
> +{
> + switch (exception_class)
> + {
> + case 0x01: return "Trapped WFI or WFE instruction";
indent two spaces, put the return on a newline, to adhere to score style.
> + case 0x03: return "Trapped MCR or MRC access with (coproc==0b1111)";
> + case 0x04: return "Trapped MCRR or MRRC access with (coproc==0b1111)";
> + case 0x05: return "Trapped MCR or MRC access with (coproc==0b1110)";
> + case 0x06: return "Trapped LDC or STC access";
> + case 0x0c: return "Trapped MRRC access with (coproc==0b1110)";
> + case 0x0e: return "Illegal Execution state";
> + case 0x18: return "Trapped MSR, MRS, or System instruction";
> + case 0x20: return "Instruction Abort from a lower Exception level";
> + case 0x21: return "Instruction Abort taken without a change in Exception "
> + "level";
> + case 0x22: return "PC alignment fault";
> + case 0x24: return "Data Abort from a lower Exception level";
> + case 0x25: return "Data Abort taken without a change in Exception level";
> + case 0x26: return "SP alignment fault";
> + case 0x30: return "Breakpoint exception from a lower Exception level";
> + case 0x31: return "Breakpoint exception taken without a change in "
> + "Exception level";
> + case 0x32: return "Software Step exception from a lower Exception level";
> + case 0x33: return "Software Step exception taken without a change in "
> + "Exception level";
> + case 0x34: return "Watchpoint exception from a lower Exception level";
> + case 0x35: return "Watchpoint exception taken without a change in "
> + "Exception level";
> + case 0x38: return "BKPT instruction execution in AArch32 state";
> + case 0x3c: return "BRK instruction execution in AArch64 state";
> + default: return "Unknown";
> + }
> +}
> +
> +typedef struct {
> + char *s;
> + size_t n;
> +} string_context;
> +
> +static void put_char(int c, void *arg)
> +{
> + string_context *sctx = arg;
> + size_t n = sctx->n;
> +
> + if (n > 0) {
> + char *s = sctx->s;
> + *s = (char)c;
> + sctx->s = s + 1;
> + sctx->n = n - 1;
> + }
> +}
> +
> +static void _binary_sprintf(
> + char *s,
> + size_t maxlen,
> + uint32_t num_bits,
> + uint32_t value
> +)
> +{
> + string_context sctx = {
> + .s = s,
> + .n = maxlen
> + };
> + uint32_t mask = 1<<(num_bits-1);
> + int cx = 0;
> +
> + while ( mask != 0 ) {
> + cx += _IO_Printf(put_char, &sctx, "%d", (value & mask ? 1 : 0));
> + mask >>= 1;
> + }
> +}
> +
> void _CPU_Exception_frame_print( const CPU_Exception_frame *frame )
> {
> printk(
> @@ -68,8 +150,7 @@ void _CPU_Exception_frame_print( const CPU_Exception_frame *frame )
> "X14 = 0x%016" PRIx64 " SP = 0x%016" PRIxPTR "\n"
> "X15 = 0x%016" PRIx64 " PC = 0x%016" PRIxPTR "\n"
> "X16 = 0x%016" PRIx64 " DAIF = 0x%016" PRIx64 "\n"
> - "VEC = 0x%016" PRIxPTR " CPSR = 0x%016" PRIx64 "\n"
> - "ESR = 0x%016" PRIx64 " FAR = 0x%016" PRIx64 "\n",
> + "VEC = 0x%016" PRIxPTR " CPSR = 0x%016" PRIx64 "\n",
> frame->register_x0, frame->register_x17,
> frame->register_x1, frame->register_x18,
> frame->register_x2, frame->register_x19,
> @@ -87,10 +168,26 @@ void _CPU_Exception_frame_print( const CPU_Exception_frame *frame )
> frame->register_x14, (intptr_t)frame->register_sp,
> frame->register_x15, (intptr_t)frame->register_pc,
> frame->register_x16, frame->register_daif,
> - (intptr_t) frame->vector, frame->register_cpsr,
> - frame->register_syndrome, frame->register_fault_address
> + (intptr_t) frame->vector, frame->register_cpsr
> );
>
> + uint32_t ec = (frame->register_syndrome >> 26) & 0x3f;
> + uint32_t il = (frame->register_syndrome >> 25) & 0x1;
> + uint32_t iss = frame->register_syndrome & 0x1ffffff;
> + char ec_str[7] = {0};
> + char iss_str[26] = {0};
> +
> + _binary_sprintf(ec_str, 7, 6, ec);
> + _binary_sprintf(iss_str, 26, 25, iss);
> +
> + printk(
> + "ESR = EC: 0b%s" " IL: 0b%d" " ISS: 0b%s" "\n"
> + " %s\n",
> + ec_str, il, iss_str, _exception_class_to_string(ec)
> + );
> +
> + printk( "FAR = 0x%016" PRIx64 "\n", frame->register_fault_address );
> +
> const uint128_t *qx = &frame->register_q0;
> int i;
prefer all the variable decls at the top of the function.
>
> --
> 2.27.0
>
> _______________________________________________
> devel mailing list
> devel at rtems.org
> http://lists.rtems.org/mailman/listinfo/devel
More information about the devel
mailing list