debugcmds: Add support for reading/writing 32bit values

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
Kevin O'Connor 2019-02-07 11:48:37 -05:00
parent 1f9208dc66
commit af8376e203
1 changed files with 25 additions and 29 deletions

View File

@ -1,9 +1,10 @@
// Debugging commands. // Debugging commands.
// //
// Copyright (C) 2016,2017 Kevin O'Connor <kevin@koconnor.net> // Copyright (C) 2016-2019 Kevin O'Connor <kevin@koconnor.net>
// //
// This file may be distributed under the terms of the GNU GPLv3 license. // This file may be distributed under the terms of the GNU GPLv3 license.
#include "board/io.h" // readl
#include "board/irq.h" // irq_save #include "board/irq.h" // irq_save
#include "command.h" // DECL_COMMAND #include "command.h" // DECL_COMMAND
#include "sched.h" // sched_add_timer #include "sched.h" // sched_add_timer
@ -44,44 +45,39 @@ DECL_COMMAND(command_end_group, "end_group");
****************************************************************/ ****************************************************************/
void void
command_debug_read8(uint32_t *args) command_debug_read(uint32_t *args)
{ {
uint8_t *ptr = (void*)(size_t)args[0]; uint8_t order = args[0];
uint16_t v = *ptr; void *ptr = (void*)(size_t)args[1];
sendf("debug_result val=%hu", v); uint32_t v;
}
DECL_COMMAND_FLAGS(command_debug_read8, HF_IN_SHUTDOWN, "debug_read8 addr=%u");
void
command_debug_read16(uint32_t *args)
{
uint16_t *ptr = (void*)(size_t)args[0];
irqstatus_t flag = irq_save(); irqstatus_t flag = irq_save();
uint16_t v = *ptr; switch (order) {
default: case 0: v = readb(ptr); break;
case 1: v = readw(ptr); break;
case 2: v = readl(ptr); break;
}
irq_restore(flag); irq_restore(flag);
sendf("debug_result val=%hu", v); sendf("debug_result val=%u", v);
} }
DECL_COMMAND_FLAGS(command_debug_read16, HF_IN_SHUTDOWN, "debug_read16 addr=%u"); DECL_COMMAND_FLAGS(command_debug_read, HF_IN_SHUTDOWN,
"debug_read order=%c addr=%u");
void void
command_debug_write8(uint32_t *args) command_debug_write(uint32_t *args)
{ {
uint8_t *ptr = (void*)(size_t)args[0]; uint8_t order = args[0];
*ptr = args[1]; void *ptr = (void*)(size_t)args[1];
} uint32_t v = args[2];
DECL_COMMAND_FLAGS(command_debug_write8, HF_IN_SHUTDOWN,
"debug_write8 addr=%u val=%u");
void
command_debug_write16(uint32_t *args)
{
uint16_t *ptr = (void*)(size_t)args[0];
irqstatus_t flag = irq_save(); irqstatus_t flag = irq_save();
*ptr = args[1]; switch (order) {
default: case 0: writeb(ptr, v); break;
case 1: writew(ptr, v); break;
case 2: writel(ptr, v); break;
}
irq_restore(flag); irq_restore(flag);
} }
DECL_COMMAND_FLAGS(command_debug_write16, HF_IN_SHUTDOWN, DECL_COMMAND_FLAGS(command_debug_write, HF_IN_SHUTDOWN,
"debug_write16 addr=%u val=%u"); "debug_write order=%c addr=%u val=%u");
void void
command_debug_ping(uint32_t *args) command_debug_ping(uint32_t *args)