117 lines
3.1 KiB
C
117 lines
3.1 KiB
C
/*
|
|
* This file is part of Luma3DS.
|
|
* Copyright (C) 2016-2020 Aurora Wright, TuxSH
|
|
*
|
|
* SPDX-License-Identifier: (MIT OR GPL-2.0-or-later)
|
|
*/
|
|
|
|
#include "gdb/breakpoints.h"
|
|
|
|
#define _REENT_ONLY
|
|
#include <errno.h>
|
|
|
|
u32 GDB_FindClosestBreakpointSlot(GDBContext *ctx, u32 address)
|
|
{
|
|
if(ctx->nbBreakpoints == 0 || address <= ctx->breakpoints[0].address)
|
|
return 0;
|
|
else if(address > ctx->breakpoints[ctx->nbBreakpoints - 1].address)
|
|
return ctx->nbBreakpoints;
|
|
|
|
u32 a = 0, b = ctx->nbBreakpoints - 1, m;
|
|
|
|
do
|
|
{
|
|
m = (a + b) / 2;
|
|
if(ctx->breakpoints[m].address < address)
|
|
a = m;
|
|
else if(ctx->breakpoints[m].address > address)
|
|
b = m;
|
|
else
|
|
return m;
|
|
}
|
|
while(b - a > 1);
|
|
|
|
return b;
|
|
}
|
|
|
|
int GDB_GetBreakpointInstruction(u32 *instruction, GDBContext *ctx, u32 address)
|
|
{
|
|
u32 id = GDB_FindClosestBreakpointSlot(ctx, address);
|
|
|
|
if(id == ctx->nbBreakpoints || ctx->breakpoints[id].address != address)
|
|
return -EINVAL;
|
|
|
|
if(instruction != NULL)
|
|
*instruction = ctx->breakpoints[id].savedInstruction;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int GDB_AddBreakpoint(GDBContext *ctx, u32 address, bool thumb, bool persist)
|
|
{
|
|
if(!thumb && (address & 3) != 0)
|
|
return -EINVAL;
|
|
|
|
address &= ~1;
|
|
|
|
u32 id = GDB_FindClosestBreakpointSlot(ctx, address);
|
|
|
|
if(id != ctx->nbBreakpoints && ctx->breakpoints[id].instructionSize != 0 && ctx->breakpoints[id].address == address)
|
|
return 0;
|
|
else if(ctx->nbBreakpoints == MAX_BREAKPOINT)
|
|
return -EBUSY;
|
|
|
|
for(u32 i = ctx->nbBreakpoints; i > id && i != 0; i--)
|
|
ctx->breakpoints[i] = ctx->breakpoints[i - 1];
|
|
|
|
ctx->nbBreakpoints++;
|
|
|
|
Breakpoint *bkpt = &ctx->breakpoints[id];
|
|
u32 instr = thumb ? BREAKPOINT_INSTRUCTION_THUMB : BREAKPOINT_INSTRUCTION_ARM;
|
|
if(R_FAILED(svcReadProcessMemory(&bkpt->savedInstruction, ctx->debug, address, thumb ? 2 : 4)) ||
|
|
R_FAILED(svcWriteProcessMemory(ctx->debug, &instr, address, thumb ? 2 : 4)))
|
|
{
|
|
for(u32 i = id; i < ctx->nbBreakpoints - 1; i++)
|
|
ctx->breakpoints[i] = ctx->breakpoints[i + 1];
|
|
|
|
memset(&ctx->breakpoints[--ctx->nbBreakpoints], 0, sizeof(Breakpoint));
|
|
return -EFAULT;
|
|
}
|
|
|
|
bkpt->instructionSize = thumb ? 2 : 4;
|
|
bkpt->address = address;
|
|
bkpt->persistent = persist;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int GDB_DisableBreakpointById(GDBContext *ctx, u32 id)
|
|
{
|
|
Breakpoint *bkpt = &ctx->breakpoints[id];
|
|
if(R_FAILED(svcWriteProcessMemory(ctx->debug, &bkpt->savedInstruction, bkpt->address, bkpt->instructionSize)))
|
|
return -EFAULT;
|
|
else return 0;
|
|
}
|
|
|
|
int GDB_RemoveBreakpoint(GDBContext *ctx, u32 address)
|
|
{
|
|
address &= ~1;
|
|
|
|
u32 id = GDB_FindClosestBreakpointSlot(ctx, address);
|
|
if(id == ctx->nbBreakpoints || ctx->breakpoints[id].address != address)
|
|
return -EINVAL;
|
|
|
|
int r = GDB_DisableBreakpointById(ctx, id);
|
|
if(r != 0)
|
|
return r;
|
|
else
|
|
{
|
|
for(u32 i = id; i < ctx->nbBreakpoints - 1; i++)
|
|
ctx->breakpoints[i] = ctx->breakpoints[i + 1];
|
|
|
|
memset(&ctx->breakpoints[--ctx->nbBreakpoints], 0, sizeof(Breakpoint));
|
|
|
|
return 0;
|
|
}
|
|
}
|