Browse Source

[bsp/cvitek]update cvitek sdhci drvier (#8874)

update cvitek sdhci drvier
flyingcys 1 year ago
parent
commit
aee6048a53

+ 1 - 1
bsp/cvitek/cv18xx_risc-v/rtconfig.py

@@ -41,7 +41,7 @@ if PLATFORM == 'gcc':
     OBJDUMP = PREFIX + 'objdump'
     OBJDUMP = PREFIX + 'objdump'
     OBJCPY  = PREFIX + 'objcopy'
     OBJCPY  = PREFIX + 'objcopy'
 
 
-    DEVICE  = ' -mcmodel=medany -mcpu=c906fdv -mabi=lp64'
+    DEVICE  = ' -mcmodel=medany -march=rv64imafdc -mabi=lp64'
     CFLAGS  = DEVICE + ' -Wno-cpp -fvar-tracking -ffreestanding -fno-common -ffunction-sections -fdata-sections -fstrict-volatile-bitfields -D_POSIX_SOURCE '
     CFLAGS  = DEVICE + ' -Wno-cpp -fvar-tracking -ffreestanding -fno-common -ffunction-sections -fdata-sections -fstrict-volatile-bitfields -D_POSIX_SOURCE '
     AFLAGS  = ' -c' + DEVICE + ' -x assembler-with-cpp -D__ASSEMBLY__'
     AFLAGS  = ' -c' + DEVICE + ' -x assembler-with-cpp -D__ASSEMBLY__'
     LFLAGS  = DEVICE + ' -nostartfiles -Wl,--gc-sections,-Map=rtthread.map,-cref,-u,_start -T link.lds' + ' -lsupc++ -lgcc -static'
     LFLAGS  = DEVICE + ' -nostartfiles -Wl,--gc-sections,-Map=rtthread.map,-cref,-u,_start -T link.lds' + ' -lsupc++ -lgcc -static'

+ 11 - 8
bsp/cvitek/drivers/drv_sdhci.c

@@ -10,9 +10,12 @@
 #include <rthw.h>
 #include <rthw.h>
 #include <rtthread.h>
 #include <rtthread.h>
 #include <rtdevice.h>
 #include <rtdevice.h>
-#include "stdbool.h"
+#include <stdbool.h>
+#include <stdlib.h>
+#include <stdio.h>
 
 
 #include "board.h"
 #include "board.h"
+#include "cache.h"
 
 
 #define DBG_TAG     "drv.sdio"
 #define DBG_TAG     "drv.sdio"
 #define DBG_LEVEL   DBG_INFO
 #define DBG_LEVEL   DBG_INFO
@@ -227,7 +230,7 @@ uint32_t sdhci_prepare_data(struct rthw_sdhci *sdhci, struct rt_mmcsd_cmd *cmd,
 
 
     load_addr = (uint64_t)dma_config->dma_des_buffer_start_addr;
     load_addr = (uint64_t)dma_config->dma_des_buffer_start_addr;
 
 
-    csi_dcache_clean_invalid_range((uint64_t *)load_addr, dma_config->dma_des_buffer_len);
+    rt_hw_cpu_dcache_clean((void *)load_addr, dma_config->dma_des_buffer_len);
 
 
     mmio_write_32(BASE + SDIF_ADMA_SA_LOW, load_addr);
     mmio_write_32(BASE + SDIF_ADMA_SA_LOW, load_addr);
     mmio_write_32(BASE + SDIF_ADMA_SA_HIGH, (load_addr >> 32));
     mmio_write_32(BASE + SDIF_ADMA_SA_HIGH, (load_addr >> 32));
@@ -367,7 +370,7 @@ static rt_err_t sdhci_send_data_cmd(struct rthw_sdhci *sdhci, struct rt_mmcsd_cm
 
 
         if (data->flags & DATA_DIR_READ)
         if (data->flags & DATA_DIR_READ)
         {
         {
-            csi_dcache_invalid_range((uint64_t *)dma_config.dma_des_buffer_start_addr, dma_config.dma_des_buffer_len);
+            rt_hw_cpu_dcache_invalidate((uint64_t *)dma_config.dma_des_buffer_start_addr, dma_config.dma_des_buffer_len);
             if (src_unalign)
             if (src_unalign)
             {
             {
                 memcpy((void *)data->buf, src_align, dma_config.dma_des_buffer_len);
                 memcpy((void *)data->buf, src_align, dma_config.dma_des_buffer_len);
@@ -862,7 +865,7 @@ static void rthw_sdhci_request(struct rt_mmcsd_host *host, struct rt_mmcsd_req *
                 data ? data->blksize : 0,
                 data ? data->blksize : 0,
                 data ? data->blks * data->blksize : 0);
                 data ? data->blks * data->blksize : 0);
 
 
-        if (cmd->cmd_code == 5)
+        if (cmd->cmd_code == SD_IO_SEND_OP_COND)
         {
         {
             cmd->err = -RT_ERROR;
             cmd->err = -RT_ERROR;
 
 
@@ -1003,7 +1006,7 @@ static int rthw_sdhci_init(void)
     /* set host default attributes */
     /* set host default attributes */
     host->ops = &ops;
     host->ops = &ops;
     host->freq_min = 400000;
     host->freq_min = 400000;
-    host->freq_max = 40000000;
+    host->freq_max = 50 * 1000 * 1000;
     host->valid_ocr = VDD_31_32 | VDD_32_33 | VDD_33_34;
     host->valid_ocr = VDD_31_32 | VDD_32_33 | VDD_33_34;
     host->flags = MMCSD_BUSWIDTH_4 | MMCSD_MUTBLKWRITE | MMCSD_SUP_HIGHSPEED;
     host->flags = MMCSD_BUSWIDTH_4 | MMCSD_MUTBLKWRITE | MMCSD_SUP_HIGHSPEED;
     host->max_seg_size = 512;
     host->max_seg_size = 512;
@@ -1021,12 +1024,12 @@ static int rthw_sdhci_init(void)
 }
 }
 INIT_DEVICE_EXPORT(rthw_sdhci_init);
 INIT_DEVICE_EXPORT(rthw_sdhci_init);
 
 
-void sdhci_register_dump(uint8_t argc, char **argv)
+void sdhci_reg_dump(uint8_t argc, char **argv)
 {
 {
     rt_uint32_t *base;
     rt_uint32_t *base;
     if (argc < 2)
     if (argc < 2)
     {
     {
-        rt_kprintf("Usage: sdhci_register_dump 0/1/2\n");
+        rt_kprintf("Usage: sdhci_reg_dump 0/1/2\n");
         return;
         return;
     }
     }
 
 
@@ -1088,4 +1091,4 @@ void sdhci_register_dump(uint8_t argc, char **argv)
            mmio_read_32(BASE + SDIF_ADMA_ADDRESS));
            mmio_read_32(BASE + SDIF_ADMA_ADDRESS));
     rt_kprintf("============================================\n");
     rt_kprintf("============================================\n");
 }
 }
-MSH_CMD_EXPORT(sdhci_register_dump, Dump SDHCI register);
+MSH_CMD_EXPORT(sdhci_reg_dump, dump sdhci register);

+ 0 - 2
bsp/cvitek/drivers/drv_sdhci.h

@@ -14,8 +14,6 @@
 #include "dw_sdmmc.h"
 #include "dw_sdmmc.h"
 #include "dw_mmc_reg.h"
 #include "dw_mmc_reg.h"
 
 
-#include "core_rv64.h"
-
 #ifndef BIT
 #ifndef BIT
 #define BIT(nr)      (UINT64_C(1) << (nr))
 #define BIT(nr)      (UINT64_C(1) << (nr))
 #endif
 #endif

+ 0 - 1314
bsp/cvitek/drivers/libraries/core_rv64.h

@@ -1,1314 +0,0 @@
-/*
- * Copyright (C) 2017-2019 Alibaba Group Holding Limited
- */
-
-
-/******************************************************************************
- * @file     core_rv64.h
- * @brief    CSI RV32 Core Peripheral Access Layer Header File
- * @version  V1.0
- * @date     01. Sep 2018
- ******************************************************************************/
-
-#ifndef __CORE_RV64_H_GENERIC
-#define __CORE_RV64_H_GENERIC
-
-#include <stdint.h>
-
-#ifdef __cplusplus
-extern "C" {
-#endif
-
-/*******************************************************************************
- *                 CSI definitions
- ******************************************************************************/
-/**
-  \ingroup RV32
-  @{
- */
-
-#ifndef __RV64
-#define __RV64                (0x01U)
-#endif
-
-/** __FPU_USED indicates whether an FPU is used or not.
-    This core does not support an FPU at all
-*/
-#define __FPU_USED       0U
-
-#if defined ( __GNUC__ )
-#if defined (__VFP_FP__) && !defined(__SOFTFP__)
-#error "Compiler generates FPU instructions for a device without an FPU (check __FPU_PRESENT)"
-#endif
-#endif
-
-#ifdef __cplusplus
-}
-#endif
-
-#endif /* __CORE_RV32_H_GENERIC */
-
-#ifndef __CSI_GENERIC
-
-#ifndef __CORE_RV32_H_DEPENDANT
-#define __CORE_RV32_H_DEPENDANT
-
-#ifdef __cplusplus
-extern "C" {
-#endif
-
-/* check device defines and use defaults */
-#ifndef __RV64_REV
-#define __RV64_REV               0x0000U
-#endif
-
-#ifndef __VIC_PRIO_BITS
-#define __VIC_PRIO_BITS           2U
-#endif
-
-#ifndef __Vendor_SysTickConfig
-#define __Vendor_SysTickConfig    1U
-#endif
-
-#ifndef __MPU_PRESENT
-#define __MPU_PRESENT             1U
-#endif
-
-#ifndef __ICACHE_PRESENT
-#define __ICACHE_PRESENT          1U
-#endif
-
-#ifndef __DCACHE_PRESENT
-#define __DCACHE_PRESENT          1U
-#endif
-
-
-#ifndef __L2CACHE_PRESENT
-#define __L2CACHE_PRESENT          1U
-#endif
-
-#include <csi_rv64_gcc.h>
-
-/* IO definitions (access restrictions to peripheral registers) */
-/**
-    \defgroup CSI_glob_defs CSI Global Defines
-
-    <strong>IO Type Qualifiers</strong> are used
-    \li to specify the access to peripheral variables.
-    \li for automatic generation of peripheral register debug information.
-*/
-#ifdef __cplusplus
-#define     __I      volatile             /*!< Defines 'read only' permissions */
-#else
-#define     __I      volatile const       /*!< Defines 'read only' permissions */
-#endif
-#define     __O      volatile             /*!< Defines 'write only' permissions */
-#define     __IO     volatile             /*!< Defines 'read / write' permissions */
-
-/* following defines should be used for structure members */
-#define     __IM     volatile const       /*! Defines 'read only' structure member permissions */
-#define     __OM     volatile             /*! Defines 'write only' structure member permissions */
-#define     __IOM    volatile             /*! Defines 'read / write' structure member permissions */
-
-/*@} end of group C906 */
-
-/*******************************************************************************
- *                 Register Abstraction
-  Core Register contain:
-  - Core Register
-  - Core CLINT Register
- ******************************************************************************/
-/**
-  \defgroup CSI_core_register Defines and Type Definitions
-  \brief Type definitions and defines for CK80X processor based devices.
-*/
-
-/**
-  \ingroup    CSI_core_register
-  \defgroup   CSI_CORE  Status and Control Registers
-  \brief      Core Register type definitions.
-  @{
- */
-
-/**
-  \ingroup    CSI_core_register
-  \defgroup   CSI_CLINT Core-Local Interrupt Controller (CLINT)
-  \brief      Type definitions for the CLINT Registers
-  @{
- */
-
-/**
-  \brief Access to the structure of a vector interrupt controller.
- */
-
-typedef struct {
-    uint32_t RESERVED0;                 /*!< Offset: 0x000 (R/W)  CLINT configure register */
-    __IOM uint32_t PLIC_PRIO[1023];
-    __IOM uint32_t PLIC_IP[32];
-    uint32_t RESERVED1[3972 / 4 - 1];
-    __IOM uint32_t PLIC_H0_MIE[32];
-    __IOM uint32_t PLIC_H0_SIE[32];
-    __IOM uint32_t PLIC_H1_MIE[32];
-    __IOM uint32_t PLIC_H1_SIE[32];
-    __IOM uint32_t PLIC_H2_MIE[32];
-    __IOM uint32_t PLIC_H2_SIE[32];
-    __IOM uint32_t PLIC_H3_MIE[32];
-    __IOM uint32_t PLIC_H3_SIE[32];
-    uint32_t RESERVED2[(0x01FFFFC - 0x00023FC) / 4 - 1];
-    __IOM uint32_t PLIC_PER;
-    __IOM uint32_t PLIC_H0_MTH;
-    __IOM uint32_t PLIC_H0_MCLAIM;
-    uint32_t RESERVED3[0xFFC / 4 - 1];
-    __IOM uint32_t PLIC_H0_STH;
-    __IOM uint32_t PLIC_H0_SCLAIM;
-    uint32_t RESERVED4[0xFFC / 4 - 1];
-
-    __IOM uint32_t PLIC_H1_MTH;
-    __IOM uint32_t PLIC_H1_MCLAIM;
-    uint32_t RESERVED5[0xFFC / 4 - 1];
-    __IOM uint32_t PLIC_H1_STH;
-    __IOM uint32_t PLIC_H1_SCLAIM;
-    uint32_t RESERVED6[0xFFC / 4 - 1];
-
-    __IOM uint32_t PLIC_H2_MTH;
-    __IOM uint32_t PLIC_H2_MCLAIM;
-    uint32_t RESERVED7[0xFFC / 4 - 1];
-    __IOM uint32_t PLIC_H2_STH;
-    __IOM uint32_t PLIC_H2_SCLAIM;
-    uint32_t RESERVED8[0xFFC / 4 - 1];
-
-    __IOM uint32_t PLIC_H3_MTH;
-    __IOM uint32_t PLIC_H3_MCLAIM;
-    uint32_t RESERVED9[0xFFC / 4 - 1];
-    __IOM uint32_t PLIC_H3_STH;
-    __IOM uint32_t PLIC_H3_SCLAIM;
-    uint32_t RESERVED10[0xFFC / 4 - 1];
-} PLIC_Type;
-
-
-/**
-  \ingroup    CSI_core_register
-  \defgroup   CSI_PMP Physical Memory Protection (PMP)
-  \brief      Type definitions for the PMP Registers
-  @{
- */
-
-#define PMP_PMPCFG_R_Pos                       0U                                    /*!< PMP PMPCFG: R Position */
-#define PMP_PMPCFG_R_Msk                       (0x1UL << PMP_PMPCFG_R_Pos)           /*!< PMP PMPCFG: R Mask */
-
-#define PMP_PMPCFG_W_Pos                       1U                                    /*!< PMP PMPCFG: W Position */
-#define PMP_PMPCFG_W_Msk                       (0x1UL << PMP_PMPCFG_W_Pos)           /*!< PMP PMPCFG: W Mask */
-
-#define PMP_PMPCFG_X_Pos                       2U                                    /*!< PMP PMPCFG: X Position */
-#define PMP_PMPCFG_X_Msk                       (0x1UL << PMP_PMPCFG_X_Pos)           /*!< PMP PMPCFG: X Mask */
-
-#define PMP_PMPCFG_A_Pos                       3U                                    /*!< PMP PMPCFG: A Position */
-#define PMP_PMPCFG_A_Msk                       (0x3UL << PMP_PMPCFG_A_Pos)           /*!< PMP PMPCFG: A Mask */
-
-#define PMP_PMPCFG_L_Pos                       7U                                    /*!< PMP PMPCFG: L Position */
-#define PMP_PMPCFG_L_Msk                       (0x1UL << PMP_PMPCFG_L_Pos)           /*!< PMP PMPCFG: L Mask */
-
-typedef enum {
-    REGION_SIZE_4B       = -1,
-    REGION_SIZE_8B       = 0,
-    REGION_SIZE_16B      = 1,
-    REGION_SIZE_32B      = 2,
-    REGION_SIZE_64B      = 3,
-    REGION_SIZE_128B     = 4,
-    REGION_SIZE_256B     = 5,
-    REGION_SIZE_512B     = 6,
-    REGION_SIZE_1KB      = 7,
-    REGION_SIZE_2KB      = 8,
-    REGION_SIZE_4KB      = 9,
-    REGION_SIZE_8KB      = 10,
-    REGION_SIZE_16KB     = 11,
-    REGION_SIZE_32KB     = 12,
-    REGION_SIZE_64KB     = 13,
-    REGION_SIZE_128KB    = 14,
-    REGION_SIZE_256KB    = 15,
-    REGION_SIZE_512KB    = 16,
-    REGION_SIZE_1MB      = 17,
-    REGION_SIZE_2MB      = 18,
-    REGION_SIZE_4MB      = 19,
-    REGION_SIZE_8MB      = 20,
-    REGION_SIZE_16MB     = 21,
-    REGION_SIZE_32MB     = 22,
-    REGION_SIZE_64MB     = 23,
-    REGION_SIZE_128MB    = 24,
-    REGION_SIZE_256MB    = 25,
-    REGION_SIZE_512MB    = 26,
-    REGION_SIZE_1GB      = 27,
-    REGION_SIZE_2GB      = 28,
-    REGION_SIZE_4GB      = 29,
-    REGION_SIZE_8GB      = 30,
-    REGION_SIZE_16GB     = 31
-} region_size_e;
-
-typedef enum {
-    ADDRESS_MATCHING_TOR   = 1,
-    ADDRESS_MATCHING_NAPOT = 3
-} address_matching_e;
-
-typedef struct {
-    uint32_t r: 1;           /* readable enable */
-    uint32_t w: 1;           /* writeable enable */
-    uint32_t x: 1;           /* execable enable */
-    address_matching_e a: 2; /* address matching mode */
-    uint32_t reserved: 2;    /* reserved */
-    uint32_t l: 1;           /* lock enable */
-} mpu_region_attr_t;
-
-/*@} end of group CSI_PMP */
-
-/* CACHE Register Definitions */
-#define CACHE_MHCR_WBR_Pos                     8U                                            /*!< CACHE MHCR: WBR Position */
-#define CACHE_MHCR_WBR_Msk                     (0x1UL << CACHE_MHCR_WBR_Pos)                 /*!< CACHE MHCR: WBR Mask */
-
-#define CACHE_MHCR_IBPE_Pos                    7U                                            /*!< CACHE MHCR: IBPE Position */
-#define CACHE_MHCR_IBPE_Msk                    (0x1UL << CACHE_MHCR_IBPE_Pos)                /*!< CACHE MHCR: IBPE Mask */
-
-#define CACHE_MHCR_L0BTB_Pos                   6U                                            /*!< CACHE MHCR: L0BTB Position */
-#define CACHE_MHCR_L0BTB_Msk                   (0x1UL << CACHE_MHCR_L0BTB_Pos)               /*!< CACHE MHCR: BTB Mask */
-
-#define CACHE_MHCR_BPE_Pos                     5U                                            /*!< CACHE MHCR: BPE Position */
-#define CACHE_MHCR_BPE_Msk                     (0x1UL << CACHE_MHCR_BPE_Pos)                 /*!< CACHE MHCR: BPE Mask */
-
-#define CACHE_MHCR_RS_Pos                      4U                                            /*!< CACHE MHCR: RS Position */
-#define CACHE_MHCR_RS_Msk                      (0x1UL << CACHE_MHCR_RS_Pos)                  /*!< CACHE MHCR: RS Mask */
-
-#define CACHE_MHCR_WB_Pos                      3U                                            /*!< CACHE MHCR: WB Position */
-#define CACHE_MHCR_WB_Msk                      (0x1UL << CACHE_MHCR_WB_Pos)                  /*!< CACHE MHCR: WB Mask */
-
-#define CACHE_MHCR_WA_Pos                      2U                                            /*!< CACHE MHCR: WA Position */
-#define CACHE_MHCR_WA_Msk                      (0x1UL << CACHE_MHCR_WA_Pos)                  /*!< CACHE MHCR: WA Mask */
-
-#define CACHE_MHCR_DE_Pos                      1U                                            /*!< CACHE MHCR: DE Position */
-#define CACHE_MHCR_DE_Msk                      (0x1UL << CACHE_MHCR_DE_Pos)                  /*!< CACHE MHCR: DE Mask */
-
-#define CACHE_MHCR_IE_Pos                      0U                                            /*!< CACHE MHCR: IE Position */
-#define CACHE_MHCR_IE_Msk                      (0x1UL << CACHE_MHCR_IE_Pos)                  /*!< CACHE MHCR: IE Mask */
-
-#define CACHE_INV_ADDR_Pos                     6U
-#define CACHE_INV_ADDR_Msk                     (0xFFFFFFFFUL << CACHE_INV_ADDR_Pos)
-
-/*@} end of group CSI_CACHE */
-
-// MSTATUS Register
-#define MSTATUS_TVM_MASK (1L << 20)     // mstatus.TVM                      [20]
-#define MSTATUS_MPP_MASK (3L << 11)     // mstatus.SPP                      [11:12]
-#define MSTATUS_MPP_M    (3L << 11)     // Machine mode                     11
-#define MSTATUS_MPP_S    (1L << 11)     // Supervisor mode                  01
-#define MSTATUS_MPP_U    (0L << 11)     // User mode                        00
-
-// SSTATUS Register
-#define SSTATUS_SPP_MASK (3L << 8)      // sstatus.SPP                      [8:9]
-#define SSTATUS_SPP_S    (1L << 8)      // Supervisor mode                  01
-#define SSTATUS_SPP_U    (0L << 8)      // User mode                        00
-
-typedef enum {
-    USER_MODE        = 0,
-    SUPERVISOR_MODE  = 1,
-    MACHINE_MODE     = 3,
-} cpu_work_mode_t;
-/**
-  \ingroup  CSI_core_register
-  \defgroup CSI_CINT     Core Local Interrupt (CLINT)
-  \brief    Type definitions for the Core Local Interrupt Registers.
-  @{
- */
-
-/**
-  \brief  The data structure of the access Clint.
- */
-typedef struct {
-    __IOM uint32_t MSIP0;
-    __IOM uint32_t MSIP1;
-    __IOM uint32_t MSIP2;
-    __IOM uint32_t MSIP3;
-    uint32_t RESERVED0[(0x4004000 - 0x400000C) / 4 - 1];
-    __IOM uint32_t MTIMECMPL0;
-    __IOM uint32_t MTIMECMPH0;
-    __IOM uint32_t MTIMECMPL1;
-    __IOM uint32_t MTIMECMPH1;
-    __IOM uint32_t MTIMECMPL2;
-    __IOM uint32_t MTIMECMPH2;
-    __IOM uint32_t MTIMECMPL3;
-    __IOM uint32_t MTIMECMPH3;
-    uint32_t RESERVED1[(0x400C000 - 0x400401C) / 4 - 1];
-    __IOM uint32_t SSIP0;
-    __IOM uint32_t SSIP1;
-    __IOM uint32_t SSIP2;
-    __IOM uint32_t SSIP3;
-    uint32_t RESERVED2[(0x400D000 - 0x400C00C) / 4 - 1];
-    __IOM uint32_t STIMECMPL0;
-    __IOM uint32_t STIMECMPH0;
-    __IOM uint32_t STIMECMPL1;
-    __IOM uint32_t STIMECMPH1;
-    __IOM uint32_t STIMECMPL2;
-    __IOM uint32_t STIMECMPH2;
-    __IOM uint32_t STIMECMPL3;
-    __IOM uint32_t STIMECMPH3;
-} CLINT_Type;
-/*@} end of group CSI_SysTick */
-
-
-/**
-  \ingroup    CSI_core_register
-  \defgroup   CSI_core_bitfield     Core register bit field macros
-  \brief      Macros for use with bit field definitions (xxx_Pos, xxx_Msk).
-  @{
- */
-
-/**
-  \brief   Mask and shift a bit field value for use in a register bit range.
-  \param[in] field  Name of the register bit field.
-  \param[in] value  Value of the bit field.
-  \return           Masked and shifted value.
-*/
-#define _VAL2FLD(field, value)    ((value << field ## _Pos) & field ## _Msk)
-
-/**
-  \brief     Mask and shift a register value to extract a bit filed value.
-  \param[in] field  Name of the register bit field.
-  \param[in] value  Value of register.
-  \return           Masked and shifted bit field value.
-*/
-#define _FLD2VAL(field, value)    ((value & field ## _Msk) >> field ## _Pos)
-
-/*@} end of group CSI_core_bitfield */
-
-/**
-  \ingroup    CSI_core_register
-  \defgroup   CSI_core_base     Core Definitions
-  \brief      Definitions for base addresses, unions, and structures.
-  @{
- */
-
-/*@} */
-
-/*******************************************************************************
- *                Hardware Abstraction Layer
-  Core Function Interface contains:
-  - Core VIC Functions
-  - Core CORET Functions
-  - Core Register Access Functions
- ******************************************************************************/
-/**
-  \defgroup CSI_Core_FunctionInterface Functions and Instructions Reference
-*/
-
-/* ##########################   VIC functions  #################################### */
-/**
-  \ingroup  CSI_Core_FunctionInterface
-  \defgroup CSI_Core_VICFunctions VIC Functions
-  \brief    Functions that manage interrupts and exceptions via the VIC.
-  @{
- */
-
-/* The following MACROS handle generation of the register offset and byte masks */
-#define _BIT_SHIFT(IRQn)         (  ((((uint32_t)(int32_t)(IRQn))         )      &  0x03UL) * 8UL)
-#define _IP_IDX(IRQn)            (   (((uint32_t)(int32_t)(IRQn))                >>    5UL)      )
-#define _IP2_IDX(IRQn)            (   (((uint32_t)(int32_t)(IRQn))                >>    2UL)      )
-
-/**
-  \brief   Enable External Interrupt
-  \details Enable a device-specific interrupt in the VIC interrupt controller.
-  \param [in]      IRQn  External interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_enable_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    plic->PLIC_H0_SIE[IRQn/32] = plic->PLIC_H0_SIE[IRQn/32] | (0x1 << (IRQn%32));
-#else
-    plic->PLIC_H0_MIE[IRQn/32] = plic->PLIC_H0_MIE[IRQn/32] | (0x1 << (IRQn%32));
-#endif
-}
-
-/**
-  \brief   Disable External Interrupt
-  \details Disable a device-specific interrupt in the VIC interrupt controller.
-  \param [in]      IRQn  External interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_disable_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    plic->PLIC_H0_SIE[IRQn/32] = plic->PLIC_H0_SIE[IRQn/32] & (~(0x1 << (IRQn%32)));
-#else
-    plic->PLIC_H0_MIE[IRQn/32] = plic->PLIC_H0_MIE[IRQn/32] & (~(0x1 << (IRQn%32)));
-#endif
-}
-
-/**
-  \brief   Enable External Secure Interrupt
-  \details Enable a secure device-specific interrupt in the VIC interrupt controller.
-  \param [in]      IRQn  External interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_enable_sirq(uint64_t plic_base, int32_t IRQn)
-{
-    csi_plic_enable_irq(plic_base, IRQn);
-}
-
-/**
-  \brief   Disable External Secure Interrupt
-  \details Disable a secure device-specific interrupt in the VIC interrupt controller.
-  \param [in]      IRQn  External interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_disable_sirq(uint64_t plic_base, int32_t IRQn)
-{
-    csi_plic_disable_irq(plic_base, IRQn);
-}
-
-/**
-  \brief   Check Interrupt is Enabled or not
-  \details Read the enabled register in the VIC and returns the pending bit for the specified interrupt.
-  \param [in]      IRQn  Interrupt number.
-  \return             0  Interrupt status is not enabled.
-  \return             1  Interrupt status is enabled.
- */
-__STATIC_INLINE uint32_t csi_plic_get_enabled_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    return (uint32_t)((plic->PLIC_H0_SIE[IRQn/32] >> IRQn%32) & 0x1);
-#else
-    return (uint32_t)((plic->PLIC_H0_MIE[IRQn/32] >> IRQn%32) & 0x1);
-#endif
-}
-
-/**
-  \brief   Check Interrupt is Pending or not
-  \details Read the pending register in the VIC and returns the pending bit for the specified interrupt.
-  \param [in]      IRQn  Interrupt number.
-  \return             0  Interrupt status is not pending.
-  \return             1  Interrupt status is pending.
- */
-__STATIC_INLINE uint32_t csi_plic_get_pending_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-    return (uint32_t)((plic->PLIC_IP[IRQn/32] >> IRQn%32) & 0x1);
-}
-
-/**
-  \brief   Set Pending Interrupt
-  \details Set the pending bit of an external interrupt.
-  \param [in]      IRQn  Interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_set_pending_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-    plic->PLIC_IP[IRQn/32] = plic->PLIC_IP[IRQn/32] | (0x1 << (IRQn%32));
-}
-
-/**
-  \brief   Clear Pending Interrupt
-  \details Clear the pending bit of an external interrupt.
-  \param [in]      IRQn  External interrupt number. Value cannot be negative.
- */
-__STATIC_INLINE void csi_plic_clear_pending_irq(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-    plic->PLIC_H0_SCLAIM = IRQn;
-}
-
-/**
-  \brief   Set Interrupt Priority
-  \details Set the priority of an interrupt.
-  \note    The priority cannot be set for every core interrupt.
-  \param [in]      IRQn  Interrupt number.
-  \param [in]  priority  Priority to set.
- */
-__STATIC_INLINE void csi_plic_set_prio(uint64_t plic_base, int32_t IRQn, uint32_t priority)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-    plic->PLIC_PRIO[IRQn] = priority;
-}
-
-/**
-  \brief   Get Interrupt Priority
-  \details Read the priority of an interrupt.
-           The interrupt number can be positive to specify an external (device specific) interrupt,
-           or negative to specify an internal (core) interrupt.
-  \param [in]   IRQn  Interrupt number.
-  \return             Interrupt Priority.
-                      Value is aligned automatically to the implemented priority bits of the microcontroller.
- */
-__STATIC_INLINE uint32_t csi_plic_get_prio(uint64_t plic_base, int32_t IRQn)
-{
-    PLIC_Type *plic = (PLIC_Type *)plic_base;
-    uint32_t prio = plic->PLIC_PRIO[IRQn];
-    return prio;
-}
-
-/**
-  \brief   Set interrupt handler
-  \details Set the interrupt handler according to the interrupt num, the handler will be filled in irq vectors.
-  \param [in]      IRQn  Interrupt number.
-  \param [in]   handler  Interrupt handler.
- */
-__STATIC_INLINE void csi_plic_set_vector(int32_t IRQn, uint64_t handler)
-{
-    if (IRQn >= 0 && IRQn < 1024) {
-        uint64_t *vectors = (uint64_t *)__get_MTVT();
-        vectors[IRQn] = handler;
-    }
-}
-
-/**
-  \brief   Get interrupt handler
-  \details Get the address of interrupt handler function.
-  \param [in]      IRQn  Interrupt number.
- */
-__STATIC_INLINE uint32_t csi_plic_get_vector(int32_t IRQn)
-{
-    if (IRQn >= 0 && IRQn < 1024) {
-        uint64_t *vectors = (uint64_t *)__get_MTVT();
-        return (uint32_t)vectors[IRQn];
-    }
-
-    return 0;
-}
-
-/*@} end of CSI_Core_VICFunctions */
-
-/* ##########################   PMP functions  #################################### */
-/**
-  \ingroup  CSI_Core_FunctionInterface
-  \defgroup CSI_Core_PMPFunctions PMP Functions
-  \brief    Functions that manage interrupts and exceptions via the VIC.
-  @{
- */
-
-/**
-  \brief  configure memory protected region.
-  \details
-  \param [in]  idx        memory protected region (0, 1, 2, ..., 15).
-  \param [in]  base_addr  base address must be aligned with page size.
-  \param [in]  size       \ref region_size_e. memory protected region size.
-  \param [in]  attr       \ref region_size_t. memory protected region attribute.
-  \param [in]  enable     enable or disable memory protected region.
-  */
-__STATIC_INLINE void csi_mpu_config_region(uint32_t idx, uint32_t base_addr, region_size_e size,
-        mpu_region_attr_t attr, uint32_t enable)
-{
-    uint8_t  pmpxcfg = 0;
-    uint32_t addr = 0;
-
-    if (idx > 15) {
-        return;
-    }
-
-    if (!enable) {
-        attr.a = (address_matching_e)0;
-    }
-
-    if (attr.a == ADDRESS_MATCHING_TOR) {
-        addr = base_addr >> 2;
-    } else {
-        if (size == REGION_SIZE_4B) {
-            addr = base_addr >> 2;
-            attr.a = (address_matching_e)2;
-        } else {
-            addr = ((base_addr >> 2) & (0xFFFFFFFFU - ((1 << (size + 1)) - 1))) | ((1 << size) - 1);
-        }
-    }
-
-    __set_PMPADDRx(idx, addr);
-
-    pmpxcfg |= (attr.r << PMP_PMPCFG_R_Pos) | (attr.w << PMP_PMPCFG_W_Pos) |
-               (attr.x << PMP_PMPCFG_X_Pos) | (attr.a << PMP_PMPCFG_A_Pos) |
-               (attr.l << PMP_PMPCFG_L_Pos);
-
-    __set_PMPxCFG(idx, pmpxcfg);
-}
-
-/**
-  \brief  disable mpu region by idx.
-  \details
-  \param [in]  idx        memory protected region (0, 1, 2, ..., 15).
-  */
-__STATIC_INLINE void csi_mpu_disable_region(uint32_t idx)
-{
-    __set_PMPxCFG(idx, __get_PMPxCFG(idx) & (~PMP_PMPCFG_A_Msk));
-}
-
-/*@} end of CSI_Core_PMPFunctions */
-
-/* ##################################    SysTick function  ############################################ */
-/**
-  \ingroup  CSI_Core_FunctionInterface
-  \defgroup CSI_Core_SysTickFunctions SysTick Functions
-  \brief    Functions that configure the System.
-  @{
- */
-
-
-/**
-  \brief   CORE timer Configuration
-  \details Initializes the System Timer and its interrupt, and starts the System Tick Timer.
-           Counter is in free running mode to generate periodic interrupts.
-  \param [in]  ticks  Number of ticks between two interrupts.
-  \param [in]  IRQn   core timer Interrupt number.
-  \return          0  Function succeeded.
-  \return          1  Function failed.
-  \note    When the variable <b>__Vendor_SysTickConfig</b> is set to 1, then the
-           function <b>SysTick_Config</b> is not included. In this case, the file <b><i>device</i>.h</b>
-           must contain a vendor-specific implementation of this function.
- */
-__STATIC_INLINE uint32_t csi_clint_config(uint64_t clint_base, uint32_t ticks, int32_t IRQn)
-{
-    CLINT_Type *clint = (CLINT_Type *)clint_base;
-#ifdef __QEMU_RUN
-    uint64_t value = (((uint64_t)clint->MTIMECMPH0) << 32) + (uint64_t)clint->MTIMECMPL0;
-
-    value = value + (uint64_t)ticks;
-    clint->MTIMECMPH0 = (uint32_t)(value >> 32);
-    clint->MTIMECMPL0 = (uint32_t)value;
-#else
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    uint64_t value = (((uint64_t)clint->STIMECMPH0) << 32) + (uint64_t)clint->STIMECMPL0;
-
-    if ((value != 0) && (value != 0xffffffffffffffff)) {
-        value = value + (uint64_t)ticks;
-    } else {
-        value = __get_MTIME() + ticks;
-    }
-    clint->STIMECMPH0 = (uint32_t)(value >> 32);
-    clint->STIMECMPL0 = (uint32_t)value;
-#else
-    uint64_t value = (((uint64_t)clint->MTIMECMPH0) << 32) + (uint64_t)clint->MTIMECMPL0;
-
-    if ((value != 0) && (value != 0xffffffffffffffff)) {
-        value = value + (uint64_t)ticks;
-    } else {
-        value = __get_MTIME() + ticks;
-    }
-    clint->MTIMECMPH0 = (uint32_t)(value >> 32);
-    clint->MTIMECMPL0 = (uint32_t)value;
-#endif
-#endif /*__QEMU_RUN*/
-
-    return (0UL);
-}
-
-__STATIC_INLINE void csi_coret_reset_value(uint64_t clint_base)
-{
-    uint32_t value = 0x0;
-    CLINT_Type *clint = (CLINT_Type *)clint_base;
-
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    clint->STIMECMPH0 = (uint32_t)value;
-    clint->STIMECMPL0 = (uint32_t)value;
-#else
-    clint->MTIMECMPH0 = (uint32_t)value;
-    clint->MTIMECMPL0 = (uint32_t)value;
-#endif
-}
-
-/**
-  \brief   get CORE timer reload value
-  \return          CORE timer counter value.
- */
-__STATIC_INLINE uint64_t csi_clint_get_load(uint64_t clint_base)
-{
-    CLINT_Type *clint = (CLINT_Type *)clint_base;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    uint64_t value = (((uint64_t)clint->STIMECMPH0) << 32) + (uint64_t)clint->STIMECMPL0;
-#else
-    uint64_t value = (((uint64_t)clint->MTIMECMPH0) << 32) + (uint64_t)clint->MTIMECMPL0;
-#endif
-
-    return value;
-}
-
-/**
-  \brief   get CORE timer reload high value
-  \return          CORE timer counter value.
- */
-__STATIC_INLINE uint32_t csi_clint_get_loadh(uint64_t clint_base)
-{
-    CLINT_Type *clint = (CLINT_Type *)clint_base;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    uint64_t value = (((uint64_t)clint->STIMECMPH0) << 32) + (uint64_t)clint->STIMECMPL0;
-#else
-    uint64_t value = (((uint64_t)clint->MTIMECMPH0) << 32) + (uint64_t)clint->MTIMECMPL0;
-#endif
-
-    return (value >> 32) & 0xFFFFFFFF;
-}
-
-/**
-  \brief   get CORE timer counter value
-  \return          CORE timer counter value.
- */
-__STATIC_INLINE uint64_t csi_clint_get_value(void)
-{
-    uint64_t result;
-    __ASM volatile("csrr %0, 0xc01" : "=r"(result));
-    return result;
-}
-
-/**
-  \brief   get CORE timer counter high value
-  \return          CORE timer counter value.
- */
-__STATIC_INLINE uint32_t csi_clint_get_valueh(void)
-{
-    uint64_t result;
-    __ASM volatile("csrr %0, time" : "=r"(result));
-    return (result >> 32) & 0xFFFFFFFF;
-}
-
-/*@} end of CSI_core_DebugFunctions */
-
-/* ##########################  Cache functions  #################################### */
-/**
-  \ingroup  CSI_Core_FunctionInterface
-  \defgroup CSI_Core_CacheFunctions Cache Functions
-  \brief    Functions that configure Instruction and Data cache.
-  @{
- */
-
-/**
-  \brief   whether I-Cache enable
-  */
-__STATIC_INLINE int csi_icache_is_enable()
-{
-    uint32_t cache = __get_MHCR();
-    return (cache & CACHE_MHCR_IE_Msk) >> CACHE_MHCR_IE_Pos;
-}
-
-/**
-  \brief   Enable I-Cache
-  \details Turns on I-Cache
-  */
-__STATIC_INLINE void csi_icache_enable(void)
-{
-#if (__ICACHE_PRESENT == 1U)
-    if (!csi_icache_is_enable()) {
-        uint32_t cache;
-        __DSB();
-        __ISB();
-        __ICACHE_IALL();
-        cache = __get_MHCR();
-        cache |= CACHE_MHCR_IE_Msk;
-        __set_MHCR(cache);
-        __DSB();
-        __ISB();
-    }
-#endif
-}
-
-
-/**
-  \brief   Disable I-Cache
-  \details Turns off I-Cache
-  */
-__STATIC_INLINE void csi_icache_disable(void)
-{
-#if (__ICACHE_PRESENT == 1U)
-    if (csi_icache_is_enable()) {
-        uint32_t cache;
-        __DSB();
-        __ISB();
-        cache = __get_MHCR();
-        cache &= ~CACHE_MHCR_IE_Msk;            /* disable icache */
-        __set_MHCR(cache);
-        __ICACHE_IALL();                        /* invalidate all icache */
-        __DSB();
-        __ISB();
-    }
-#endif
-}
-
-
-/**
-  \brief   Invalidate I-Cache
-  \details Invalidates I-Cache
-  */
-__STATIC_INLINE void csi_icache_invalid(void)
-{
-#if (__ICACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __ICACHE_IALL();                        /* invalidate all icache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-/**
-  \brief   whether D-Cache enable
-  */
-__STATIC_INLINE int csi_dcache_is_enable()
-{
-    uint32_t cache = __get_MHCR();
-    return (cache & CACHE_MHCR_DE_Msk) >> CACHE_MHCR_DE_Pos;
-}
-
-/**
-  \brief   Enable D-Cache
-  \details Turns on D-Cache
-  \note    I-Cache also turns on.
-  */
-__STATIC_INLINE void csi_dcache_enable(void)
-{
-#if (__DCACHE_PRESENT == 1U)
-    if (!csi_dcache_is_enable()) {
-        uint32_t cache;
-        __DSB();
-        __ISB();
-        __DCACHE_IALL();                        /* invalidate all dcache */
-        cache = __get_MHCR();
-        cache |= (CACHE_MHCR_DE_Msk | CACHE_MHCR_WB_Msk | CACHE_MHCR_WA_Msk | CACHE_MHCR_RS_Msk | CACHE_MHCR_BPE_Msk | CACHE_MHCR_L0BTB_Msk | CACHE_MHCR_IBPE_Msk | CACHE_MHCR_WBR_Msk);      /* enable all Cache */
-        __set_MHCR(cache);
-
-        __DSB();
-        __ISB();
-    }
-#endif
-}
-
-
-/**
-  \brief   Disable D-Cache
-  \details Turns off D-Cache
-  \note    I-Cache also turns off.
-  */
-__STATIC_INLINE void csi_dcache_disable(void)
-{
-#if (__DCACHE_PRESENT == 1U)
-    if (csi_dcache_is_enable()) {
-        uint32_t cache;
-        __DSB();
-        __ISB();
-        cache = __get_MHCR();
-        cache &= ~(uint32_t)CACHE_MHCR_DE_Msk; /* disable all Cache */
-        __set_MHCR(cache);
-        __DCACHE_IALL();                             /* invalidate all Cache */
-        __DSB();
-        __ISB();
-    }
-#endif
-}
-
-/**
-  \brief   Invalidate D-Cache
-  \details Invalidates D-Cache
-  \note    I-Cache also invalid
-  */
-__STATIC_INLINE void csi_dcache_invalid(void)
-{
-#if (__DCACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __DCACHE_IALL();                            /* invalidate all Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-
-/**
-  \brief   Clean D-Cache
-  \details Cleans D-Cache
-  \note    I-Cache also cleans
-  */
-__STATIC_INLINE void csi_dcache_clean(void)
-{
-#if (__DCACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __DCACHE_CALL();                                     /* clean all Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-
-/**
-  \brief   Clean & Invalidate D-Cache
-  \details Cleans and Invalidates D-Cache
-  \note    I-Cache also flush.
-  */
-__STATIC_INLINE void csi_dcache_clean_invalid(void)
-{
-#if (__DCACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __DCACHE_CIALL();                                   /* clean and inv all Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-
-/**
-  \brief   Invalidate L2-Cache
-  \details Invalidates L2-Cache
-  \note
-  */
-__STATIC_INLINE void csi_l2cache_invalid(void)
-{
-#if (__L2CACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __L2CACHE_IALL();                            /* invalidate l2 Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-
-/**
-  \brief   Clean L2-Cache
-  \details Cleans L2-Cache
-  \note
-  */
-__STATIC_INLINE void csi_l2cache_clean(void)
-{
-#if (__L2CACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __L2CACHE_CALL();                                     /* clean l2 Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-
-/**
-  \brief   Clean & Invalidate L2-Cache
-  \details Cleans and Invalidates L2-Cache
-  \note
-  */
-__STATIC_INLINE void csi_l2cache_clean_invalid(void)
-{
-#if (__L2CACHE_PRESENT == 1U)
-    __DSB();
-    __ISB();
-    __L2CACHE_CIALL();                                   /* clean and inv l2 Cache */
-    __DSB();
-    __ISB();
-#endif
-}
-
-/**
-  \brief   D-Cache Invalidate by address
-  \details Invalidates D-Cache for the given address
-  \param[in]   addr    address (aligned to 64-byte boundary)
-  \param[in]   dsize   size of memory block (in number of bytes)
-*/
-__STATIC_INLINE void csi_dcache_invalid_range(uint64_t *addr, int64_t dsize)
-{
-#if (__DCACHE_PRESENT == 1U)
-    int64_t op_size = dsize + (uint64_t)addr % 64;
-    uint64_t op_addr = (uint64_t)addr;
-    int64_t linesize = 64;
-    cpu_work_mode_t cpu_work_mode;
-    cpu_work_mode = (cpu_work_mode_t)__get_CPU_WORK_MODE();
-
-    __DSB();
-
-    if (cpu_work_mode == MACHINE_MODE) {
-        while (op_size > 0) {
-            __DCACHE_IPA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    } else if (cpu_work_mode == SUPERVISOR_MODE) {
-        while (op_size > 0) {
-            __DCACHE_IVA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    }
-
-    __SYNC_IS();
-    __DSB();
-#endif
-}
-
-
-/**
-  \brief   D-Cache Clean by address
-  \details Cleans D-Cache for the given address
-  \param[in]   addr    address (aligned to 64-byte boundary)
-  \param[in]   dsize   size of memory block (in number of bytes)
-*/
-__STATIC_INLINE void csi_dcache_clean_range(uint64_t *addr, int64_t dsize)
-{
-
-#if (__DCACHE_PRESENT == 1)
-    int64_t op_size = dsize + (uint64_t)addr % 64;
-    uint64_t op_addr = (uint64_t) addr & CACHE_INV_ADDR_Msk;
-    int64_t linesize = 64;
-    cpu_work_mode_t cpu_work_mode;
-    cpu_work_mode = (cpu_work_mode_t)__get_CPU_WORK_MODE();
-
-    __DSB();
-
-    if (cpu_work_mode == MACHINE_MODE) {
-        while (op_size > 0) {
-            __DCACHE_CPA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    } else if (cpu_work_mode == SUPERVISOR_MODE) {
-        while (op_size > 0) {
-            __DCACHE_CVA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    }
-
-    __SYNC_IS();
-    __DSB();
-#endif
-
-}
-
-
-/**
-  \brief   D-Cache Clean and Invalidate by address
-  \details Cleans and invalidates D_Cache for the given address
-  \param[in]   addr    address (aligned to 64-byte boundary)
-  \param[in]   dsize   size of memory block (aligned to 64-byte boundary)
-*/
-__STATIC_INLINE void csi_dcache_clean_invalid_range(uint64_t *addr, int64_t dsize)
-{
-#if (__DCACHE_PRESENT == 1U)
-    int64_t op_size = dsize + (uint64_t)addr % 64;
-    uint64_t op_addr = (uint64_t) addr;
-    int64_t linesize = 64;
-    cpu_work_mode_t cpu_work_mode;
-    cpu_work_mode = (cpu_work_mode_t)__get_CPU_WORK_MODE();
-
-    __DSB();
-
-    if (cpu_work_mode == MACHINE_MODE) {
-        while (op_size > 0) {
-            __DCACHE_CIPA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    } else if (cpu_work_mode == SUPERVISOR_MODE) {
-        while (op_size > 0) {
-            __DCACHE_CIVA(op_addr);
-            op_addr += linesize;
-            op_size -= linesize;
-        }
-    }
-
-    __SYNC_IS();
-    __DSB();
-#endif
-}
-
-/**
-  \brief   setup cacheable range Cache
-  \details setup Cache range
-  */
-__STATIC_INLINE void csi_cache_set_range (uint64_t index, uint64_t baseAddr, uint64_t size, uint64_t enable)
-{
-    ;
-}
-
-/**
-  \brief   Enable cache profile
-  \details Turns on Cache profile
-  */
-__STATIC_INLINE void csi_cache_enable_profile(void)
-{
-    ;
-}
-
-/**
-  \brief   Disable cache profile
-  \details Turns off Cache profile
-  */
-__STATIC_INLINE void csi_cache_disable_profile(void)
-{
-    ;
-}
-
-/**
-  \brief   Reset cache profile
-  \details Reset Cache profile
-  */
-__STATIC_INLINE void csi_cache_reset_profile(void)
-{
-    ;
-}
-
-/**
-  \brief   cache access times
-  \details Cache access times
-  \note    every 256 access add 1.
-  \return          cache access times, actual times should be multiplied by 256
-  */
-__STATIC_INLINE uint64_t csi_cache_get_access_time(void)
-{
-    return 0;
-}
-
-/**
-  \brief   cache miss times
-  \details Cache miss times
-  \note    every 256 miss add 1.
-  \return          cache miss times, actual times should be multiplied by 256
-  */
-__STATIC_INLINE uint64_t csi_cache_get_miss_time(void)
-{
-    return 0;
-}
-
-/*@} end of CSI_Core_CacheFunctions */
-
-
-/* ##########################  MMU functions  #################################### */
-/**
-  \ingroup  CSI_Core_FunctionInterface
-  \defgroup CSI_Core_MMUFunctions MMU Functions
-  \brief    Functions that configure MMU.
-  @{
-  */
-
-typedef enum {
-    PAGE_SIZE_4KB   = 0x1000,
-    PAGE_SIZE_2MB   = 0x200000,
-    PAGE_SIZE_1GB   = 0x40000000,
-} page_size_e;
-
-
-typedef enum {
-    MMU_MODE_39   = 0x8,
-    MMU_MODE_48   = 0x9,
-    MMU_MODE_57   = 0xa,
-    MMU_MODE_64   = 0xb,
-} mmu_mode_e;
-
-/**
-  \brief  enable mmu
-  \details
-  */
-__STATIC_INLINE void csi_mmu_enable(mmu_mode_e mode)
-{
-    __set_SATP(__get_SATP() | ((uint64_t)mode << 60));
-}
-
-/**
-  \brief  disable mmu
-  \details
-  */
-__STATIC_INLINE void csi_mmu_disable(void)
-{
-    __set_SATP(__get_SATP() & (~((uint64_t)0xf << 60)));
-}
-
-/**
-  \brief  flush all mmu tlb.
-  \details
-  */
-__STATIC_INLINE void csi_mmu_invalid_tlb_all(void)
-{
-    __ASM volatile("sfence.vma" : : : "memory");
-}
-
-/**
-  \brief  flush mmu tlb by asid.
-  \details
-  */
-__STATIC_INLINE void csi_mmu_invalid_tlb_by_asid(unsigned long asid)
-{
-    __ASM volatile("sfence.vma zero, %0"
-                   :
-                   : "r"(asid)
-                   : "memory");
-}
-
-/**
-  \brief  flush mmu tlb by page.
-  \details
-  */
-__STATIC_INLINE void csi_mmu_invalid_tlb_by_page(unsigned long asid, unsigned long addr)
-{
-    __ASM volatile("sfence.vma %0, %1"
-                   :
-                   : "r"(addr), "r"(asid)
-                   : "memory");
-}
-
-/**
-  \brief  flush mmu tlb by range.
-  \details
-  */
-__STATIC_INLINE void csi_mmu_invalid_tlb_by_range(unsigned long asid, page_size_e page_size, unsigned long start_addr, unsigned long end_addr)
-{
-    start_addr &= ~(page_size - 1);
-    end_addr += page_size - 1;
-    end_addr &= ~(page_size - 1);
-
-    while(start_addr < end_addr) {
-        __ASM volatile("sfence.vma %0, %1"
-                       :
-                       : "r"(start_addr), "r"(asid)
-                       : "memory");
-    }
-}
-
-/*@} end of CSI_Core_MMUFunctions */
-
-/* ##################################    IRQ Functions  ############################################ */
-
-/**
-  \brief   Save the Irq context
-  \details save the psr result before disable irq.
- */
-__STATIC_INLINE uint64_t csi_irq_save(void)
-{
-    uint64_t result;
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    result = __get_SSTATUS();
-#else
-    result = __get_MSTATUS();
-#endif
-    __disable_irq();
-    return(result);
-}
-
-/**
-  \brief   Restore the Irq context
-  \details restore saved primask state.
-  \param [in]      irq_state  psr irq state.
- */
-__STATIC_INLINE void csi_irq_restore(uint64_t irq_state)
-{
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    __set_SSTATUS(irq_state);
-#else
-    __set_MSTATUS(irq_state);
-#endif
-}
-
-/*@} end of IRQ Functions */
-
-/**
-  \brief   Get the byte-width of vector register
-  \return  the byte-width of vector register
- */
-__STATIC_INLINE int csi_vlenb_get_value(void)
-{
-    int result;
-    __ASM volatile("csrr %0, vlenb" : "=r"(result) : : "memory");
-    return result;
-}
-
-#ifdef __cplusplus
-}
-#endif
-
-#endif /* __CORE_RV32_H_DEPENDANT */
-
-#endif /* __CSI_GENERIC */

+ 0 - 3340
bsp/cvitek/drivers/libraries/csi_rv64_gcc.h

@@ -1,3340 +0,0 @@
-/*
- * Copyright (C) 2017-2019 Alibaba Group Holding Limited
- */
-
-
-/******************************************************************************
- * @file     csi_rv64_gcc.h
- * @brief    CSI Header File for GCC.
- * @version  V1.0
- * @date     01. Sep 2018
- ******************************************************************************/
-
-#ifndef _CSI_RV64_GCC_H_
-#define _CSI_RV64_GCC_H_
-
-#include <stdlib.h>
-
-#ifndef __ASM
-#define __ASM                   __asm     /*!< asm keyword for GNU Compiler */
-#endif
-
-#ifndef __INLINE
-#define __INLINE                inline    /*!< inline keyword for GNU Compiler */
-#endif
-
-#ifndef __ALWAYS_STATIC_INLINE
-#define __ALWAYS_STATIC_INLINE  __attribute__((always_inline)) static inline
-#endif
-
-#ifndef __STATIC_INLINE
-#define __STATIC_INLINE         static inline
-#endif
-
-#ifndef __NO_RETURN
-#define __NO_RETURN             __attribute__((__noreturn__))
-#endif
-
-#ifndef __USED
-#define __USED                  __attribute__((used))
-#endif
-
-#ifndef __WEAK
-#define __WEAK                  __attribute__((weak))
-#endif
-
-#ifndef __PACKED
-#define __PACKED                __attribute__((packed, aligned(1)))
-#endif
-
-#ifndef __PACKED_STRUCT
-#define __PACKED_STRUCT         struct __attribute__((packed, aligned(1)))
-#endif
-
-#ifndef __PACKED_UNION
-#define __PACKED_UNION          union __attribute__((packed, aligned(1)))
-#endif
-
-
-/* ###########################  Core Function Access  ########################### */
-/** \ingroup  CSI_Core_FunctionInterface
-    \defgroup CSI_Core_RegAccFunctions CSI Core Register Access Functions
-  @{
- */
-/**
-  \brief   Enable IRQ Interrupts
-  \details Enables IRQ interrupts by setting the IE-bit in the PSR.
-           Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __enable_irq(void)
-{
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    __ASM volatile("csrs sstatus, 2");
-    __ASM volatile("li a0, 0x222");
-    __ASM volatile("csrs sie, a0");
-#else
-    __ASM volatile("csrs mstatus, 8");
-    __ASM volatile("li a0, 0x888");
-    __ASM volatile("csrs mie, a0");
-#endif
-}
-
-/**
-  \brief   Enable supervisor IRQ Interrupts
-  \details Enables IRQ interrupts by setting the IE-bit in the PSR.
-           Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __enable_supervisor_irq(void)
-{
-    __ASM volatile("csrs sstatus, 2");
-    __ASM volatile("li a0, 0x222");
-    __ASM volatile("csrs sie, a0");
-}
-
-/**
-  \brief   Disable IRQ Interrupts
-  \details Disables IRQ interrupts by clearing the IE-bit in the PSR.
-  Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __disable_irq(void)
-{
-#if defined(CONFIG_RISCV_SMODE) && CONFIG_RISCV_SMODE
-    __ASM volatile("csrc sstatus, 2");
-#else
-    __ASM volatile("csrc mstatus, 8");
-#endif
-}
-
-/**
-  \brief   Disable supervisor IRQ Interrupts
-  \details Disables supervisor IRQ interrupts by clearing the IE-bit in the PSR.
-  Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __disable_supervisor_irq(void)
-{
-    __ASM volatile("csrc sstatus, 2");
-}
-
-/**
-  \brief   Get MXSTATUS
-  \details Returns the content of the MXSTATUS Register.
-  \return               MXSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MXSTATUS(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mxstatus" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get SXSTATUS
-  \details Returns the content of the SXSTATUS Register.
-  \return               SXSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SXSTATUS(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, sxstatus" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get CPU WORK MODE
-  \details Returns CPU WORK MODE.
-  \return  CPU WORK MODE
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_CPU_WORK_MODE(void)
-{
-    uint64_t result;
-    __ASM volatile("csrr %0, sxstatus" : "=r"(result));
-    return ((result >> 30U) & 0x3U);
-}
-
-/**
-  \brief   Get SATP
-  \details Returns the content of the SATP Register.
-  \return               SATP Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SATP(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, satp" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set SATP
-  \details Writes the given value to the SATP Register.
-  \param [in]    satp  SATP Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_SATP(uint64_t satp)
-{
-    __ASM volatile("csrw satp, %0" : : "r"(satp));
-}
-
-/**
-  \brief   Set MEPC
-  \details Writes the given value to the MEPC Register.
-  \param [in]    mstatus  MEPC Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MEPC(uint64_t mepc)
-{
-    __ASM volatile("csrw mepc, %0" : : "r"(mepc));
-}
-
-
-/**
-  \brief   Set MXSTATUS
-  \details Writes the given value to the MXSTATUS Register.
-  \param [in]    mxstatus  MXSTATUS Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MXSTATUS(uint64_t mxstatus)
-{
-    __ASM volatile("csrw mxstatus, %0" : : "r"(mxstatus));
-}
-
-/**
-  \brief   Get MSTATUS
-  \details Returns the content of the MSTATUS Register.
-  \return               MSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MSTATUS(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mstatus" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MSTATUS
-  \details Writes the given value to the MSTATUS Register.
-  \param [in]    mstatus  MSTATUS Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MSTATUS(uint64_t mstatus)
-{
-    __ASM volatile("csrw mstatus, %0" : : "r"(mstatus));
-}
-
-/**
-  \brief   Get MCOR
-  \details Returns the content of the MCOR Register.
-  \return               MCOR Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCOR(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mcor" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MCOR
-  \details Writes the given value to the MCOR Register.
-  \param [in]    mstatus  MCOR Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MCOR(uint64_t mcor)
-{
-    __ASM volatile("csrw mcor, %0" : : "r"(mcor));
-}
-
-/**
-  \brief   Get MHCR
-  \details Returns the content of the MHCR Register.
-  \return               MHCR Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MHCR(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mhcr" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MHCR
-  \details Writes the given value to the MHCR Register.
-  \param [in]    mstatus  MHCR Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MHCR(uint64_t mhcr)
-{
-    __ASM volatile("csrw mhcr, %0" : : "r"(mhcr));
-}
-
-/**
-  \brief   Get MHINT
-  \details Returns the content of the MHINT Register.
-  \return               MHINT Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MHINT(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mhint" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MHINT
-  \details Writes the given value to the MHINT Register.
-  \param [in]    mstatus  MHINT Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MHINT(uint64_t mhint)
-{
-    __ASM volatile("csrw mhint, %0" : : "r"(mhint));
-}
-
-/**
-  \brief   Get MCCR2
-  \details Returns the content of the MCCR2 Register.
-  \return               MCCR2 Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCCR2(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mccr2" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MCCR2
-  \details Writes the given value to the MCCR2 Register.
-  \param [in]    mstatus  MCCR2 Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MCCR2(uint64_t mccr2)
-{
-    __ASM volatile("csrw mccr2, %0" : : "r"(mccr2));
-}
-
-/**
-  \brief   Get MISA Register
-  \details Returns the content of the MISA Register.
-  \return               MISA Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MISA(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, misa" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MISA
-  \details Writes the given value to the MISA Register.
-  \param [in]    misa  MISA Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MISA(uint64_t misa)
-{
-    __ASM volatile("csrw misa, %0" : : "r"(misa));
-}
-
-/**
-  \brief   Get MIE Register
-  \details Returns the content of the MIE Register.
-  \return               MIE Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MIE(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mie" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MIE
-  \details Writes the given value to the MIE Register.
-  \param [in]    mie  MIE Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MIE(uint64_t mie)
-{
-    __ASM volatile("csrw mie, %0" : : "r"(mie));
-}
-
-/**
-  \brief   Get MTVEC Register
-  \details Returns the content of the MTVEC Register.
-  \return               MTVEC Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MTVEC(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mtvec" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MTVEC
-  \details Writes the given value to the MTVEC Register.
-  \param [in]    mtvec  MTVEC Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MTVEC(uint64_t mtvec)
-{
-    __ASM volatile("csrw mtvec, %0" : : "r"(mtvec));
-}
-
-/**
-  \brief   Set MTVT
-  \details Writes the given value to the MTVT Register.
-  \param [in]    mtvt  MTVT Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MTVT(uint64_t mtvt)
-{
-    __ASM volatile("csrw mtvt, %0" : : "r"(mtvt));
-}
-
-/**
-  \brief   Get MTVT Register
-  \details Returns the content of the MTVT Register.
-  \return               MTVT Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MTVT(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mtvt" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MTIME
-  \details Returns the content of the MTIME Register.
-  \return               MTIME Register value
-  */
-__ALWAYS_STATIC_INLINE uint64_t __get_MTIME(void)
-{
-    uint64_t result;
-
-    __ASM volatile("rdtime %0" : "=r"(result));
-    //__ASM volatile("csrr %0, 0xc01" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get SP
-  \details Returns the content of the SP Register.
-  \return               SP Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SP(void)
-{
-    uint64_t result;
-
-    __ASM volatile("mv %0, sp" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set SP
-  \details Writes the given value to the SP Register.
-  \param [in]    sp  SP Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_SP(uint64_t sp)
-{
-    __ASM volatile("mv sp, %0" : : "r"(sp): "sp");
-}
-
-/**
-  \brief   Get MSCRATCH Register
-  \details Returns the content of the MSCRATCH Register.
-  \return               MSCRATCH Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MSCRATCH(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mscratch" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MSCRATCH
-  \details Writes the given value to the MSCRATCH Register.
-  \param [in]    mscratch  MSCRATCH Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MSCRATCH(uint64_t mscratch)
-{
-    __ASM volatile("csrw mscratch, %0" : : "r"(mscratch));
-}
-
-/**
-  \brief   Get MCAUSE Register
-  \details Returns the content of the MCAUSE Register.
-  \return               MCAUSE Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCAUSE(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mcause" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get SCAUSE Register
-  \details Returns the content of the SCAUSE Register.
-  \return               SCAUSE Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SCAUSE(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, scause" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MNXTI Register
-  \details Returns the content of the MNXTI Register.
-  \return               MNXTI Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MNXTI(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mnxti" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MNXTI
-  \details Writes the given value to the MNXTI Register.
-  \param [in]    mnxti  MNXTI Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MNXTI(uint64_t mnxti)
-{
-    __ASM volatile("csrw mnxti, %0" : : "r"(mnxti));
-}
-
-/**
-  \brief   Get MINTSTATUS Register
-  \details Returns the content of the MINTSTATUS Register.
-  \return               MINTSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MINTSTATUS(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mintstatus" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MTVAL Register
-  \details Returns the content of the MTVAL Register.
-  \return               MTVAL Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MTVAL(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mtval" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MIP Register
-  \details Returns the content of the MIP Register.
-  \return               MIP Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MIP(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mip" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MIP
-  \details Writes the given value to the MIP Register.
-  \param [in]    mip  MIP Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MIP(uint64_t mip)
-{
-    __ASM volatile("csrw mip, %0" : : "r"(mip));
-}
-
-/**
-  \brief   Get MCYCLEL Register
-  \details Returns the content of the MCYCLEL Register.
-  \return               MCYCLE Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCYCLE(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mcycle" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MCYCLEH Register
-  \details Returns the content of the MCYCLEH Register.
-  \return               MCYCLEH Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCYCLEH(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mcycleh" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MINSTRET Register
-  \details Returns the content of the MINSTRET Register.
-  \return               MINSTRET Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MINSTRET(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, minstret" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MINSTRETH Register
-  \details Returns the content of the MINSTRETH Register.
-  \return               MINSTRETH Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MINSTRETH(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, minstreth" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MVENDORID Register
-  \details Returns the content of the MVENDROID Register.
-  \return               MVENDORID Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MVENDORID(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mvendorid" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MARCHID Register
-  \details Returns the content of the MARCHID Register.
-  \return               MARCHID Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MARCHID(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, marchid" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MIMPID Register
-  \details Returns the content of the MIMPID Register.
-  \return               MIMPID Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MIMPID(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mimpid" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get MHARTID Register
-  \details Returns the content of the MHARTID Register.
-  \return               MHARTID Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MHARTID(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, mhartid" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get PMPCFGx Register
-  \details Returns the content of the PMPCFGx Register.
-  \return               PMPCFGx Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPCFG0(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpcfg0" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPCFG1(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpcfg1" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPCFG2(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpcfg2" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPCFG3(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpcfg3" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get PMPxCFG Register by index
-  \details Returns the content of the PMPxCFG Register.
-  \param [in]    idx    PMP region index
-  \return               PMPxCFG Register value
- */
-__STATIC_INLINE uint8_t __get_PMPxCFG(uint64_t idx)
-{
-    uint64_t pmpcfgx = 0;
-
-    if (idx < 4) {
-        pmpcfgx = __get_PMPCFG0();
-    } else if (idx >= 4 && idx < 8) {
-        idx -= 4;
-        pmpcfgx = __get_PMPCFG1();
-    } else if (idx >= 8 && idx < 12) {
-        idx -= 8;
-        pmpcfgx = __get_PMPCFG2();
-    } else if (idx >= 12 && idx < 16) {
-        idx -= 12;
-        pmpcfgx = __get_PMPCFG3();
-    } else {
-        return 0;
-    }
-
-    return (uint8_t)((pmpcfgx & (0xFF << (idx << 3))) >> (idx << 3));
-}
-
-/**
-  \brief   Set PMPCFGx
-  \details Writes the given value to the PMPCFGx Register.
-  \param [in]    pmpcfg  PMPCFGx Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_PMPCFG0(uint64_t pmpcfg)
-{
-    __ASM volatile("csrw pmpcfg0, %0" : : "r"(pmpcfg));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPCFG1(uint64_t pmpcfg)
-{
-    __ASM volatile("csrw pmpcfg1, %0" : : "r"(pmpcfg));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPCFG2(uint64_t pmpcfg)
-{
-    __ASM volatile("csrw pmpcfg2, %0" : : "r"(pmpcfg));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPCFG3(uint64_t pmpcfg)
-{
-    __ASM volatile("csrw pmpcfg3, %0" : : "r"(pmpcfg));
-}
-
-/**
-  \brief   Set PMPxCFG by index
-  \details Writes the given value to the PMPxCFG Register.
-  \param [in]    idx      PMPx region index
-  \param [in]    pmpxcfg  PMPxCFG Register value to set
- */
-__STATIC_INLINE void __set_PMPxCFG(uint64_t idx, uint8_t pmpxcfg)
-{
-    uint64_t pmpcfgx = 0;
-
-    if (idx < 4) {
-        pmpcfgx = __get_PMPCFG0();
-        pmpcfgx = (pmpcfgx & ~(0xFF << (idx << 3))) | ((uint64_t)(pmpxcfg) << (idx << 3));
-        __set_PMPCFG0(pmpcfgx);
-    } else if (idx >= 4 && idx < 8) {
-        idx -= 4;
-        pmpcfgx = __get_PMPCFG1();
-        pmpcfgx = (pmpcfgx & ~(0xFF << (idx << 3))) | ((uint64_t)(pmpxcfg) << (idx << 3));
-        __set_PMPCFG1(pmpcfgx);
-    } else if (idx >= 8 && idx < 12) {
-        idx -= 8;
-        pmpcfgx = __get_PMPCFG2();
-        pmpcfgx = (pmpcfgx & ~(0xFF << (idx << 3))) | ((uint64_t)(pmpxcfg) << (idx << 3));
-        __set_PMPCFG2(pmpcfgx);
-    } else if (idx >= 12 && idx < 16) {
-        idx -= 12;
-        pmpcfgx = __get_PMPCFG3();
-        pmpcfgx = (pmpcfgx & ~(0xFF << (idx << 3))) | ((uint64_t)(pmpxcfg) << (idx << 3));
-        __set_PMPCFG3(pmpcfgx);
-    } else {
-        return;
-    }
-}
-
-/**
-  \brief   Get PMPADDRx Register
-  \details Returns the content of the PMPADDRx Register.
-  \return               PMPADDRx Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR0(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr0" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR1(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr1" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR2(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr2" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR3(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr3" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR4(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr4" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR5(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr5" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR6(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr6" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR7(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr7" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR8(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr8" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR9(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr9" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR10(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr10" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR11(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr11" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR12(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr12" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR13(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr13" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR14(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr14" : "=r"(result));
-    return (result);
-}
-
-__ALWAYS_STATIC_INLINE uint64_t __get_PMPADDR15(void)
-{
-    uint64_t result;
-
-    __ASM volatile("csrr %0, pmpaddr15" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Get PMPADDRx Register by index
-  \details Returns the content of the PMPADDRx Register.
-  \param [in]    idx    PMP region index
-  \return               PMPADDRx Register value
- */
-__STATIC_INLINE uint64_t __get_PMPADDRx(uint64_t idx)
-{
-    switch (idx) {
-        case 0:
-            return __get_PMPADDR0();
-
-        case 1:
-            return __get_PMPADDR1();
-
-        case 2:
-            return __get_PMPADDR2();
-
-        case 3:
-            return __get_PMPADDR3();
-
-        case 4:
-            return __get_PMPADDR4();
-
-        case 5:
-            return __get_PMPADDR5();
-
-        case 6:
-            return __get_PMPADDR6();
-
-        case 7:
-            return __get_PMPADDR7();
-
-        case 8:
-            return __get_PMPADDR8();
-
-        case 9:
-            return __get_PMPADDR9();
-
-        case 10:
-            return __get_PMPADDR10();
-
-        case 11:
-            return __get_PMPADDR11();
-
-        case 12:
-            return __get_PMPADDR12();
-
-        case 13:
-            return __get_PMPADDR13();
-
-        case 14:
-            return __get_PMPADDR14();
-
-        case 15:
-            return __get_PMPADDR15();
-
-        default:
-            return 0;
-    }
-}
-
-/**
-  \brief   Set PMPADDRx
-  \details Writes the given value to the PMPADDRx Register.
-  \param [in]    pmpaddr  PMPADDRx Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_PMPADDR0(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr0, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR1(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr1, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR2(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr2, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR3(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr3, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR4(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr4, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR5(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr5, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR6(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr6, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR7(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr7, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR8(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr8, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR9(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr9, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR10(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr10, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR11(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr11, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR12(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr12, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR13(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr13, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR14(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr14, %0" : : "r"(pmpaddr));
-}
-
-__ALWAYS_STATIC_INLINE void __set_PMPADDR15(uint64_t pmpaddr)
-{
-    __ASM volatile("csrw pmpaddr15, %0" : : "r"(pmpaddr));
-}
-
-/**
-  \brief   Set PMPADDRx by index
-  \details Writes the given value to the PMPADDRx Register.
-  \param [in]    idx      PMP region index
-  \param [in]    pmpaddr  PMPADDRx Register value to set
- */
-__STATIC_INLINE void __set_PMPADDRx(uint64_t idx, uint64_t pmpaddr)
-{
-    switch (idx) {
-        case 0:
-            __set_PMPADDR0(pmpaddr);
-            break;
-
-        case 1:
-            __set_PMPADDR1(pmpaddr);
-            break;
-
-        case 2:
-            __set_PMPADDR2(pmpaddr);
-            break;
-
-        case 3:
-            __set_PMPADDR3(pmpaddr);
-            break;
-
-        case 4:
-            __set_PMPADDR4(pmpaddr);
-            break;
-
-        case 5:
-            __set_PMPADDR5(pmpaddr);
-            break;
-
-        case 6:
-            __set_PMPADDR6(pmpaddr);
-            break;
-
-        case 7:
-            __set_PMPADDR7(pmpaddr);
-            break;
-
-        case 8:
-            __set_PMPADDR8(pmpaddr);
-            break;
-
-        case 9:
-            __set_PMPADDR9(pmpaddr);
-            break;
-
-        case 10:
-            __set_PMPADDR10(pmpaddr);
-            break;
-
-        case 11:
-            __set_PMPADDR11(pmpaddr);
-            break;
-
-        case 12:
-            __set_PMPADDR12(pmpaddr);
-            break;
-
-        case 13:
-            __set_PMPADDR13(pmpaddr);
-            break;
-
-        case 14:
-            __set_PMPADDR14(pmpaddr);
-            break;
-
-        case 15:
-            __set_PMPADDR15(pmpaddr);
-            break;
-
-        default:
-            return;
-    }
-}
-
-/**
-  \brief   Get MCOUNTEREN
-  \details Returns the content of the MCOUNTEREN Register.
-  \return               MCOUNTEREN Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCOUNTEREN(void)
-{
-    uint32_t result;
-
-    __ASM volatile("csrr %0, mcounteren" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MCOUNTEREN
-  \details Writes the given value to the MCOUNTEREN Register.
-  \param [in]    mcounteren  MCOUNTEREN Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MCOUNTEREN(uint32_t mcounteren)
-{
-    __ASM volatile("csrw mcounteren, %0" : : "r"(mcounteren));
-}
-
-/**
-  \brief   Get MCOUNTERWEN
-  \details Returns the content of the MCOUNTERWEN Register.
-  \return               MCOUNTERWEN Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MCOUNTERWEN(void)
-{
-    uint32_t result;
-
-    __ASM volatile("csrr %0, mcounterwen" : "=r"(result));
-    return (result);
-}
-
-/**
-  \brief   Set MCOUNTERWEN
-  \details Writes the given value to the MCOUNTERWEN Register.
-  \param [in]    mcounterwen  MCOUNTERWEN Register value to set
- */
-__ALWAYS_STATIC_INLINE void __set_MCOUNTERWEN(uint32_t mcounterwen)
-{
-    __ASM volatile("csrw mcounterwen, %0" : : "r"(mcounterwen));
-}
-/**
-  \brief   Set MEDELEG Register
-  \details Writes the given value to the MEDELEG Register.
- */
-__ALWAYS_STATIC_INLINE void __set_MEDELEG(uint64_t x)
-{
-    asm volatile("csrw medeleg, %0"::"r"(x));
-}
-
-/**
-  \brief   Set MEDELEG Register
-  \details Writes the given value to the MEDELEG Register.
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MEDELEG(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, medeleg":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Set MIDELEG Register
-  \details Writes the given value to the MIDELEG Register.
- */
-__ALWAYS_STATIC_INLINE void __set_MIDELEG(uint64_t x)
-{
-    asm volatile("csrw mideleg, %0"::"r"(x));
-}
-
-/**
-  \brief   Get MIDELEG Register
-  \details Returns the content of the MIDELEG Register.
-  \return               MIDELEG Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_MIDELEG(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, mideleg":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Set SSTATUS Register
-  \details Writes the given value to the SSTATUS Register.
- */
-__ALWAYS_STATIC_INLINE void __set_SSTATUS(uint64_t x)
-{
-    asm volatile("csrw sstatus, %0"::"r"(x));
-}
-
-/**
-  \brief   Get SSTATUS Register
-  \details Returns the content of the SSTATUS Register.
-  \return               SSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SSTATUS(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, sstatus":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Set SXSTATUS Register
-  \details Writes the given value to the SXSTATUS Register.
- */
-__ALWAYS_STATIC_INLINE void __set_SXSTATUS(uint64_t x)
-{
-    asm volatile("csrw sxstatus, %0"::"r"(x));
-}
-
-/**
-  \brief   Get SXSTATUS Register
-  \details Returns the content of the SXSTATUS Register.
-  \return               SXSTATUS Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get__SXSTATUS(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, sxstatus":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Set SIE Register
-  \details Writes the given value to the SIE Register.
- */
-__ALWAYS_STATIC_INLINE void __set_SIE(uint64_t x)
-{
-    asm volatile("csrw sie, %0"::"r"(x));
-}
-
-/**
-  \brief   Get SIE Register
-  \details Returns the content of the SIE Register.
-  \return               SIE Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_SIE(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, sie":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Set STVAC Register
-  \details Writes the given value to the STVEC Register.
- */
-__ALWAYS_STATIC_INLINE void __set_STVEC(uint64_t x)
-{
-    asm volatile("csrw stvec, %0"::"r"(x));
-}
-
-/**
-  \brief   Get STVAC Register
-  \details Returns the content of the STVAC Register.
-  \return               STVAC Register value
- */
-__ALWAYS_STATIC_INLINE uint64_t __get_STVEC(void)
-{
-    uint64_t x;
-    asm volatile("csrr %0, stvec":"=r"(x));
-    return x;
-}
-
-/**
-  \brief   Enable interrupts and exceptions
-  \details Enables interrupts and exceptions by setting the IE-bit and EE-bit in the PSR.
-           Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __enable_excp_irq(void)
-{
-#ifdef CONFIG_MMU
-    __enable_supervisor_irq();
-#else
-    __enable_irq();
-#endif
-}
-
-
-/**
-  \brief   Disable interrupts and exceptions
-  \details Disables interrupts and exceptions by clearing the IE-bit and EE-bit in the PSR.
-           Can only be executed in Privileged modes.
- */
-__ALWAYS_STATIC_INLINE void __disable_excp_irq(void)
-{
-#ifdef CONFIG_MMU
-    __disable_supervisor_irq();
-#else
-    __disable_irq();
-#endif
-}
-
-#define __CSI_GCC_OUT_REG(r) "=r" (r)
-#define __CSI_GCC_USE_REG(r) "r" (r)
-
-/**
-  \brief   No Operation
-  \details No Operation does nothing. This instruction can be used for code alignment purposes.
- */
-__ALWAYS_STATIC_INLINE void __NOP(void)
-{
-    __ASM volatile("nop");
-}
-
-
-/**
-  \brief   return from M-MODE
-  \details return from M-MODE.
- */
-__ALWAYS_STATIC_INLINE void __MRET(void)
-{
-    __ASM volatile("mret");
-}
-
-/**
-  \brief   Wait For Interrupt
-  \details Wait For Interrupt is a hint instruction that suspends execution until one of a number of events occurs.
- */
-__ALWAYS_STATIC_INLINE void __WFI(void)
-{
-    __ASM volatile("wfi");
-}
-
-/**
-  \brief   Wait For Interrupt
-  \details Wait For Interrupt is a hint instruction that suspends execution until one interrupt occurs.
- */
-__ALWAYS_STATIC_INLINE void __WAIT(void)
-{
-    __ASM volatile("wfi");
-}
-
-/**
-  \brief   Doze For Interrupt
-  \details Doze For Interrupt is a hint instruction that suspends execution until one interrupt occurs.
- */
-__ALWAYS_STATIC_INLINE void __DOZE(void)
-{
-    __ASM volatile("wfi");
-}
-
-/**
-  \brief   Stop For Interrupt
-  \details Stop For Interrupt is a hint instruction that suspends execution until one interrupt occurs.
- */
-__ALWAYS_STATIC_INLINE void __STOP(void)
-{
-    __ASM volatile("wfi");
-}
-
-/**
-  \brief   Instruction Synchronization Barrier
-  \details Instruction Synchronization Barrier flushes the pipeline in the processor,
-           so that all instructions following the ISB are fetched from cache or memory,
-           after the instruction has been completed.
- */
-__ALWAYS_STATIC_INLINE void __ISB(void)
-{
-    __ASM volatile("fence.i");
-    __ASM volatile("fence r, r");
-}
-
-
-/**
-  \brief   Data Synchronization Barrier
-  \details Acts as a special kind of Data Memory Barrier.
-           It completes when all explicit memory accesses before this instruction complete.
- */
-__ALWAYS_STATIC_INLINE void __DSB(void)
-{
-    __ASM volatile("fence iorw, iorw");
-    __ASM volatile("sync");
-}
-
-/**
-  \brief   Data Memory Barrier
-  \details Ensures the apparent order of the explicit memory operations before
-           and after the instruction, without ensuring their completion.
- */
-__ALWAYS_STATIC_INLINE void __DMB(void)
-{
-    __ASM volatile("fence rw, rw");
-}
-
-/**
-  \brief   Data Synchronization Barrier
-  \details Acts as a special kind of Data Memory Barrier.
-           It completes when all explicit memory accesses before this instruction complete.
- */
-__ALWAYS_STATIC_INLINE void __SYNC_IS(void)
-{
-    __ASM volatile("sync.is");
-}
-
-/**
-  \brief   Invalid all icache
-  \details invalid all icache.
- */
-__ALWAYS_STATIC_INLINE void __ICACHE_IALL(void)
-{
-    __ASM volatile("icache.iall");
-}
-
-/**
-  \brief   Invalid all cpu icache
-  \details invalid all cpu icache.
- */
-__ALWAYS_STATIC_INLINE void __ICACHE_IALLS(void)
-{
-    __ASM volatile("icache.ialls");
-}
-
-/**
-  \brief   Invalid Icache by phy addr
-  \details Invalid Icache by phy addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __ICACHE_IPA(uint64_t addr)
-{
-    __ASM volatile("icache.ipa %0" : : "r"(addr));
-}
-
-/**
-  \brief   Invalid Icache by virt address
-  \details Invalid Icache by virt address
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __ICACHE_IVA(uint64_t addr)
-{
-    __ASM volatile("icache.iva %0" : : "r"(addr));
-}
-
-/**
-  \brief   Invalid all dcache
-  \details invalid all dcache.
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_IALL(void)
-{
-    __ASM volatile("dcache.iall");
-}
-
-/**
-  \brief   Clear all dcache
-  \details clear all dcache.
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CALL(void)
-{
-    __ASM volatile("dcache.call");
-}
-
-/**
-  \brief   Clear&invalid all dcache
-  \details clear & invalid all dcache.
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CIALL(void)
-{
-    __ASM volatile("dcache.ciall");
-}
-
-#if (__L2CACHE_PRESENT == 1U)
-/**
-  \brief   Invalid L2 cache
-  \details invalid L2 cache.
- */
-__ALWAYS_STATIC_INLINE void __L2CACHE_IALL(void)
-{
-    __ASM volatile("l2cache.iall");
-}
-
-/**
-  \brief   Clear L2cache
-  \details clear L2cache.
- */
-__ALWAYS_STATIC_INLINE void __L2CACHE_CALL(void)
-{
-    __ASM volatile("l2cache.call");
-}
-
-/**
-  \brief   Clear&invalid L2cache
-  \details clear & invalid L2cache.
- */
-__ALWAYS_STATIC_INLINE void __L2CACHE_CIALL(void)
-{
-    __ASM volatile("l2cache.ciall");
-}
-#endif
-
-
-/**
-  \brief   Invalid Dcache by addr
-  \details Invalid Dcache by addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_IPA(uint64_t addr)
-{
-    __ASM volatile("dcache.ipa %0" : : "r"(addr));
-}
-
-/**
-  \brief   Invalid Dcache by virt addr
-  \details Invalid Dcache by virt addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_IVA(uint64_t addr)
-{
-    __ASM volatile("dcache.iva %0" : : "r"(addr));
-}
-
-/**
-  \brief   Clear Dcache by addr
-  \details Clear Dcache by addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CPA(uint64_t addr)
-{
-    __ASM volatile("dcache.cpa %0" : : "r"(addr));
-}
-
-/**
-  \brief   Clear Dcache by virt addr
-  \details Clear Dcache by virt addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CVA(uint64_t addr)
-{
-    __ASM volatile("dcache.cva %0" : : "r"(addr));
-}
-
-/**
-  \brief   Clear & Invalid Dcache by addr
-  \details Clear & Invalid Dcache by addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CIPA(uint64_t addr)
-{
-    __ASM volatile("dcache.cipa %0" : : "r"(addr));
-}
-
-/**
-  \brief   Clear & Invalid Dcache by virt addr
-  \details Clear & Invalid Dcache by virt addr.
-  \param [in] addr  operate addr
- */
-__ALWAYS_STATIC_INLINE void __DCACHE_CIVA(uint64_t addr)
-{
-    __ASM volatile("dcache.civa %0" : : "r"(addr));
-}
-
-/**
-  \brief   Reverse byte order (32 bit)
-  \details Reverses the byte order in integer value.
-  \param [in]    value  Value to reverse
-  \return               Reversed value
- */
-__ALWAYS_STATIC_INLINE uint64_t __REV(uint64_t value)
-{
-    return __builtin_bswap32(value);
-}
-
-
-/**
-  \brief   Reverse byte order (16 bit)
-  \details Reverses the byte order in two unsigned short values.
-  \param [in]    value  Value to reverse
-  \return               Reversed value
- */
-__ALWAYS_STATIC_INLINE uint32_t __REV16(uint32_t value)
-{
-    uint32_t result;
-
-    result = ((value & 0xFF000000) >> 8) | ((value & 0x00FF0000) << 8) |
-             ((value & 0x0000FF00) >> 8) | ((value & 0x000000FF) << 8);
-
-    return (result);
-}
-
-
-/**
-  \brief   Reverse byte order in signed short value
-  \details Reverses the byte order in a signed short value with sign extension to integer.
-  \param [in]    value  Value to reverse
-  \return               Reversed value
- */
-__ALWAYS_STATIC_INLINE int32_t __REVSH(int32_t value)
-{
-    return (short)(((value & 0xFF00) >> 8) | ((value & 0x00FF) << 8));
-}
-
-
-/**
-  \brief   Rotate Right in unsigned value (32 bit)
-  \details Rotate Right (immediate) provides the value of the contents of a register rotated by a variable number of bits.
-  \param [in]    op1  Value to rotate
-  \param [in]    op2  Number of Bits to rotate
-  \return               Rotated value
- */
-__ALWAYS_STATIC_INLINE uint32_t __ROR(uint32_t op1, uint32_t op2)
-{
-    return (op1 >> op2) | (op1 << (32U - op2));
-}
-
-
-/**
-  \brief   Breakpoint
-  \details Causes the processor to enter Debug state
-           Debug tools can use this to investigate system state when the instruction at a particular address is reached.
- */
-__ALWAYS_STATIC_INLINE void __BKPT(void)
-{
-    __ASM volatile("ebreak");
-}
-
-/**
-  \brief   Reverse bit order of value
-  \details Reverses the bit order of the given value.
-  \param [in]    value  Value to reverse
-  \return               Reversed value
- */
-__ALWAYS_STATIC_INLINE uint32_t __RBIT(uint32_t value)
-{
-    uint32_t result;
-
-    int32_t s = 4 /*sizeof(v)*/ * 8 - 1; /* extra shift needed at end */
-
-    result = value;                      /* r will be reversed bits of v; first get LSB of v */
-
-    for (value >>= 1U; value; value >>= 1U) {
-        result <<= 1U;
-        result |= value & 1U;
-        s--;
-    }
-
-    result <<= s;                        /* shift when v's highest bits are zero */
-
-    return (result);
-}
-
-
-/**
-  \brief   Count leading zeros
-  \details Counts the number of leading zeros of a data value.
-  \param [in]  value  Value to count the leading zeros
-  \return             number of leading zeros in value
- */
-#define __CLZ             __builtin_clz
-/**
-  \details This function saturates a signed value.
-  \param [in]    x   Value to be saturated
-  \param [in]    y   Bit position to saturate to [1..32]
-  \return            Saturated value.
- */
-__ALWAYS_STATIC_INLINE int32_t __SSAT(int32_t x, uint32_t y)
-{
-    int32_t posMax, negMin;
-    uint32_t i;
-
-    posMax = 1;
-
-    for (i = 0; i < (y - 1); i++) {
-        posMax = posMax * 2;
-    }
-
-    if (x > 0) {
-        posMax = (posMax - 1);
-
-        if (x > posMax) {
-            x = posMax;
-        }
-
-//    x &= (posMax * 2 + 1);
-    } else {
-        negMin = -posMax;
-
-        if (x < negMin) {
-            x = negMin;
-        }
-
-//    x &= (posMax * 2 - 1);
-    }
-
-    return (x);
-}
-
-/**
-  \brief   Unsigned Saturate
-  \details Saturates an unsigned value.
-  \param [in]  value  Value to be saturated
-  \param [in]    sat  Bit position to saturate to (0..31)
-  \return             Saturated value
- */
-__ALWAYS_STATIC_INLINE uint32_t __USAT(uint32_t value, uint32_t sat)
-{
-    uint32_t result;
-
-    if ((((0xFFFFFFFF >> sat) << sat) & value) != 0) {
-        result = 0xFFFFFFFF >> (32 - sat);
-    } else {
-        result = value;
-    }
-
-    return (result);
-}
-
-/**
-  \brief   Unsigned Saturate for internal use
-  \details Saturates an unsigned value, should not call directly.
-  \param [in]  value  Value to be saturated
-  \param [in]    sat  Bit position to saturate to (0..31)
-  \return             Saturated value
- */
-__ALWAYS_STATIC_INLINE uint32_t __IUSAT(uint32_t value, uint32_t sat)
-{
-    uint32_t result;
-
-    if (value & 0x80000000) { /* only overflow set bit-31 */
-        result = 0;
-    } else if ((((0xFFFFFFFF >> sat) << sat) & value) != 0) {
-        result = 0xFFFFFFFF >> (32 - sat);
-    } else {
-        result = value;
-    }
-
-    return (result);
-}
-
-/**
-  \brief   Rotate Right with Extend
-  \details This function moves each bit of a bitstring right by one bit.
-           The carry input is shifted in at the left end of the bitstring.
-  \note    carry input will always 0.
-  \param [in]    op1  Value to rotate
-  \return               Rotated value
- */
-__ALWAYS_STATIC_INLINE uint32_t __RRX(uint32_t op1)
-{
-    return 0;
-}
-
-/**
-  \brief   LDRT Unprivileged (8 bit)
-  \details Executes a Unprivileged LDRT instruction for 8 bit value.
-  \param [in]    addr  Pointer to location
-  \return             value of type uint8_t at (*ptr)
- */
-__ALWAYS_STATIC_INLINE uint8_t __LDRBT(volatile uint8_t *addr)
-{
-    uint32_t result;
-
-    __ASM volatile("lb %0, 0(%1)" : "=r"(result) : "r"(addr));
-
-    return ((uint8_t) result);    /* Add explicit type cast here */
-}
-
-
-/**
-  \brief   LDRT Unprivileged (16 bit)
-  \details Executes a Unprivileged LDRT instruction for 16 bit values.
-  \param [in]    addr  Pointer to location
-  \return        value of type uint16_t at (*ptr)
- */
-__ALWAYS_STATIC_INLINE uint16_t __LDRHT(volatile uint16_t *addr)
-{
-    uint32_t result;
-
-    __ASM volatile("lh %0, 0(%1)" : "=r"(result) : "r"(addr));
-
-    return ((uint16_t) result);    /* Add explicit type cast here */
-}
-
-
-/**
-  \brief   LDRT Unprivileged (32 bit)
-  \details Executes a Unprivileged LDRT instruction for 32 bit values.
-  \param [in]    addr  Pointer to location
-  \return        value of type uint32_t at (*ptr)
- */
-__ALWAYS_STATIC_INLINE uint32_t __LDRT(volatile uint32_t *addr)
-{
-    uint32_t result;
-
-    __ASM volatile("lw %0, 0(%1)" : "=r"(result) : "r"(addr));
-
-    return (result);
-}
-
-
-/**
-  \brief   STRT Unprivileged (8 bit)
-  \details Executes a Unprivileged STRT instruction for 8 bit values.
-  \param [in]  value  Value to store
-  \param [in]    addr  Pointer to location
- */
-__ALWAYS_STATIC_INLINE void __STRBT(uint8_t value, volatile uint8_t *addr)
-{
-    __ASM volatile("sb %1, 0(%0)" :: "r"(addr), "r"((uint32_t)value) : "memory");
-}
-
-
-/**
-  \brief   STRT Unprivileged (16 bit)
-  \details Executes a Unprivileged STRT instruction for 16 bit values.
-  \param [in]  value  Value to store
-  \param [in]    addr  Pointer to location
- */
-__ALWAYS_STATIC_INLINE void __STRHT(uint16_t value, volatile uint16_t *addr)
-{
-    __ASM volatile("sh %1, 0(%0)" :: "r"(addr), "r"((uint32_t)value) : "memory");
-}
-
-
-/**
-  \brief   STRT Unprivileged (32 bit)
-  \details Executes a Unprivileged STRT instruction for 32 bit values.
-  \param [in]  value  Value to store
-  \param [in]    addr  Pointer to location
- */
-__ALWAYS_STATIC_INLINE void __STRT(uint32_t value, volatile uint32_t *addr)
-{
-    __ASM volatile("sw %1, 0(%0)" :: "r"(addr), "r"(value) : "memory");
-}
-
-/*@}*/ /* end of group CSI_Core_InstructionInterface */
-
-/* ###################  Compiler specific Intrinsics  ########################### */
-/** \defgroup CSI_SIMD_intrinsics CSI SIMD Intrinsics
-  Access to dedicated SIMD instructions \n
-  Single Instruction Multiple Data (SIMD) extensions are provided to simplify development of application software. SIMD extensions increase the processing capability without materially increasing the power consumption. The SIMD extensions are completely transparent to the operating system (OS), allowing existing OS ports to be used.
-
-  @{
-*/
-
-/**
-  \brief   Halfword packing instruction. Combines bits[15:0] of val1 with bits[31:16]
-           of val2 levitated with the val3.
-  \details Combine a halfword from one register with a halfword from another register.
-           The second argument can be left-shifted before extraction of the halfword.
-  \param [in]    val1   first 16-bit operands
-  \param [in]    val2   second 16-bit operands
-  \param [in]    val3   value for left-shifting val2. Value range [0..31].
-  \return               the combination of halfwords.
-  \remark
-                 res[15:0]  = val1[15:0]              \n
-                 res[31:16] = val2[31:16] << val3
- */
-__ALWAYS_STATIC_INLINE uint32_t __PKHBT(uint32_t val1, uint32_t val2, uint32_t val3)
-{
-    return ((((int32_t)(val1) << 0) & (int32_t)0x0000FFFF) | (((int32_t)(val2) << val3) & (int32_t)0xFFFF0000));
-}
-
-/**
-  \brief   Halfword packing instruction. Combines bits[31:16] of val1 with bits[15:0]
-           of val2 right-shifted with the val3.
-  \details Combine a halfword from one register with a halfword from another register.
-           The second argument can be right-shifted before extraction of the halfword.
-  \param [in]    val1   first 16-bit operands
-  \param [in]    val2   second 16-bit operands
-  \param [in]    val3   value for right-shifting val2. Value range [1..32].
-  \return               the combination of halfwords.
-  \remark
-                 res[15:0]  = val2[15:0] >> val3        \n
-                 res[31:16] = val1[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __PKHTB(uint32_t val1, uint32_t val2, uint32_t val3)
-{
-    return ((((int32_t)(val1) << 0) & (int32_t)0xFFFF0000) | (((int32_t)(val2) >> val3) & (int32_t)0x0000FFFF));
-}
-
-/**
-  \brief   Dual 16-bit signed saturate.
-  \details This function saturates a signed value.
-  \param [in]    x   two signed 16-bit values to be saturated.
-  \param [in]    y   bit position for saturation, an integral constant expression in the range 1 to 16.
-  \return        the sum of the absolute differences of the following bytes, added to the accumulation value:\n
-                 the signed saturation of the low halfword in val1, saturated to the bit position specified in
-                 val2 and returned in the low halfword of the return value.\n
-                 the signed saturation of the high halfword in val1, saturated to the bit position specified in
-                 val2 and returned in the high halfword of the return value.
- */
-__ALWAYS_STATIC_INLINE uint32_t __SSAT16(int32_t x, const uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = __SSAT((((int32_t)x << 16) >> 16), y) & (int32_t)0x0000FFFF;
-    s = __SSAT((((int32_t)x) >> 16), y) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned saturate.
-  \details This function enables you to saturate two signed 16-bit values to a selected unsigned range.
-  \param [in]    x   two signed 16-bit values to be saturated.
-  \param [in]    y   bit position for saturation, an integral constant expression in the range 1 to 16.
-  \return        the saturation of the two signed 16-bit values, as non-negative values:
-                 the saturation of the low halfword in val1, saturated to the bit position specified in
-                 val2 and returned in the low halfword of the return value.\n
-                 the saturation of the high halfword in val1, saturated to the bit position specified in
-                 val2 and returned in the high halfword of the return value.
- */
-__ALWAYS_STATIC_INLINE uint32_t __USAT16(uint32_t x, const uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = __IUSAT(((x << 16) >> 16), y) & 0x0000FFFF;
-    s = __IUSAT(((x) >> 16), y) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Quad 8-bit saturating addition.
-  \details This function enables you to perform four 8-bit integer additions,
-           saturating the results to the 8-bit signed integer range -2^7 <= x <= 2^7 - 1.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the saturated addition of the first byte of each operand in the first byte of the return value.\n
-                 the saturated addition of the second byte of each operand in the second byte of the return value.\n
-                 the saturated addition of the third byte of each operand in the third byte of the return value.\n
-                 the saturated addition of the fourth byte of each operand in the fourth byte of the return value.\n
-                 The returned results are saturated to the 8-bit signed integer range -2^7 <= x <= 2^7 - 1.
-  \remark
-                 res[7:0]   = val1[7:0]   + val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  + val2[15:8]       \n
-                 res[23:16] = val1[23:16] + val2[23:16]      \n
-                 res[31:24] = val1[31:24] + val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = __SSAT(((((int32_t)x << 24) >> 24) + (((int32_t)y << 24) >> 24)), 8) & (int32_t)0x000000FF;
-    s = __SSAT(((((int32_t)x << 16) >> 24) + (((int32_t)y << 16) >> 24)), 8) & (int32_t)0x000000FF;
-    t = __SSAT(((((int32_t)x <<  8) >> 24) + (((int32_t)y <<  8) >> 24)), 8) & (int32_t)0x000000FF;
-    u = __SSAT(((((int32_t)x) >> 24) + (((int32_t)y) >> 24)), 8) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned saturating addition.
-  \details This function enables you to perform four unsigned 8-bit integer additions,
-           saturating the results to the 8-bit unsigned integer range 0 < x < 2^8 - 1.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the saturated addition of the first byte of each operand in the first byte of the return value.\n
-                 the saturated addition of the second byte of each operand in the second byte of the return value.\n
-                 the saturated addition of the third byte of each operand in the third byte of the return value.\n
-                 the saturated addition of the fourth byte of each operand in the fourth byte of the return value.\n
-                 The returned results are saturated to the 8-bit signed integer range 0 <= x <= 2^8 - 1.
-  \remark
-                 res[7:0]   = val1[7:0]   + val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  + val2[15:8]       \n
-                 res[23:16] = val1[23:16] + val2[23:16]      \n
-                 res[31:24] = val1[31:24] + val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = __IUSAT((((x << 24) >> 24) + ((y << 24) >> 24)), 8) & 0x000000FF;
-    s = __IUSAT((((x << 16) >> 24) + ((y << 16) >> 24)), 8) & 0x000000FF;
-    t = __IUSAT((((x <<  8) >> 24) + ((y <<  8) >> 24)), 8) & 0x000000FF;
-    u = __IUSAT((((x) >> 24) + ((y) >> 24)), 8) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Quad 8-bit signed addition.
-  \details This function performs four 8-bit signed integer additions.
-  \param [in]    x  first four 8-bit summands.
-  \param [in]    y  second four 8-bit summands.
-  \return        the addition of the first bytes from each operand, in the first byte of the return value.\n
-                 the addition of the second bytes of each operand, in the second byte of the return value.\n
-                 the addition of the third bytes of each operand, in the third byte of the return value.\n
-                 the addition of the fourth bytes of each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = val1[7:0]   + val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  + val2[15:8]       \n
-                 res[23:16] = val1[23:16] + val2[23:16]      \n
-                 res[31:24] = val1[31:24] + val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = ((((int32_t)x << 24) >> 24) + (((int32_t)y << 24) >> 24)) & (int32_t)0x000000FF;
-    s = ((((int32_t)x << 16) >> 24) + (((int32_t)y << 16) >> 24)) & (int32_t)0x000000FF;
-    t = ((((int32_t)x <<  8) >> 24) + (((int32_t)y <<  8) >> 24)) & (int32_t)0x000000FF;
-    u = ((((int32_t)x) >> 24) + (((int32_t)y) >> 24)) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned addition.
-  \details This function performs four unsigned 8-bit integer additions.
-  \param [in]    x  first four 8-bit summands.
-  \param [in]    y  second four 8-bit summands.
-  \return        the addition of the first bytes from each operand, in the first byte of the return value.\n
-                 the addition of the second bytes of each operand, in the second byte of the return value.\n
-                 the addition of the third bytes of each operand, in the third byte of the return value.\n
-                 the addition of the fourth bytes of each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = val1[7:0]   + val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  + val2[15:8]       \n
-                 res[23:16] = val1[23:16] + val2[23:16]      \n
-                 res[31:24] = val1[31:24] + val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = (((x << 24) >> 24) + ((y << 24) >> 24)) & 0x000000FF;
-    s = (((x << 16) >> 24) + ((y << 16) >> 24)) & 0x000000FF;
-    t = (((x <<  8) >> 24) + ((y <<  8) >> 24)) & 0x000000FF;
-    u = (((x) >> 24) + ((y) >> 24)) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Quad 8-bit saturating subtract.
-  \details This function enables you to perform four 8-bit integer subtractions,
-           saturating the results to the 8-bit signed integer range -2^7 <= x <= 2^7 - 1.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the subtraction of the first byte of each operand in the first byte of the return value.\n
-                 the subtraction of the second byte of each operand in the second byte of the return value.\n
-                 the subtraction of the third byte of each operand in the third byte of the return value.\n
-                 the subtraction of the fourth byte of each operand in the fourth byte of the return value.\n
-                 The returned results are saturated to the 8-bit signed integer range -2^7 <= x <= 2^7 - 1.
-  \remark
-                 res[7:0]   = val1[7:0]   - val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  - val2[15:8]       \n
-                 res[23:16] = val1[23:16] - val2[23:16]      \n
-                 res[31:24] = val1[31:24] - val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QSUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = __SSAT(((((int32_t)x << 24) >> 24) - (((int32_t)y << 24) >> 24)), 8) & (int32_t)0x000000FF;
-    s = __SSAT(((((int32_t)x << 16) >> 24) - (((int32_t)y << 16) >> 24)), 8) & (int32_t)0x000000FF;
-    t = __SSAT(((((int32_t)x <<  8) >> 24) - (((int32_t)y <<  8) >> 24)), 8) & (int32_t)0x000000FF;
-    u = __SSAT(((((int32_t)x) >> 24) - (((int32_t)y) >> 24)), 8) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned saturating subtraction.
-  \details This function enables you to perform four unsigned 8-bit integer subtractions,
-           saturating the results to the 8-bit unsigned integer range 0 < x < 2^8 - 1.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the subtraction of the first byte of each operand in the first byte of the return value.\n
-                 the subtraction of the second byte of each operand in the second byte of the return value.\n
-                 the subtraction of the third byte of each operand in the third byte of the return value.\n
-                 the subtraction of the fourth byte of each operand in the fourth byte of the return value.\n
-                 The returned results are saturated to the 8-bit unsigned integer range 0 <= x <= 2^8 - 1.
-  \remark
-                 res[7:0]   = val1[7:0]   - val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  - val2[15:8]       \n
-                 res[23:16] = val1[23:16] - val2[23:16]      \n
-                 res[31:24] = val1[31:24] - val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQSUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = __IUSAT((((x << 24) >> 24) - ((y << 24) >> 24)), 8) & 0x000000FF;
-    s = __IUSAT((((x << 16) >> 24) - ((y << 16) >> 24)), 8) & 0x000000FF;
-    t = __IUSAT((((x <<  8) >> 24) - ((y <<  8) >> 24)), 8) & 0x000000FF;
-    u = __IUSAT((((x) >> 24) - ((y) >> 24)), 8) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Quad 8-bit signed subtraction.
-  \details This function enables you to perform four 8-bit signed integer subtractions.
-  \param [in]    x  first four 8-bit operands of each subtraction.
-  \param [in]    y  second four 8-bit operands of each subtraction.
-  \return        the subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the subtraction of the second bytes of each operand, in the second byte of the return value.\n
-                 the subtraction of the third bytes of each operand, in the third byte of the return value.\n
-                 the subtraction of the fourth bytes of each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = val1[7:0]   - val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  - val2[15:8]       \n
-                 res[23:16] = val1[23:16] - val2[23:16]      \n
-                 res[31:24] = val1[31:24] - val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SSUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = ((((int32_t)x << 24) >> 24) - (((int32_t)y << 24) >> 24)) & (int32_t)0x000000FF;
-    s = ((((int32_t)x << 16) >> 24) - (((int32_t)y << 16) >> 24)) & (int32_t)0x000000FF;
-    t = ((((int32_t)x <<  8) >> 24) - (((int32_t)y <<  8) >> 24)) & (int32_t)0x000000FF;
-    u = ((((int32_t)x) >> 24) - (((int32_t)y) >> 24)) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned subtract.
-  \details This function enables you to perform four 8-bit unsigned integer subtractions.
-  \param [in]    x  first four 8-bit operands of each subtraction.
-  \param [in]    y  second four 8-bit operands of each subtraction.
-  \return        the subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the subtraction of the second bytes of each operand, in the second byte of the return value.\n
-                 the subtraction of the third bytes of each operand, in the third byte of the return value.\n
-                 the subtraction of the fourth bytes of each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = val1[7:0]   - val2[7:0]        \n
-                 res[15:8]  = val1[15:8]  - val2[15:8]       \n
-                 res[23:16] = val1[23:16] - val2[23:16]      \n
-                 res[31:24] = val1[31:24] - val2[31:24]
- */
-__ALWAYS_STATIC_INLINE uint32_t __USUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = (((x << 24) >> 24) - ((y << 24) >> 24)) & 0x000000FF;
-    s = (((x << 16) >> 24) - ((y << 16) >> 24)) & 0x000000FF;
-    t = (((x <<  8) >> 24) - ((y <<  8) >> 24)) & 0x000000FF;
-    u = (((x) >> 24) - ((y) >> 24)) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Unsigned sum of quad 8-bit unsigned absolute difference.
-  \details This function enables you to perform four unsigned 8-bit subtractions, and add the absolute values
-           of the differences together, returning the result as a single unsigned integer.
-  \param [in]    x  first four 8-bit operands of each subtraction.
-  \param [in]    y  second four 8-bit operands of each subtraction.
-  \return        the subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the subtraction of the second bytes of each operand, in the second byte of the return value.\n
-                 the subtraction of the third bytes of each operand, in the third byte of the return value.\n
-                 the subtraction of the fourth bytes of each operand, in the fourth byte of the return value.\n
-                 The sum is returned as a single unsigned integer.
-  \remark
-                 absdiff1   = val1[7:0]   - val2[7:0]        \n
-                 absdiff2   = val1[15:8]  - val2[15:8]       \n
-                 absdiff3   = val1[23:16] - val2[23:16]      \n
-                 absdiff4   = val1[31:24] - val2[31:24]      \n
-                 res[31:0]  = absdiff1 + absdiff2 + absdiff3 + absdiff4
- */
-__ALWAYS_STATIC_INLINE uint32_t __USAD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = (((x << 24) >> 24) - ((y << 24) >> 24)) & 0x000000FF;
-    s = (((x << 16) >> 24) - ((y << 16) >> 24)) & 0x000000FF;
-    t = (((x <<  8) >> 24) - ((y <<  8) >> 24)) & 0x000000FF;
-    u = (((x) >> 24) - ((y) >> 24)) & 0x000000FF;
-
-    return (u + t + s + r);
-}
-
-/**
-  \brief   Unsigned sum of quad 8-bit unsigned absolute difference with 32-bit accumulate.
-  \details This function enables you to perform four unsigned 8-bit subtractions, and add the absolute values
-           of the differences to a 32-bit accumulate operand.
-  \param [in]    x  first four 8-bit operands of each subtraction.
-  \param [in]    y  second four 8-bit operands of each subtraction.
-  \param [in]  sum  accumulation value.
-  \return        the sum of the absolute differences of the following bytes, added to the accumulation value:
-                 the subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the subtraction of the second bytes of each operand, in the second byte of the return value.\n
-                 the subtraction of the third bytes of each operand, in the third byte of the return value.\n
-                 the subtraction of the fourth bytes of each operand, in the fourth byte of the return value.
-  \remark
-                 absdiff1 = val1[7:0]   - val2[7:0]        \n
-                 absdiff2 = val1[15:8]  - val2[15:8]       \n
-                 absdiff3 = val1[23:16] - val2[23:16]      \n
-                 absdiff4 = val1[31:24] - val2[31:24]      \n
-                 sum = absdiff1 + absdiff2 + absdiff3 + absdiff4 \n
-                 res[31:0] = sum[31:0] + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __USADA8(uint32_t x, uint32_t y, uint32_t sum)
-{
-    int32_t r, s, t, u;
-
-#ifdef __cplusplus
-    r = (abs((long long)((x << 24) >> 24) - ((y << 24) >> 24))) & 0x000000FF;
-    s = (abs((long long)((x << 16) >> 24) - ((y << 16) >> 24))) & 0x000000FF;
-    t = (abs((long long)((x <<  8) >> 24) - ((y <<  8) >> 24))) & 0x000000FF;
-    u = (abs((long long)((x) >> 24) - ((y) >> 24))) & 0x000000FF;
-#else
-    r = (abs(((x << 24) >> 24) - ((y << 24) >> 24))) & 0x000000FF;
-    s = (abs(((x << 16) >> 24) - ((y << 16) >> 24))) & 0x000000FF;
-    t = (abs(((x <<  8) >> 24) - ((y <<  8) >> 24))) & 0x000000FF;
-    u = (abs(((x) >> 24) - ((y) >> 24))) & 0x000000FF;
-#endif
-    return (u + t + s + r + sum);
-}
-
-/**
-  \brief   Dual 16-bit saturating addition.
-  \details This function enables you to perform two 16-bit integer arithmetic additions in parallel,
-           saturating the results to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the saturated addition of the low halfwords, in the low halfword of the return value.\n
-                 the saturated addition of the high halfwords, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[15:0]        \n
-                 res[31:16] = val1[31:16] + val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QADD16(uint32_t x, uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = __SSAT(((((int32_t)x << 16) >> 16) + (((int32_t)y << 16) >> 16)), 16) & (int32_t)0x0000FFFF;
-    s = __SSAT(((((int32_t)x) >> 16) + (((int32_t)y) >> 16)), 16) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned saturating addition.
-  \details This function enables you to perform two unsigned 16-bit integer additions, saturating
-           the results to the 16-bit unsigned integer range 0 < x < 2^16 - 1.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the saturated addition of the low halfwords, in the low halfword of the return value.\n
-                 the saturated addition of the high halfwords, in the high halfword of the return value.\n
-                 The results are saturated to the 16-bit unsigned integer range 0 < x < 2^16 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[15:0]        \n
-                 res[31:16] = val1[31:16] + val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQADD16(uint32_t x, uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = __IUSAT((((x << 16) >> 16) + ((y << 16) >> 16)), 16) & 0x0000FFFF;
-    s = __IUSAT((((x) >> 16) + ((y) >> 16)), 16) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed addition.
-  \details This function enables you to perform two 16-bit signed integer additions.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the addition of the low halfwords in the low halfword of the return value.\n
-                 the addition of the high halfwords in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[15:0]        \n
-                 res[31:16] = val1[31:16] + val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SADD16(uint32_t x, uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = ((((int32_t)x << 16) >> 16) + (((int32_t)y << 16) >> 16)) & (int32_t)0x0000FFFF;
-    s = ((((int32_t)x) >> 16) + (((int32_t)y) >> 16)) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned addition
-  \details This function enables you to perform two 16-bit unsigned integer additions.
-  \param [in]    x   first two 16-bit summands for each addition.
-  \param [in]    y   second two 16-bit summands for each addition.
-  \return        the addition of the low halfwords in the low halfword of the return value.\n
-                 the addition of the high halfwords in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[15:0]        \n
-                 res[31:16] = val1[31:16] + val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UADD16(uint32_t x, uint32_t y)
-{
-    int32_t r = 0, s = 0;
-
-    r = (((x << 16) >> 16) + ((y << 16) >> 16)) & 0x0000FFFF;
-    s = (((x) >> 16) + ((y) >> 16)) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-
-/**
-  \brief   Dual 16-bit signed addition with halved results.
-  \details This function enables you to perform two signed 16-bit integer additions, halving the results.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the halved addition of the low halfwords, in the low halfword of the return value.\n
-                 the halved addition of the high halfwords, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  + val2[15:0]) >> 1        \n
-                 res[31:16] = (val1[31:16] + val2[31:16]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHADD16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((((int32_t)x << 16) >> 16) + (((int32_t)y << 16) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-    s = (((((int32_t)x) >> 16) + (((int32_t)y) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned addition with halved results.
-  \details This function enables you to perform two unsigned 16-bit integer additions, halving the results.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the halved addition of the low halfwords, in the low halfword of the return value.\n
-                 the halved addition of the high halfwords, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  + val2[15:0]) >> 1        \n
-                 res[31:16] = (val1[31:16] + val2[31:16]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHADD16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((x << 16) >> 16) + ((y << 16) >> 16)) >> 1) & 0x0000FFFF;
-    s = ((((x) >> 16) + ((y) >> 16)) >> 1) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Quad 8-bit signed addition with halved results.
-  \details This function enables you to perform four signed 8-bit integer additions, halving the results.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the halved addition of the first bytes from each operand, in the first byte of the return value.\n
-                 the halved addition of the second bytes from each operand, in the second byte of the return value.\n
-                 the halved addition of the third bytes from each operand, in the third byte of the return value.\n
-                 the halved addition of the fourth bytes from each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = (val1[7:0]   + val2[7:0]  ) >> 1    \n
-                 res[15:8]  = (val1[15:8]  + val2[15:8] ) >> 1    \n
-                 res[23:16] = (val1[23:16] + val2[23:16]) >> 1    \n
-                 res[31:24] = (val1[31:24] + val2[31:24]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = (((((int32_t)x << 24) >> 24) + (((int32_t)y << 24) >> 24)) >> 1) & (int32_t)0x000000FF;
-    s = (((((int32_t)x << 16) >> 24) + (((int32_t)y << 16) >> 24)) >> 1) & (int32_t)0x000000FF;
-    t = (((((int32_t)x <<  8) >> 24) + (((int32_t)y <<  8) >> 24)) >> 1) & (int32_t)0x000000FF;
-    u = (((((int32_t)x) >> 24) + (((int32_t)y) >> 24)) >> 1) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned addition with halved results.
-  \details This function enables you to perform four unsigned 8-bit integer additions, halving the results.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the halved addition of the first bytes from each operand, in the first byte of the return value.\n
-                 the halved addition of the second bytes from each operand, in the second byte of the return value.\n
-                 the halved addition of the third bytes from each operand, in the third byte of the return value.\n
-                 the halved addition of the fourth bytes from each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = (val1[7:0]   + val2[7:0]  ) >> 1    \n
-                 res[15:8]  = (val1[15:8]  + val2[15:8] ) >> 1    \n
-                 res[23:16] = (val1[23:16] + val2[23:16]) >> 1    \n
-                 res[31:24] = (val1[31:24] + val2[31:24]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHADD8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = ((((x << 24) >> 24) + ((y << 24) >> 24)) >> 1) & 0x000000FF;
-    s = ((((x << 16) >> 24) + ((y << 16) >> 24)) >> 1) & 0x000000FF;
-    t = ((((x <<  8) >> 24) + ((y <<  8) >> 24)) >> 1) & 0x000000FF;
-    u = ((((x) >> 24) + ((y) >> 24)) >> 1) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Dual 16-bit saturating subtract.
-  \details This function enables you to perform two 16-bit integer subtractions in parallel,
-           saturating the results to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the saturated subtraction of the low halfwords, in the low halfword of the return value.\n
-                 the saturated subtraction of the high halfwords, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[15:0]        \n
-                 res[31:16] = val1[31:16] - val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QSUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __SSAT(((((int32_t)x << 16) >> 16) - (((int32_t)y << 16) >> 16)), 16) & (int32_t)0x0000FFFF;
-    s = __SSAT(((((int32_t)x) >> 16) - (((int32_t)y) >> 16)), 16) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned saturating subtraction.
-  \details This function enables you to perform two unsigned 16-bit integer subtractions,
-           saturating the results to the 16-bit unsigned integer range 0 < x < 2^16 - 1.
-  \param [in]    x   first two 16-bit operands for each subtraction.
-  \param [in]    y   second two 16-bit operands for each subtraction.
-  \return        the saturated subtraction of the low halfwords, in the low halfword of the return value.\n
-                 the saturated subtraction of the high halfwords, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[15:0]        \n
-                 res[31:16] = val1[31:16] - val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQSUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __IUSAT((((x << 16) >> 16) - ((y << 16) >> 16)), 16) & 0x0000FFFF;
-    s = __IUSAT((((x) >> 16) - ((y) >> 16)), 16) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed subtraction.
-  \details This function enables you to perform two 16-bit signed integer subtractions.
-  \param [in]    x   first two 16-bit operands of each subtraction.
-  \param [in]    y   second two 16-bit operands of each subtraction.
-  \return        the subtraction of the low halfword in the second operand from the low
-                 halfword in the first operand, in the low halfword of the return value. \n
-                 the subtraction of the high halfword in the second operand from the high
-                 halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[15:0]        \n
-                 res[31:16] = val1[31:16] - val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SSUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((int32_t)x << 16) >> 16) - (((int32_t)y << 16) >> 16)) & (int32_t)0x0000FFFF;
-    s = ((((int32_t)x) >> 16) - (((int32_t)y) >> 16)) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned subtract.
-  \details This function enables you to perform two 16-bit unsigned integer subtractions.
-  \param [in]    x   first two 16-bit operands of each subtraction.
-  \param [in]    y   second two 16-bit operands of each subtraction.
-  \return        the subtraction of the low halfword in the second operand from the low
-                 halfword in the first operand, in the low halfword of the return value. \n
-                 the subtraction of the high halfword in the second operand from the high
-                 halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[15:0]        \n
-                 res[31:16] = val1[31:16] - val2[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __USUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((x << 16) >> 16) - ((y << 16) >> 16)) & 0x0000FFFF;
-    s = (((x) >> 16) - ((y) >> 16)) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed subtraction with halved results.
-  \details This function enables you to perform two signed 16-bit integer subtractions, halving the results.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the halved subtraction of the low halfwords, in the low halfword of the return value.\n
-                 the halved subtraction of the high halfwords, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  - val2[15:0]) >> 1        \n
-                 res[31:16] = (val1[31:16] - val2[31:16]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHSUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((((int32_t)x << 16) >> 16) - (((int32_t)y << 16) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-    s = (((((int32_t)x) >> 16) - (((int32_t)y) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned subtraction with halved results.
-  \details This function enables you to perform two unsigned 16-bit integer subtractions, halving the results.
-  \param [in]    x   first two 16-bit summands.
-  \param [in]    y   second two 16-bit summands.
-  \return        the halved subtraction of the low halfwords, in the low halfword of the return value.\n
-                 the halved subtraction of the high halfwords, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  - val2[15:0]) >> 1        \n
-                 res[31:16] = (val1[31:16] - val2[31:16]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHSUB16(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((x << 16) >> 16) - ((y << 16) >> 16)) >> 1) & 0x0000FFFF;
-    s = ((((x) >> 16) - ((y) >> 16)) >> 1) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Quad 8-bit signed addition with halved results.
-  \details This function enables you to perform four signed 8-bit integer subtractions, halving the results.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the halved subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the halved subtraction of the second bytes from each operand, in the second byte of the return value.\n
-                 the halved subtraction of the third bytes from each operand, in the third byte of the return value.\n
-                 the halved subtraction of the fourth bytes from each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = (val1[7:0]   - val2[7:0]  ) >> 1    \n
-                 res[15:8]  = (val1[15:8]  - val2[15:8] ) >> 1    \n
-                 res[23:16] = (val1[23:16] - val2[23:16]) >> 1    \n
-                 res[31:24] = (val1[31:24] - val2[31:24]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHSUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = (((((int32_t)x << 24) >> 24) - (((int32_t)y << 24) >> 24)) >> 1) & (int32_t)0x000000FF;
-    s = (((((int32_t)x << 16) >> 24) - (((int32_t)y << 16) >> 24)) >> 1) & (int32_t)0x000000FF;
-    t = (((((int32_t)x <<  8) >> 24) - (((int32_t)y <<  8) >> 24)) >> 1) & (int32_t)0x000000FF;
-    u = (((((int32_t)x) >> 24) - (((int32_t)y) >> 24)) >> 1) & (int32_t)0x000000FF;
-
-    return ((uint32_t)((u << 24) | (t << 16) | (s <<  8) | (r)));
-}
-
-/**
-  \brief   Quad 8-bit unsigned subtraction with halved results.
-  \details This function enables you to perform four unsigned 8-bit integer subtractions, halving the results.
-  \param [in]    x   first four 8-bit summands.
-  \param [in]    y   second four 8-bit summands.
-  \return        the halved subtraction of the first bytes from each operand, in the first byte of the return value.\n
-                 the halved subtraction of the second bytes from each operand, in the second byte of the return value.\n
-                 the halved subtraction of the third bytes from each operand, in the third byte of the return value.\n
-                 the halved subtraction of the fourth bytes from each operand, in the fourth byte of the return value.
-  \remark
-                 res[7:0]   = (val1[7:0]   - val2[7:0]  ) >> 1    \n
-                 res[15:8]  = (val1[15:8]  - val2[15:8] ) >> 1    \n
-                 res[23:16] = (val1[23:16] - val2[23:16]) >> 1    \n
-                 res[31:24] = (val1[31:24] - val2[31:24]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHSUB8(uint32_t x, uint32_t y)
-{
-    int32_t r, s, t, u;
-
-    r = ((((x << 24) >> 24) - ((y << 24) >> 24)) >> 1) & 0x000000FF;
-    s = ((((x << 16) >> 24) - ((y << 16) >> 24)) >> 1) & 0x000000FF;
-    t = ((((x <<  8) >> 24) - ((y <<  8) >> 24)) >> 1) & 0x000000FF;
-    u = ((((x) >> 24) - ((y) >> 24)) >> 1) & 0x000000FF;
-
-    return ((u << 24) | (t << 16) | (s <<  8) | (r));
-}
-
-/**
-  \brief   Dual 16-bit add and subtract with exchange.
-  \details This function enables you to exchange the halfwords of the one operand,
-           then add the high halfwords and subtract the low halfwords,
-           saturating the results to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \param [in]    x   first operand for the subtraction in the low halfword,
-                     and the first operand for the addition in the high halfword.
-  \param [in]    y   second operand for the subtraction in the high halfword,
-                     and the second operand for the addition in the low halfword.
-  \return        the saturated subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the saturated addition of the high halfword in the first operand and the
-                 low halfword in the second operand, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[31:16]        \n
-                 res[31:16] = val1[31:16] + val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __SSAT(((((int32_t)x << 16) >> 16) - (((int32_t)y) >> 16)), 16) & (int32_t)0x0000FFFF;
-    s = __SSAT(((((int32_t)x) >> 16) + (((int32_t)y << 16) >> 16)), 16) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned saturating addition and subtraction with exchange.
-  \details This function enables you to exchange the halfwords of the second operand and
-           perform one unsigned 16-bit integer addition and one unsigned 16-bit subtraction,
-           saturating the results to the 16-bit unsigned integer range 0 <= x <= 2^16 - 1.
-  \param [in]    x   first operand for the subtraction in the low halfword,
-                     and the first operand for the addition in the high halfword.
-  \param [in]    y   second operand for the subtraction in the high halfword,
-                     and the second operand for the addition in the low halfword.
-  \return        the saturated subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the saturated addition of the high halfword in the first operand and the
-                 low halfword in the second operand, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit unsigned integer range 0 <= x <= 2^16 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[31:16]        \n
-                 res[31:16] = val1[31:16] + val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __IUSAT((((x << 16) >> 16) - ((y) >> 16)), 16) & 0x0000FFFF;
-    s = __IUSAT((((x) >> 16) + ((y << 16) >> 16)), 16) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit addition and subtraction with exchange.
-  \details It enables you to exchange the halfwords of the second operand, add the high halfwords
-           and subtract the low halfwords.
-  \param [in]    x   first operand for the subtraction in the low halfword,
-                     and the first operand for the addition in the high halfword.
-  \param [in]    y   second operand for the subtraction in the high halfword,
-                     and the second operand for the addition in the low halfword.
-  \return        the subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the addition of the high halfword in the first operand and the
-                 low halfword in the second operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[31:16]        \n
-                 res[31:16] = val1[31:16] + val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((int32_t)x << 16) >> 16) - (((int32_t)y) >> 16)) & (int32_t)0x0000FFFF;
-    s = ((((int32_t)x) >> 16) + (((int32_t)y << 16) >> 16)) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned addition and subtraction with exchange.
-  \details This function enables you to exchange the two halfwords of the second operand,
-           add the high halfwords and subtract the low halfwords.
-  \param [in]    x   first operand for the subtraction in the low halfword,
-                     and the first operand for the addition in the high halfword.
-  \param [in]    y   second operand for the subtraction in the high halfword,
-                     and the second operand for the addition in the low halfword.
-  \return        the subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the addition of the high halfword in the first operand and the
-                 low halfword in the second operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = val1[15:0]  - val2[31:16]        \n
-                 res[31:16] = val1[31:16] + val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((x << 16) >> 16) - ((y) >> 16)) & 0x0000FFFF;
-    s = (((x) >> 16) + ((y << 16) >> 16)) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed addition and subtraction with halved results.
-  \details This function enables you to exchange the two halfwords of one operand, perform one
-           signed 16-bit integer addition and one signed 16-bit subtraction, and halve the results.
-  \param [in]    x   first 16-bit operands.
-  \param [in]    y   second 16-bit operands.
-  \return        the halved subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the halved addition of the low halfword in the second operand from the high
-                 halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  - val2[31:16]) >> 1        \n
-                 res[31:16] = (val1[31:16] + val2[15:0]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((((int32_t)x << 16) >> 16) - (((int32_t)y) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-    s = (((((int32_t)x) >> 16) + (((int32_t)y << 16) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned addition and subtraction with halved results and exchange.
-  \details This function enables you to exchange the halfwords of the second operand,
-           add the high halfwords and subtract the low halfwords, halving the results.
-  \param [in]    x   first operand for the subtraction in the low halfword, and
-                     the first operand for the addition in the high halfword.
-  \param [in]    y   second operand for the subtraction in the high halfword, and
-                     the second operand for the addition in the low halfword.
-  \return        the halved subtraction of the high halfword in the second operand from the
-                 low halfword in the first operand, in the low halfword of the return value.\n
-                 the halved addition of the low halfword in the second operand from the high
-                 halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  - val2[31:16]) >> 1        \n
-                 res[31:16] = (val1[31:16] + val2[15:0]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHASX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((x << 16) >> 16) - ((y) >> 16)) >> 1) & 0x0000FFFF;
-    s = ((((x) >> 16) + ((y << 16) >> 16)) >> 1) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit subtract and add with exchange.
-  \details This function enables you to exchange the halfwords of one operand,
-           then subtract the high halfwords and add the low halfwords,
-           saturating the results to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \param [in]    x   first operand for the addition in the low halfword,
-                     and the first operand for the subtraction in the high halfword.
-  \param [in]    y   second operand for the addition in the high halfword,
-                     and the second operand for the subtraction in the low halfword.
-  \return        the saturated addition of the low halfword of the first operand and the high
-                 halfword of the second operand, in the low halfword of the return value.\n
-                 the saturated subtraction of the low halfword of the second operand from the
-                 high halfword of the first operand, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit signed integer range -2^15 <= x <= 2^15 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[31:16]        \n
-                 res[31:16] = val1[31:16] - val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __QSAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __SSAT(((((int32_t)x << 16) >> 16) + (((int32_t)y) >> 16)), 16) & (int32_t)0x0000FFFF;
-    s = __SSAT(((((int32_t)x) >> 16) - (((int32_t)y << 16) >> 16)), 16) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned saturating subtraction and addition with exchange.
-  \details This function enables you to exchange the halfwords of the second operand and perform
-           one unsigned 16-bit integer subtraction and one unsigned 16-bit addition, saturating
-           the results to the 16-bit unsigned integer range 0 <= x <= 2^16 - 1.
-  \param [in]    x   first operand for the addition in the low halfword,
-                     and the first operand for the subtraction in the high halfword.
-  \param [in]    y   second operand for the addition in the high halfword,
-                     and the second operand for the subtraction in the low halfword.
-  \return        the saturated addition of the low halfword of the first operand and the high
-                 halfword of the second operand, in the low halfword of the return value.\n
-                 the saturated subtraction of the low halfword of the second operand from the
-                 high halfword of the first operand, in the high halfword of the return value.\n
-                 The returned results are saturated to the 16-bit unsigned integer range 0 <= x <= 2^16 - 1.
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[31:16]        \n
-                 res[31:16] = val1[31:16] - val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UQSAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = __IUSAT((((x << 16) >> 16) + ((y) >> 16)), 16) & 0x0000FFFF;
-    s = __IUSAT((((x) >> 16) - ((y << 16) >> 16)), 16) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit unsigned subtract and add with exchange.
-  \details This function enables you to exchange the halfwords of the second operand,
-           subtract the high halfwords and add the low halfwords.
-  \param [in]    x   first operand for the addition in the low halfword,
-                     and the first operand for the subtraction in the high halfword.
-  \param [in]    y   second operand for the addition in the high halfword,
-                     and the second operand for the subtraction in the low halfword.
-  \return        the addition of the low halfword of the first operand and the high
-                 halfword of the second operand, in the low halfword of the return value.\n
-                 the subtraction of the low halfword of the second operand from the
-                 high halfword of the first operand, in the high halfword of the return value.\n
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[31:16]        \n
-                 res[31:16] = val1[31:16] - val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __USAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((x << 16) >> 16) + ((y) >> 16)) & 0x0000FFFF;
-    s = (((x) >> 16) - ((y << 16) >> 16)) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed subtraction and addition with exchange.
-  \details This function enables you to exchange the two halfwords of one operand and perform one
-           16-bit integer subtraction and one 16-bit addition.
-  \param [in]    x   first operand for the addition in the low halfword, and the first operand
-                     for the subtraction in the high halfword.
-  \param [in]    y   second operand for the addition in the high halfword, and the second
-                     operand for the subtraction in the low halfword.
-  \return        the addition of the low halfword of the first operand and the high
-                 halfword of the second operand, in the low halfword of the return value.\n
-                 the subtraction of the low halfword of the second operand from the
-                 high halfword of the first operand, in the high halfword of the return value.\n
-  \remark
-                 res[15:0]  = val1[15:0]  + val2[31:16]        \n
-                 res[31:16] = val1[31:16] - val2[15:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SSAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((int32_t)x << 16) >> 16) + (((int32_t)y) >> 16)) & (int32_t)0x0000FFFF;
-    s = ((((int32_t)x) >> 16) - (((int32_t)y << 16) >> 16)) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-
-/**
-  \brief   Dual 16-bit signed subtraction and addition with halved results.
-  \details This function enables you to exchange the two halfwords of one operand, perform one signed
-           16-bit integer subtraction and one signed 16-bit addition, and halve the results.
-  \param [in]    x   first 16-bit operands.
-  \param [in]    y   second 16-bit operands.
-  \return        the halved addition of the low halfword in the first operand and the
-                 high halfword in the second operand, in the low halfword of the return value.\n
-                 the halved subtraction of the low halfword in the second operand from the
-                 high halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  + val2[31:16]) >> 1        \n
-                 res[31:16] = (val1[31:16] - val2[15:0]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __SHSAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = (((((int32_t)x << 16) >> 16) + (((int32_t)y) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-    s = (((((int32_t)x) >> 16) - (((int32_t)y << 16) >> 16)) >> 1) & (int32_t)0x0000FFFF;
-
-    return ((uint32_t)((s << 16) | (r)));
-}
-
-/**
-  \brief   Dual 16-bit unsigned subtraction and addition with halved results and exchange.
-  \details This function enables you to exchange the halfwords of the second operand,
-           subtract the high halfwords and add the low halfwords, halving the results.
-  \param [in]    x   first operand for the addition in the low halfword, and
-                     the first operand for the subtraction in the high halfword.
-  \param [in]    y   second operand for the addition in the high halfword, and
-                     the second operand for the subtraction in the low halfword.
-  \return        the halved addition of the low halfword in the first operand and the
-                 high halfword in the second operand, in the low halfword of the return value.\n
-                 the halved subtraction of the low halfword in the second operand from the
-                 high halfword in the first operand, in the high halfword of the return value.
-  \remark
-                 res[15:0]  = (val1[15:0]  + val2[31:16]) >> 1        \n
-                 res[31:16] = (val1[31:16] - val2[15:0]) >> 1
- */
-__ALWAYS_STATIC_INLINE uint32_t __UHSAX(uint32_t x, uint32_t y)
-{
-    int32_t r, s;
-
-    r = ((((x << 16) >> 16) + ((y) >> 16)) >> 1) & 0x0000FFFF;
-    s = ((((x) >> 16) - ((y << 16) >> 16)) >> 1) & 0x0000FFFF;
-
-    return ((s << 16) | (r));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with exchange returning difference.
-  \details This function enables you to perform two 16-bit signed multiplications, subtracting
-           one of the products from the other. The halfwords of the second operand are exchanged
-           before performing the arithmetic. This produces top * bottom and bottom * top multiplication.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \return        the difference of the products of the two 16-bit signed multiplications.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]       \n
-                 p2 = val1[31:16] * val2[15:0]        \n
-                 res[31:0] = p1 - p2
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMUSDX(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16))));
-}
-
-/**
-  \brief   Sum of dual 16-bit signed multiply with exchange.
-  \details This function enables you to perform two 16-bit signed multiplications with exchanged
-           halfwords of the second operand, adding the products together.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \return        the sum of the products of the two 16-bit signed multiplications with exchanged halfwords of the second operand.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]       \n
-                 p2 = val1[31:16] * val2[15:0]        \n
-                 res[31:0] = p1 + p2
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMUADX(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16))));
-}
-
-
-/**
-  \brief   Saturating add.
-  \details This function enables you to obtain the saturating add of two integers.
-  \param [in]    x   first summand of the saturating add operation.
-  \param [in]    y   second summand of the saturating add operation.
-  \return        the saturating addition of val1 and val2.
-  \remark
-                 res[31:0] = SAT(val1 + SAT(val2))
- */
-__ALWAYS_STATIC_INLINE int32_t __QADD(int32_t x, int32_t y)
-{
-    int32_t result;
-
-    if (y >= 0) {
-        if ((int32_t)((uint32_t)x + (uint32_t)y) >= x) {
-            result = x + y;
-        } else {
-            result = 0x7FFFFFFF;
-        }
-    } else {
-        if ((int32_t)((uint32_t)x + (uint32_t)y) < x) {
-            result = x + y;
-        } else {
-            result = 0x80000000;
-        }
-    }
-
-    return result;
-}
-
-/**
-  \brief   Saturating subtract.
-  \details This function enables you to obtain the saturating add of two integers.
-  \param [in]    x   first summand of the saturating add operation.
-  \param [in]    y   second summand of the saturating add operation.
-  \return        the saturating addition of val1 and val2.
-  \remark
-                 res[31:0] = SAT(val1 - SAT(val2))
- */
-__ALWAYS_STATIC_INLINE int32_t __QSUB(int32_t x, int32_t y)
-{
-    int64_t tmp;
-    int32_t result;
-
-    tmp = (int64_t)x - (int64_t)y;
-
-    if (tmp > 0x7fffffff) {
-        tmp = 0x7fffffff;
-    } else if (tmp < (-2147483647 - 1)) {
-        tmp = -2147483647 - 1;
-    }
-
-    result = tmp;
-    return result;
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with single 32-bit accumulator.
-  \details This function enables you to perform two signed 16-bit multiplications,
-           adding both results to a 32-bit accumulate operand.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the product of each multiplication added to the accumulate value, as a 32-bit integer.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]      \n
-                 p2 = val1[31:16] * val2[31:16]     \n
-                 res[31:0] = p1 + p2 + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMLAD(uint32_t x, uint32_t y, uint32_t sum)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16)) +
-                       (((int32_t)sum))));
-}
-
-/**
-  \brief   Pre-exchanged dual 16-bit signed multiply with single 32-bit accumulator.
-  \details This function enables you to perform two signed 16-bit multiplications with exchanged
-           halfwords of the second operand, adding both results to a 32-bit accumulate operand.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the product of each multiplication with exchanged halfwords of the second
-                 operand added to the accumulate value, as a 32-bit integer.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]     \n
-                 p2 = val1[31:16] * val2[15:0]      \n
-                 res[31:0] = p1 + p2 + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMLADX(uint32_t x, uint32_t y, uint32_t sum)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       (((int32_t)sum))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with exchange subtract with 32-bit accumulate.
-  \details This function enables you to perform two 16-bit signed multiplications, take the
-           difference of the products, subtracting the high halfword product from the low
-           halfword product, and add the difference to a 32-bit accumulate operand.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the difference of the product of each multiplication, added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]       \n
-                 p2 = val1[31:16] * val2[31:16]      \n
-                 res[31:0] = p1 - p2 + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMLSD(uint32_t x, uint32_t y, uint32_t sum)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16)) +
-                       (((int32_t)sum))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with exchange subtract with 32-bit accumulate.
-  \details This function enables you to exchange the halfwords in the second operand, then perform two 16-bit
-           signed multiplications. The difference of the products is added to a 32-bit accumulate operand.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the difference of the product of each multiplication, added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]     \n
-                 p2 = val1[31:16] * val2[15:0]      \n
-                 res[31:0] = p1 - p2 + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMLSDX(uint32_t x, uint32_t y, uint32_t sum)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       (((int32_t)sum))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with single 64-bit accumulator.
-  \details This function enables you to perform two signed 16-bit multiplications, adding both results
-           to a 64-bit accumulate operand. Overflow is only possible as a result of the 64-bit addition.
-           This overflow is not detected if it occurs. Instead, the result wraps around modulo2^64.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the product of each multiplication added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]      \n
-                 p2 = val1[31:16] * val2[31:16]     \n
-                 sum = p1 + p2 + val3[63:32][31:0]  \n
-                 res[63:32] = sum[63:32]            \n
-                 res[31:0]  = sum[31:0]
- */
-__ALWAYS_STATIC_INLINE uint64_t __SMLALD(uint32_t x, uint32_t y, uint64_t sum)
-{
-    return ((uint64_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16)) +
-                       (((uint64_t)sum))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with exchange with single 64-bit accumulator.
-  \details This function enables you to exchange the halfwords of the second operand, and perform two
-           signed 16-bit multiplications, adding both results to a 64-bit accumulate operand. Overflow
-           is only possible as a result of the 64-bit addition. This overflow is not detected if it occurs.
-           Instead, the result wraps around modulo2^64.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the product of each multiplication added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]     \n
-                 p2 = val1[31:16] * val2[15:0]      \n
-                 sum = p1 + p2 + val3[63:32][31:0]  \n
-                 res[63:32] = sum[63:32]            \n
-                 res[31:0]  = sum[31:0]
- */
-__ALWAYS_STATIC_INLINE uint64_t __SMLALDX(uint32_t x, uint32_t y, uint64_t sum)
-{
-    return ((uint64_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       (((uint64_t)sum))));
-}
-
-/**
-  \brief   dual 16-bit signed multiply subtract with 64-bit accumulate.
-  \details This function It enables you to perform two 16-bit signed multiplications, take the difference
-           of the products, subtracting the high halfword product from the low halfword product, and add the
-           difference to a 64-bit accumulate operand. Overflow cannot occur during the multiplications or the
-           subtraction. Overflow can occur as a result of the 64-bit addition, and this overflow is not
-           detected. Instead, the result wraps round to modulo2^64.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the difference of the product of each multiplication, added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]      \n
-                 p2 = val1[31:16] * val2[31:16]     \n
-                 res[63:32][31:0] = p1 - p2 + val3[63:32][31:0]
- */
-__ALWAYS_STATIC_INLINE uint64_t __SMLSLD(uint32_t x, uint32_t y, uint64_t sum)
-{
-    return ((uint64_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16)) +
-                       (((uint64_t)sum))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply with exchange subtract with 64-bit accumulate.
-  \details This function enables you to exchange the halfwords of the second operand, perform two 16-bit multiplications,
-           adding the difference of the products to a 64-bit accumulate operand. Overflow cannot occur during the
-           multiplications or the subtraction. Overflow can occur as a result of the 64-bit addition, and this overflow
-           is not detected. Instead, the result wraps round to modulo2^64.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the difference of the product of each multiplication, added to the accumulate value.
-  \remark
-                 p1 = val1[15:0]  * val2[31:16]      \n
-                 p2 = val1[31:16] * val2[15:0]       \n
-                 res[63:32][31:0] = p1 - p2 + val3[63:32][31:0]
- */
-__ALWAYS_STATIC_INLINE uint64_t __SMLSLDX(uint32_t x, uint32_t y, uint64_t sum)
-{
-    return ((uint64_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       (((uint64_t)sum))));
-}
-
-/**
-  \brief   32-bit signed multiply with 32-bit truncated accumulator.
-  \details This function enables you to perform a signed 32-bit multiplications, adding the most
-           significant 32 bits of the 64-bit result to a 32-bit accumulate operand.
-  \param [in]    x   first operand for multiplication.
-  \param [in]    y   second operand for multiplication.
-  \param [in]  sum   accumulate value.
-  \return        the product of multiplication (most significant 32 bits) is added to the accumulate value, as a 32-bit integer.
-  \remark
-                 p = val1 * val2      \n
-                 res[31:0] = p[63:32] + val3[31:0]
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMMLA(int32_t x, int32_t y, int32_t sum)
-{
-    return (uint32_t)((int32_t)((int64_t)((int64_t)x * (int64_t)y) >> 32) + sum);
-}
-
-/**
-  \brief   Sum of dual 16-bit signed multiply.
-  \details This function enables you to perform two 16-bit signed multiplications, adding the products together.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \return        the sum of the products of the two 16-bit signed multiplications.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]      \n
-                 p2 = val1[31:16] * val2[31:16]     \n
-                 res[31:0] = p1 + p2
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMUAD(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) +
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16))));
-}
-
-/**
-  \brief   Dual 16-bit signed multiply returning difference.
-  \details This function enables you to perform two 16-bit signed multiplications, taking the difference
-           of the products by subtracting the high halfword product from the low halfword product.
-  \param [in]    x   first 16-bit operands for each multiplication.
-  \param [in]    y   second 16-bit operands for each multiplication.
-  \return        the difference of the products of the two 16-bit signed multiplications.
-  \remark
-                 p1 = val1[15:0]  * val2[15:0]      \n
-                 p2 = val1[31:16] * val2[31:16]     \n
-                 res[31:0] = p1 - p2
- */
-__ALWAYS_STATIC_INLINE uint32_t __SMUSD(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)(((((int32_t)x << 16) >> 16) * (((int32_t)y << 16) >> 16)) -
-                       ((((int32_t)x) >> 16) * (((int32_t)y) >> 16))));
-}
-
-/**
-  \brief   Dual extracted 8-bit to 16-bit signed addition.
-  \details This function enables you to extract two 8-bit values from the second operand (at bit positions
-           [7:0] and [23:16]), sign-extend them to 16-bits each, and add the results to the first operand.
-  \param [in]    x   values added to the sign-extended to 16-bit values.
-  \param [in]    y   two 8-bit values to be extracted and sign-extended.
-  \return        the addition of val1 and val2, where the 8-bit values in val2[7:0] and
-                 val2[23:16] have been extracted and sign-extended prior to the addition.
-  \remark
-                 res[15:0]  = val1[15:0] + SignExtended(val2[7:0])      \n
-                 res[31:16] = val1[31:16] + SignExtended(val2[23:16])
- */
-__ALWAYS_STATIC_INLINE uint32_t __SXTAB16(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)((((((int32_t)y << 24) >> 24) + (((int32_t)x << 16) >> 16)) & (int32_t)0x0000FFFF) |
-                       (((((int32_t)y <<  8) >>  8)  + (((int32_t)x >> 16) << 16)) & (int32_t)0xFFFF0000)));
-}
-
-/**
-  \brief   Extracted 16-bit to 32-bit unsigned addition.
-  \details This function enables you to extract two 8-bit values from one operand, zero-extend
-           them to 16 bits each, and add the results to two 16-bit values from another operand.
-  \param [in]    x   values added to the zero-extended to 16-bit values.
-  \param [in]    y   two 8-bit values to be extracted and zero-extended.
-  \return        the addition of val1 and val2, where the 8-bit values in val2[7:0] and
-                 val2[23:16] have been extracted and zero-extended prior to the addition.
-  \remark
-                 res[15:0]  = ZeroExt(val2[7:0]   to 16 bits) + val1[15:0]      \n
-                 res[31:16] = ZeroExt(val2[31:16] to 16 bits) + val1[31:16]
- */
-__ALWAYS_STATIC_INLINE uint32_t __UXTAB16(uint32_t x, uint32_t y)
-{
-    return ((uint32_t)(((((y << 24) >> 24) + ((x << 16) >> 16)) & 0x0000FFFF) |
-                       ((((y <<  8) >>  8) + ((x >> 16) << 16)) & 0xFFFF0000)));
-}
-
-/**
-  \brief   Dual extract 8-bits and sign extend each to 16-bits.
-  \details This function enables you to extract two 8-bit values from an operand and sign-extend them to 16 bits each.
-  \param [in]    x   two 8-bit values in val[7:0] and val[23:16] to be sign-extended.
-  \return        the 8-bit values sign-extended to 16-bit values.\n
-                 sign-extended value of val[7:0] in the low halfword of the return value.\n
-                 sign-extended value of val[23:16] in the high halfword of the return value.
-  \remark
-                 res[15:0]  = SignExtended(val[7:0])       \n
-                 res[31:16] = SignExtended(val[23:16])
- */
-__ALWAYS_STATIC_INLINE uint32_t __SXTB16(uint32_t x)
-{
-    return ((uint32_t)(((((int32_t)x << 24) >> 24) & (int32_t)0x0000FFFF) |
-                       ((((int32_t)x <<  8) >>  8) & (int32_t)0xFFFF0000)));
-}
-
-/**
-  \brief   Dual extract 8-bits and zero-extend to 16-bits.
-  \details This function enables you to extract two 8-bit values from an operand and zero-extend them to 16 bits each.
-  \param [in]    x   two 8-bit values in val[7:0] and val[23:16] to be zero-extended.
-  \return        the 8-bit values sign-extended to 16-bit values.\n
-                 sign-extended value of val[7:0] in the low halfword of the return value.\n
-                 sign-extended value of val[23:16] in the high halfword of the return value.
-  \remark
-                 res[15:0]  = SignExtended(val[7:0])       \n
-                 res[31:16] = SignExtended(val[23:16])
- */
-__ALWAYS_STATIC_INLINE uint32_t __UXTB16(uint32_t x)
-{
-    return ((uint32_t)((((x << 24) >> 24) & 0x0000FFFF) |
-                       (((x <<  8) >>  8) & 0xFFFF0000)));
-}
-
-#endif /* _CSI_RV32_GCC_H_ */