//
// Created by lujun on 7/13/19.
//

#ifndef DSP_COMMON_H
#define DSP_COMMON_H

#include <stdint.h>
#include <stdio.h>
#include "hal_mtimer.h"

extern void bflb_platform_printf(char *fmt, ...);
extern void bflb_platform_init(uint32_t baudrate);

#define MSG(a, ...)     bflb_platform_printf(a, ##__VA_ARGS__)
#define MSG_DBG(a, ...) bflb_platform_printf(a, ##__VA_ARGS__)
#define MSG_ERR(a, ...) bflb_platform_printf(a, ##__VA_ARGS__)

#undef printf
#define printf(a, ...)  bflb_platform_printf(a, ##__VA_ARGS__)
#ifdef __riscv

#define read_csr(reg)                                                          \
    ({                                                                         \
        unsigned int __temp;                                                   \
        __ASM volatile("csrr %0, " #reg : "=r"(__temp));                         \
        __temp;                                                                \
    })

#if __riscv_xlen == 32
static inline uint64_t read_cpu_cycle(void)
{
    uint32_t hi = 0, hi1 = 0, lo = 0;
    uint64_t val = 0;
    hi = read_csr(cycleh);
    lo = read_csr(cycle);
    hi1 = read_csr(cycleh);
    if (hi != hi1) {
        hi = read_csr(cycleh);
        lo = read_csr(cycle);
    }
    val = (((uint64_t)hi) << 32) | lo;
    return val;
}
static inline uint64_t read_cpu_instret(void)
{
    uint32_t hi = 0, hi1 = 0, lo = 0;
    uint64_t val = 0;
    hi = read_csr(instreth);
    lo = read_csr(instret);
    hi1 = read_csr(instreth);
    if (hi != hi1) {
        hi = read_csr(instreth);
        lo = read_csr(instret);
    }
    val = (((uint64_t)hi) << 32) | lo;
    return val;
}
#else
static inline uint64_t read_cpu_cycle(void)
{
    uint64_t val = 0;
    val = read_csr(cycle);
    return val;
}
static inline uint64_t read_cpu_instret(void)
{
    uint64_t val = 0;
    val = read_csr(instret);
    return val;
}
#endif
static inline void reset_cpu_cycle(void) { ; }
static inline void setup_vector(void) 
{ 
#if (defined (__RISCV_FEATURE_VECTOR) && (__RISCV_FEATURE_VECTOR == 1))
  __RV_CSR_SET(CSR_MSTATUS, 0x200);
#endif 
}
#endif /*__riscv*/


#ifndef READ_CYCLE
#define READ_CYCLE mtimer_get_time_us
#endif

#ifndef RESET_CYCLE
#define RESET_CYCLE reset_cpu_cycle
#endif

#ifndef INIT_VECTOR
#define INIT_VECTOR setup_vector
#endif

uint64_t enter_cycle;
uint64_t exit_cycle;
uint64_t start_cycle;
uint64_t end_cycle;
uint64_t cycle;
uint64_t extra_cost = 0;
uint32_t bench_ercd;

#define BENCH_TRST RESET_CYCLE();

#define BENCH_INIT                                                             \
    bflb_platform_init(0);                                                     \
    MSG("Benchmark Initialized\n");                                         \
    INIT_VECTOR();                                                             \
    BENCH_TRST                                                                 \
    start_cycle = READ_CYCLE();                                                \
    end_cycle = READ_CYCLE();                                                  \
    extra_cost = end_cycle - start_cycle;                                      \
    enter_cycle = READ_CYCLE();

#define BENCH_START(func)                                                      \
    bench_ercd = 0;                                                            \
    BENCH_TRST                                                                 \
    start_cycle = READ_CYCLE();

#define BENCH_END(func)                                                        \
    end_cycle = READ_CYCLE();                                                  \
    cycle = end_cycle - start_cycle - extra_cost;                              \
    MSG("CSV, %s, %lu\n", #func, cycle);

#define BENCH_ERROR(func) bench_ercd = 1;
#define BENCH_STATUS(func)                                                     \
    if (bench_ercd) {                                                          \
        MSG("ERROR, %s\n", #func);                                          \
    } else {                                                                   \
        MSG("SUCCESS, %s\n", #func);                                        \
    }

#define BENCH_FINISH                                                           \
    exit_cycle = READ_CYCLE();                                                 \
    cycle = exit_cycle - enter_cycle - extra_cost;                             \
    MSG("CSV, BENCH END, %llu\n", cycle);

#endif // DSP_COMMON_H