Subversion Repositories riscv_vhdl

/**

 * @file

 * @copyright  Copyright 2017 GNSS Sensor Ltd. All right reserved.

 * @author     Sergey Khabarov - sergeykhbr@gmail.com

 * @brief      Read CPU stack trace buffer.

 */

#include "cmd_stack.h"

#include "iservice.h"

#include "coreservices/ielfreader.h"

namespace debugger {

CmdStack::CmdStack(ITap *tap, ISocInfo *info)

    : ICommand ("stack", tap, info) {

    briefDescr_.make_string("Read CPU Stack Trace buffer");

    detailedDescr_.make_string(

        "Description:\n"

        "    Read CPU stack trace buffer. Buffer's size is defined\n"

        "    by VHDL configuration parameter:\n"

        "Usage:\n"

        "    stack <depth>\n"

        "Example:\n"

        "    stack\n"

        "    stack 3\n");

}

bool CmdStack::isValid(AttributeType *args) {

    if ((*args)[0u].is_equal(cmdName_.to_string()) && (args->size() == 1

       || (args->size() == 2 && (*args)[1].is_integer()))) {

        return CMD_VALID;

    }

    return CMD_INVALID;

}

void CmdStack::exec(AttributeType *args, AttributeType *res) {

    res->make_list(0);

    if (!isValid(args)) {

        generateError(res, "Wrong argument list");

        return;

    }

    Reg64Type t1;

    DsuMapType *pdsu = info_->getpDsu();

    uint64_t addr = reinterpret_cast<uint64_t>(&pdsu->ureg.v.stack_trace_cnt);

    t1.val = 0;

    tap_->read(addr, 8, t1.buf);

    addr = reinterpret_cast<uint64_t>(&pdsu->ureg.v.stack_trace_buf[0]);

    unsigned trace_sz = t1.buf32[0];

    if (args->size() == 2 && args[1].to_uint64() < trace_sz) {

        addr += 8 * (trace_sz - args[1].to_uint32());

        trace_sz = args[1].to_uint32();

    }

    if (trace_sz == 0) {

        return;

    }

    AttributeType tbuf, lstServ;

    uint64_t *p_data;

    IElfReader *elf = 0;

    uint64_t from_addr, to_addr;

    tbuf.make_data(16*trace_sz);

    tap_->read(addr, tbuf.size(), tbuf.data());

    RISCV_get_services_with_iface(IFACE_ELFREADER, &lstServ);

    if (lstServ.size() >= 0) {

        IService *iserv = static_cast<IService *>(lstServ[0u].to_iface());

        elf = static_cast<IElfReader *>(iserv->getInterface(IFACE_ELFREADER));

    }

    res->make_list(t1.buf32[0]);

    p_data = reinterpret_cast<uint64_t *>(tbuf.data());

    for (unsigned i = 0; i < trace_sz; i++) {

        AttributeType &item = (*res)[i];

        from_addr = p_data[2*(trace_sz - i) - 2];

        to_addr = p_data[2*(trace_sz - i) - 1];

        // [from, ['symb_name',symb_offset], to, ['symb_name',symb_offset]]

        item.make_list(4);

        item[0u].make_uint64(from_addr);

        item[2].make_uint64(to_addr);

        if (elf) {

            elf->addressToSymbol(from_addr, &item[1]);

            elf->addressToSymbol(to_addr, &item[3]);

        }

    }

}

}  // namespace debugger