/*
 * SPDX-FileCopyrightText: 2021-2022 Espressif Systems (Shanghai) CO LTD
 *
 * SPDX-License-Identifier: Apache-2.0
 */

// This module implements debug/trace stubs. The stub is a piece of special code which can invoked by OpenOCD
// Currently one stub is used for GCOV functionality
//

#include "esp_cpu.h"
#include "esp_log.h"
#include "riscv/semihosting.h"

const static char *TAG = "esp_dbg_stubs";

#define RISCV_DBG_STUBS_SYSNR    0x65

/* Advertises apptrace control block address to host */
static int esp_dbg_stubs_advertise_table(void *stub_table_addr)
{
    if (!esp_cpu_in_ocd_debug_mode()) {
        return 0;
    }
    return (int) semihosting_call_noerrno(RISCV_DBG_STUBS_SYSNR, (long*)stub_table_addr);
}

void esp_dbg_stubs_ll_init(void *stub_table_addr)
{
    // notify host about control block address
    int res = esp_dbg_stubs_advertise_table(stub_table_addr);
    assert(res == 0 && "Failed to send debug stubs table address to host!");
    ESP_LOGV(TAG, "%s stubs %x", __func__, stub_table_addr);
}