Subversion Repositories riscv_vhdl

/**
 * @file
 * @copyright  Copyright 2016 GNSS Sensor Ltd. All right reserved.
 * @author     Sergey Khabarov - sergeykhbr@gmail.com
 * @brief      Add or remove memory breakpoint.
 */
 
#include "cmd_br.h"
 
namespace debugger {
 
CmdBr::CmdBr(ITap *tap, ISocInfo *info) 
    : ICommand ("br", tap, info) {
 
    briefDescr_.make_string("Add or remove breakpoint.");
    detailedDescr_.make_string(
        "Description:\n"
        "    Get breakpoints list or add/remove breakpoint with specified\n"
        "    flags.\n"
        "Response:\n"
        "    List of lists [[iii]*] if breakpoint list was requested, where:\n"
        "        i|s  - uint64_t address value or 'string' symbol name\n"
        "        i    - uint32_t instruction value\n"
        "        i    - uint64_t Breakpoint flags: hardware,...\n"
        "    Nil in a case of add/rm breakpoint\n"
        "Usage:\n"
        "    br"
        "    br add <addr>\n"
        "    br rm <addr>\n"
        "    br rm 'symbol_name'\n"
        "    br add <addr> hw\n"
        "Example:\n"
        "    br add 0x10000000\n"
        "    br add 0x00020040 hw\n"
        "    br add 'func1'\n"
        "    br rm 0x10000000\n"
        "    br rm 'func1'\n");
 
    AttributeType lstServ;
    RISCV_get_services_with_iface(IFACE_SOURCE_CODE, &lstServ);
    isrc_ = 0;
    if (lstServ.size() != 0) {
        IService *iserv = static_cast<IService *>(lstServ[0u].to_iface());
        isrc_ = static_cast<ISourceCode *>(
                            iserv->getInterface(IFACE_SOURCE_CODE));
    }
}
 
bool CmdBr::isValid(AttributeType *args) {
    if ((*args)[0u].is_equal(cmdName_.to_string()) 
        && (args->size() == 1 || (args->size() >= 3 && (*args)[1].is_string()))
        ) {
        return CMD_VALID;
    }
    return CMD_INVALID;
}
 
void CmdBr::exec(AttributeType *args, AttributeType *res) {
    res->make_nil();
    if (!isrc_ || !isValid(args)) {
        generateError(res, "Wrong argument list");
        return;
    }
    if (args->size() == 1) {
        isrc_->getBreakpointList(res);
        return;
    }
 
    uint64_t flags = 0;
    if (args->size() == 4 && (*args)[3].is_equal("hw")) {
        flags |= BreakFlag_HW;
    }
 
    DsuMapType *pdsu = info_->getpDsu();
 
    Reg64Type braddr;
    Reg64Type brinstr;
    AttributeType &bpadr = (*args)[2];
    if (bpadr.is_integer()) {
        braddr.val = bpadr.to_uint64();
    } else if (bpadr.is_string()) {
        if (isrc_->symbol2Address(bpadr.to_string(), &braddr.val) < 0) {
            generateError(res, "Symbol not found");
            return;
        }
    } else {
        generateError(res, "Wrong command format");
        return;
    }
 
    if ((*args)[1].is_equal("add")) {
        brinstr.val = 0;
        tap_->read(braddr.val, 4, brinstr.buf);
 
        isrc_->registerBreakpoint(braddr.val, flags, brinstr.val);
        if (flags & BreakFlag_HW) {
            uint64_t dsuaddr = 
                reinterpret_cast<uint64_t>(&pdsu->udbg.v.add_breakpoint);
            tap_->write(dsuaddr, 8, braddr.buf);
        } else {
            if ((brinstr.val & 0x3) == 0x3) {
                brinstr.buf32[0] = 0x00100073;  // EBREAK instruction
            } else {
                brinstr.buf16[0] = 0x9002;      // C.EBREAK instruction
            }
            tap_->write(braddr.val, 4, brinstr.buf);
        }
        return;
    } 
 
    if ((*args)[1].is_equal("rm")) {
        isrc_->unregisterBreakpoint(braddr.val, &flags, &brinstr.val);
        if (flags & BreakFlag_HW) {
            uint64_t dsuaddr = 
                reinterpret_cast<uint64_t>(&pdsu->udbg.v.remove_breakpoint);
            tap_->write(dsuaddr, 8, braddr.buf);
        } else {
            tap_->write(braddr.val, 4, brinstr.buf);
        }
    }
}
 
}  // namespace debugger