96 lines
2.4 KiB
C
96 lines
2.4 KiB
C
// Debugging commands.
|
|
//
|
|
// Copyright (C) 2016-2019 Kevin O'Connor <kevin@koconnor.net>
|
|
//
|
|
// 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 "command.h" // DECL_COMMAND
|
|
#include "sched.h" // sched_add_timer
|
|
|
|
|
|
/****************************************************************
|
|
* Group commands
|
|
****************************************************************/
|
|
|
|
static struct timer group_timer;
|
|
|
|
static uint_fast8_t
|
|
group_end_event(struct timer *timer)
|
|
{
|
|
shutdown("Missed scheduling of next event");
|
|
}
|
|
|
|
void
|
|
command_start_group(uint32_t *args)
|
|
{
|
|
sched_del_timer(&group_timer);
|
|
group_timer.func = group_end_event;
|
|
group_timer.waketime = args[0];
|
|
sched_add_timer(&group_timer);
|
|
}
|
|
DECL_COMMAND(command_start_group, "start_group clock=%u");
|
|
|
|
void
|
|
command_end_group(uint32_t *args)
|
|
{
|
|
sched_del_timer(&group_timer);
|
|
}
|
|
DECL_COMMAND(command_end_group, "end_group");
|
|
|
|
|
|
/****************************************************************
|
|
* Register debug commands
|
|
****************************************************************/
|
|
|
|
void
|
|
command_debug_read(uint32_t *args)
|
|
{
|
|
uint8_t order = args[0];
|
|
void *ptr = (void*)(size_t)args[1];
|
|
uint32_t v;
|
|
irqstatus_t flag = irq_save();
|
|
switch (order) {
|
|
default: case 0: v = readb(ptr); break;
|
|
case 1: v = readw(ptr); break;
|
|
case 2: v = readl(ptr); break;
|
|
}
|
|
irq_restore(flag);
|
|
sendf("debug_result val=%u", v);
|
|
}
|
|
DECL_COMMAND_FLAGS(command_debug_read, HF_IN_SHUTDOWN,
|
|
"debug_read order=%c addr=%u");
|
|
|
|
void
|
|
command_debug_write(uint32_t *args)
|
|
{
|
|
uint8_t order = args[0];
|
|
void *ptr = (void*)(size_t)args[1];
|
|
uint32_t v = args[2];
|
|
irqstatus_t flag = irq_save();
|
|
switch (order) {
|
|
default: case 0: writeb(ptr, v); break;
|
|
case 1: writew(ptr, v); break;
|
|
case 2: writel(ptr, v); break;
|
|
}
|
|
irq_restore(flag);
|
|
}
|
|
DECL_COMMAND_FLAGS(command_debug_write, HF_IN_SHUTDOWN,
|
|
"debug_write order=%c addr=%u val=%u");
|
|
|
|
void
|
|
command_debug_ping(uint32_t *args)
|
|
{
|
|
uint8_t len = args[0];
|
|
char *data = (void*)(size_t)args[1];
|
|
sendf("pong data=%*s", len, data);
|
|
}
|
|
DECL_COMMAND_FLAGS(command_debug_ping, HF_IN_SHUTDOWN, "debug_ping data=%*s");
|
|
|
|
void
|
|
command_debug_nop(uint32_t *args)
|
|
{
|
|
}
|
|
DECL_COMMAND_FLAGS(command_debug_nop, HF_IN_SHUTDOWN, "debug_nop data=%*s");
|