plat: Add Kendryte k210 initial support
authorDamien Le Moal <damien.lemoal@wdc.com>
Thu, 20 Dec 2018 05:40:41 +0000 (14:40 +0900)
committerDamien Le Moal <damien.lemoal@wdc.com>
Thu, 20 Dec 2018 05:43:04 +0000 (14:43 +0900)
Only compiles for now, completely untested.

Signed-off-by: Damien Le Moal <damien.lemoal@wdc.com>
plat/kendryte/k210/config.mk [new file with mode: 0644]
plat/kendryte/k210/objects.mk [new file with mode: 0644]
plat/kendryte/k210/platform.c [new file with mode: 0644]
plat/kendryte/k210/platform.h [new file with mode: 0644]
plat/kendryte/k210/sysctl.c [new file with mode: 0644]
plat/kendryte/k210/sysctl.h [new file with mode: 0644]
plat/kendryte/k210/uarths.c [new file with mode: 0644]
plat/kendryte/k210/uarths.h [new file with mode: 0644]

diff --git a/plat/kendryte/k210/config.mk b/plat/kendryte/k210/config.mk
new file mode 100644 (file)
index 0000000..8059b29
--- /dev/null
@@ -0,0 +1,33 @@
+#
+# Copyright (c) 2018 Western Digital Corporation or its affiliates.
+#
+# Authors:
+#   Anup Patel <anup.patel@wdc.com>
+#
+# SPDX-License-Identifier: BSD-2-Clause
+#
+
+# Essential defines required by SBI platform
+plat-cppflags-y = -DPLAT_NAME="Kendryte K210"
+plat-cppflags-y+= -DPLAT_HART_COUNT=2
+plat-cppflags-y+= -DPLAT_HART_STACK_SIZE=8192
+plat-cppflags-y+= -DPLAT_TEXT_START=0x80000000
+
+# Compiler flags
+plat-cflags-y =-mabi=lp64 -march=rv64imafdc -mcmodel=medany
+plat-asflags-y =-mabi=lp64 -march=rv64imafdc -mcmodel=medany
+plat-ldflags-y =
+
+# Common drivers to enable
+PLAT_IRQCHIP_PLIC=y
+PLAT_SYS_CLINT=y
+
+# Blobs to build
+FW_TEXT_START=0x80000000
+FW_JUMP=n
+#FW_JUMP_ADDR=0x80200000
+#FW_JUMP_FDT_ADDR=0x82200000
+FW_PAYLOAD=n
+#FW_PAYLOAD_OFFSET=0x200000
+#FW_PAYLOAD_FDT_ADDR=0x82200000
+
diff --git a/plat/kendryte/k210/objects.mk b/plat/kendryte/k210/objects.mk
new file mode 100644 (file)
index 0000000..c2103f0
--- /dev/null
@@ -0,0 +1,10 @@
+#
+# Copyright (c) 2018 Western Digital Corporation or its affiliates.
+#
+# Authors:
+#   Anup Patel <anup.patel@wdc.com>
+#
+# SPDX-License-Identifier: BSD-2-Clause
+#
+
+plat-objs-y += uarths.o sysctl.o platform.o
diff --git a/plat/kendryte/k210/platform.c b/plat/kendryte/k210/platform.c
new file mode 100644 (file)
index 0000000..6f9297e
--- /dev/null
@@ -0,0 +1,128 @@
+/*
+ * Copyright (c) 2018 Western Digital Corporation or its affiliates.
+ *
+ * Authors:
+ *   Anup Patel <anup.patel@wdc.com>
+ *
+ * SPDX-License-Identifier: BSD-2-Clause
+ */
+
+#include <sbi/riscv_encoding.h>
+#include <sbi/sbi_const.h>
+#include <sbi/sbi_platform.h>
+#include <plat/irqchip/plic.h>
+#include <plat/sys/clint.h>
+#include "platform.h"
+#include "uarths.h"
+
+#define K210_U_SYS_CLK                 1000000000
+#define K210_U_PERIPH_CLK              (K210_U_SYS_CLK / 2)
+
+#define K210_U_PLIC_NUM_SOURCES                0x35
+#define K210_U_PLIC_NUM_PRIORITIES     7
+
+static int k210_console_init(void)
+{
+       uarths_init(115200, UARTHS_STOP_1);
+
+       return 0;
+}
+
+static void k210_console_putc(char c)
+{
+       uarths_putc(c);
+}
+
+static char k210_console_getc(void)
+{
+       return uarths_getc();
+}
+
+static u32 k210_pmp_region_count(u32 target_hart)
+{
+       return 1;
+}
+
+static int k210_pmp_region_info(u32 target_hart, u32 index,
+                                 ulong *prot, ulong *addr, ulong *log2size)
+{
+       int ret = 0;
+
+       switch (index) {
+       case 0:
+               *prot = PMP_R | PMP_W | PMP_X;
+               *addr = 0;
+               *log2size = __riscv_xlen;
+               break;
+       default:
+               ret = -1;
+               break;
+       };
+
+       return ret;
+}
+
+static int k210_cold_irqchip_init(void)
+{
+       return plic_cold_irqchip_init(PLIC_BASE_ADDR,
+                                     K210_U_PLIC_NUM_SOURCES,
+                                     PLAT_HART_COUNT);
+}
+
+static int k210_cold_ipi_init(void)
+{
+       return clint_cold_ipi_init(CLINT_BASE_ADDR,
+                                  PLAT_HART_COUNT);
+}
+
+static int k210_cold_timer_init(void)
+{
+       return clint_cold_timer_init(CLINT_BASE_ADDR,
+                                    PLAT_HART_COUNT);
+}
+
+static int k210_cold_final_init(void)
+{
+       return plic_fdt_fixup(sbi_scratch_thishart_arg1_ptr(), "riscv,plic0");
+}
+
+static int k210_system_down(u32 type)
+{
+       /* For now nothing to do. */
+       return 0;
+}
+
+struct sbi_platform platform = {
+
+       .name = STRINGIFY(PLAT_NAME),
+       .features = SBI_PLATFORM_HAS_MMIO_TIMER_VALUE,
+
+       .hart_count = PLAT_HART_COUNT,
+       .hart_stack_size = PLAT_HART_STACK_SIZE,
+
+       .pmp_region_count = k210_pmp_region_count,
+       .pmp_region_info = k210_pmp_region_info,
+
+
+       .console_init = k210_console_init,
+       .console_putc = k210_console_putc,
+       .console_getc = k210_console_getc,
+
+       .cold_irqchip_init = k210_cold_irqchip_init,
+       .warm_irqchip_init = plic_warm_irqchip_init,
+       .ipi_inject = clint_ipi_inject,
+       .ipi_sync = clint_ipi_sync,
+       .ipi_clear = clint_ipi_clear,
+       .warm_ipi_init = clint_warm_ipi_init,
+       .cold_ipi_init = k210_cold_ipi_init,
+       .cold_final_init = k210_cold_final_init,
+
+       .timer_value = clint_timer_value,
+       .timer_event_stop = clint_timer_event_stop,
+       .timer_event_start = clint_timer_event_start,
+       .warm_timer_init = clint_warm_timer_init,
+       .cold_timer_init = k210_cold_timer_init,
+
+       .system_reboot = k210_system_down,
+       .system_shutdown = k210_system_down
+};
diff --git a/plat/kendryte/k210/platform.h b/plat/kendryte/k210/platform.h
new file mode 100644 (file)
index 0000000..4aa15d7
--- /dev/null
@@ -0,0 +1,1448 @@
+/* Copyright 2018 Canaan Inc.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#ifndef _PLATFORM_H_
+#define _PLATFORM_H_
+
+/* Register base address */
+
+/* Under Coreplex */
+#define CLINT_BASE_ADDR     (0x02000000U)
+#define PLIC_BASE_ADDR      (0x0C000000U)
+
+/* Under TileLink */
+#define UARTHS_BASE_ADDR    (0x38000000U)
+#define GPIOHS_BASE_ADDR    (0x38001000U)
+
+/* Under AXI 64 bit */
+#define RAM_BASE_ADDR       (0x80000000U)
+#define RAM_SIZE            (6 * 1024 * 1024U)
+
+#define IO_BASE_ADDR        (0x40000000U)
+#define IO_SIZE             (6 * 1024 * 1024U)
+
+#define AI_RAM_BASE_ADDR    (0x80600000U)
+#define AI_RAM_SIZE         (2 * 1024 * 1024U)
+
+#define AI_IO_BASE_ADDR     (0x40600000U)
+#define AI_IO_SIZE          (2 * 1024 * 1024U)
+
+#define AI_BASE_ADDR        (0x40800000U)
+#define AI_SIZE             (12 * 1024 * 1024U)
+
+#define FFT_BASE_ADDR       (0x42000000U)
+#define FFT_SIZE            (4 * 1024 * 1024U)
+
+#define ROM_BASE_ADDR       (0x88000000U)
+#define ROM_SIZE            (128 * 1024U)
+
+/* Under AHB 32 bit */
+#define DMAC_BASE_ADDR      (0x50000000U)
+
+/* Under APB1 32 bit */
+#define GPIO_BASE_ADDR      (0x50200000U)
+#define UART1_BASE_ADDR     (0x50210000U)
+#define UART2_BASE_ADDR     (0x50220000U)
+#define UART3_BASE_ADDR     (0x50230000U)
+#define SPI_SLAVE_BASE_ADDR (0x50240000U)
+#define I2S0_BASE_ADDR      (0x50250000U)
+#define I2S1_BASE_ADDR      (0x50260000U)
+#define I2S2_BASE_ADDR      (0x50270000U)
+#define I2C0_BASE_ADDR      (0x50280000U)
+#define I2C1_BASE_ADDR      (0x50290000U)
+#define I2C2_BASE_ADDR      (0x502A0000U)
+#define FPIOA_BASE_ADDR     (0x502B0000U)
+#define SHA256_BASE_ADDR    (0x502C0000U)
+#define TIMER0_BASE_ADDR    (0x502D0000U)
+#define TIMER1_BASE_ADDR    (0x502E0000U)
+#define TIMER2_BASE_ADDR    (0x502F0000U)
+
+/* Under APB2 32 bit */
+#define WDT0_BASE_ADDR      (0x50400000U)
+#define WDT1_BASE_ADDR      (0x50410000U)
+#define OTP_BASE_ADDR       (0x50420000U)
+#define DVP_BASE_ADDR       (0x50430000U)
+#define SYSCTL_BASE_ADDR    (0x50440000U)
+#define AES_BASE_ADDR       (0x50450000U)
+#define RTC_BASE_ADDR       (0x50460000U)
+
+/* Under APB3 32 bit */
+#define SPI0_BASE_ADDR      (0x52000000U)
+#define SPI1_BASE_ADDR      (0x53000000U)
+#define SPI3_BASE_ADDR      (0x54000000U)
+
+#define read_csr(reg) ({ unsigned long __tmp; \
+  asm volatile ("csrr %0, " #reg : "=r"(__tmp)); \
+  __tmp; })
+
+#define write_csr(reg, val) ({ \
+  if (__builtin_constant_p(val) && (unsigned long)(val) < 32) \
+         asm volatile ("csrw " #reg ", %0" :: "i"(val));     \
+  else \
+         asm volatile ("csrw " #reg ", %0" :: "r"(val)); })
+
+#define swap_csr(reg, val) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(val) && (unsigned long)(val) < 32) \
+         asm volatile ("csrrw %0, " #reg ", %1" : "=r"(__tmp) : "i"(val)); \
+  else \
+         asm volatile ("csrrw %0, " #reg ", %1" : "=r"(__tmp) : "r"(val)); \
+  __tmp; })
+
+#define set_csr(reg, bit) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(bit) && (unsigned long)(bit) < 32) \
+         asm volatile ("csrrs %0, " #reg ", %1" : "=r"(__tmp) : "i"(bit)); \
+  else \
+         asm volatile ("csrrs %0, " #reg ", %1" : "=r"(__tmp) : "r"(bit)); \
+  __tmp; })
+
+#define clear_csr(reg, bit) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(bit) && (unsigned long)(bit) < 32) \
+         asm volatile ("csrrc %0, " #reg ", %1" : "=r"(__tmp) : "i"(bit)); \
+  else \
+         asm volatile ("csrrc %0, " #reg ", %1" : "=r"(__tmp) : "r"(bit)); \
+  __tmp; })
+
+#define read_time()            read_csr(mtime)
+#define read_cycle()           read_csr(mcycle)
+#define current_coreid()       read_csr(mhartid)
+
+#endif /* _PLATFORM_H_ */
+
+
+
+
+
+
+
+
+#if 0
+
+/* From Kendryte SDK encoding.h file */
+
+#ifndef RISCV_CSR_ENCODING_H
+#define RISCV_CSR_ENCODING_H
+
+#define MSTATUS_UIE         0x00000001U
+#define MSTATUS_SIE         0x00000002U
+#define MSTATUS_HIE         0x00000004U
+#define MSTATUS_MIE         0x00000008U
+#define MSTATUS_UPIE        0x00000010U
+#define MSTATUS_SPIE        0x00000020U
+#define MSTATUS_HPIE        0x00000040U
+#define MSTATUS_MPIE        0x00000080U
+#define MSTATUS_SPP         0x00000100U
+#define MSTATUS_HPP         0x00000600U
+#define MSTATUS_MPP         0x00001800U
+#define MSTATUS_FS          0x00006000U
+#define MSTATUS_XS          0x00018000U
+#define MSTATUS_MPRV        0x00020000U
+#define MSTATUS_PUM         0x00040000U
+#define MSTATUS_MXR         0x00080000U
+#define MSTATUS_VM          0x1F000000U
+#define MSTATUS32_SD        0x80000000U
+#define MSTATUS64_SD        0x8000000000000000U
+
+#define SSTATUS_UIE         0x00000001U
+#define SSTATUS_SIE         0x00000002U
+#define SSTATUS_UPIE        0x00000010U
+#define SSTATUS_SPIE        0x00000020U
+#define SSTATUS_SPP         0x00000100U
+#define SSTATUS_FS          0x00006000U
+#define SSTATUS_XS          0x00018000U
+#define SSTATUS_PUM         0x00040000U
+#define SSTATUS32_SD        0x80000000U
+#define SSTATUS64_SD        0x8000000000000000U
+
+#define DCSR_XDEBUGVER      (3U<<30)
+#define DCSR_NDRESET        (1U<<29)
+#define DCSR_FULLRESET      (1U<<28)
+#define DCSR_EBREAKM        (1U<<15)
+#define DCSR_EBREAKH        (1U<<14)
+#define DCSR_EBREAKS        (1U<<13)
+#define DCSR_EBREAKU        (1U<<12)
+#define DCSR_STOPCYCLE      (1U<<10)
+#define DCSR_STOPTIME       (1U<<9)
+#define DCSR_CAUSE          (7U<<6)
+#define DCSR_DEBUGINT       (1U<<5)
+#define DCSR_HALT           (1U<<3)
+#define DCSR_STEP           (1U<<2)
+#define DCSR_PRV            (3U<<0)
+
+#define DCSR_CAUSE_NONE     0
+#define DCSR_CAUSE_SWBP     1
+#define DCSR_CAUSE_HWBP     2
+#define DCSR_CAUSE_DEBUGINT 3
+#define DCSR_CAUSE_STEP     4
+#define DCSR_CAUSE_HALT     5
+
+#define MCONTROL_SELECT     (1U<<19)
+#define MCONTROL_TIMING     (1U<<18)
+#define MCONTROL_ACTION     (0x3fU<<12)
+#define MCONTROL_CHAIN      (1U<<11)
+#define MCONTROL_MATCH      (0xfU<<7)
+#define MCONTROL_M          (1U<<6)
+#define MCONTROL_H          (1U<<5)
+#define MCONTROL_S          (1U<<4)
+#define MCONTROL_U          (1U<<3)
+#define MCONTROL_EXECUTE    (1U<<2)
+#define MCONTROL_STORE      (1U<<1)
+#define MCONTROL_LOAD       (1U<<0)
+
+#define MCONTROL_TYPE_NONE      0
+#define MCONTROL_TYPE_MATCH     2
+
+#define MCONTROL_ACTION_DEBUG_EXCEPTION   0
+#define MCONTROL_ACTION_DEBUG_MODE        1
+#define MCONTROL_ACTION_TRACE_START       2
+#define MCONTROL_ACTION_TRACE_STOP        3
+#define MCONTROL_ACTION_TRACE_EMIT        4
+
+#define MCONTROL_MATCH_EQUAL     0
+#define MCONTROL_MATCH_NAPOT     1
+#define MCONTROL_MATCH_GE        2
+#define MCONTROL_MATCH_LT        3
+#define MCONTROL_MATCH_MASK_LOW  4
+#define MCONTROL_MATCH_MASK_HIGH 5
+
+#define MIP_SSIP            (1U << IRQ_S_SOFT)
+#define MIP_HSIP            (1U << IRQ_H_SOFT)
+#define MIP_MSIP            (1U << IRQ_M_SOFT)
+#define MIP_STIP            (1U << IRQ_S_TIMER)
+#define MIP_HTIP            (1U << IRQ_H_TIMER)
+#define MIP_MTIP            (1U << IRQ_M_TIMER)
+#define MIP_SEIP            (1U << IRQ_S_EXT)
+#define MIP_HEIP            (1U << IRQ_H_EXT)
+#define MIP_MEIP            (1U << IRQ_M_EXT)
+
+#define SIP_SSIP MIP_SSIP
+#define SIP_STIP MIP_STIP
+
+#define PRV_U 0
+#define PRV_S 1
+#define PRV_H 2
+#define PRV_M 3
+
+#define VM_MBARE 0
+#define VM_MBB   1
+#define VM_MBBID 2
+#define VM_SV32  8
+#define VM_SV39  9
+#define VM_SV48  10
+
+#define IRQ_S_SOFT   1
+#define IRQ_H_SOFT   2
+#define IRQ_M_SOFT   3
+#define IRQ_S_TIMER  5
+#define IRQ_H_TIMER  6
+#define IRQ_M_TIMER  7
+#define IRQ_S_EXT    9
+#define IRQ_H_EXT    10
+#define IRQ_M_EXT    11
+#define IRQ_COP      12
+#define IRQ_HOST     13
+
+#define DEFAULT_RSTVEC     0x00001000U
+#define DEFAULT_NMIVEC     0x00001004U
+#define DEFAULT_MTVEC      0x00001010U
+#define CONFIG_STRING_ADDR 0x0000100CU
+#define EXT_IO_BASE        0x40000000U
+#define DRAM_BASE          0x80000000U
+
+/* page table entry (PTE) fields */
+#define PTE_V     0x001U /* Valid */
+#define PTE_R     0x002U /* Read */
+#define PTE_W     0x004U /* Write */
+#define PTE_X     0x008U /* Execute */
+#define PTE_U     0x010U /* User */
+#define PTE_G     0x020U /* Global */
+#define PTE_A     0x040U /* Accessed */
+#define PTE_D     0x080U /* Dirty */
+#define PTE_SOFT  0x300U /* Reserved for Software */
+
+#define PTE_PPN_SHIFT 10
+
+#define MCONTROL_TYPE(xlen)    (0xfULL<<((xlen)-4))
+#define MCONTROL_DMODE(xlen)   (1ULL<<((xlen)-5))
+#define MCONTROL_MASKMAX(xlen) (0x3fULL<<((xlen)-11))
+
+#define PTE_TABLE(PTE) (((PTE) & (PTE_V | PTE_R | PTE_W | PTE_X)) == PTE_V)
+
+#if defined(__riscv)
+
+#if defined(__riscv64)
+# define MSTATUS_SD MSTATUS64_SD
+# define SSTATUS_SD SSTATUS64_SD
+# define RISCV_PGLEVEL_BITS 9
+#else
+# define MSTATUS_SD MSTATUS32_SD
+# define SSTATUS_SD SSTATUS32_SD
+# define RISCV_PGLEVEL_BITS 10
+#endif
+
+#define RISCV_PGSHIFT 12
+#define RISCV_PGSIZE (1 << RISCV_PGSHIFT)
+
+#ifndef __ASSEMBLER__
+
+#if defined(__GNUC__)
+
+#define read_csr(reg) ({ unsigned long __tmp; \
+  asm volatile ("csrr %0, " #reg : "=r"(__tmp)); \
+  __tmp; })
+
+#define write_csr(reg, val) ({ \
+  if (__builtin_constant_p(val) && (unsigned long)(val) < 32) \
+         asm volatile ("csrw " #reg ", %0" :: "i"(val));     \
+  else \
+         asm volatile ("csrw " #reg ", %0" :: "r"(val)); })
+
+#define swap_csr(reg, val) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(val) && (unsigned long)(val) < 32) \
+         asm volatile ("csrrw %0, " #reg ", %1" : "=r"(__tmp) : "i"(val)); \
+  else \
+         asm volatile ("csrrw %0, " #reg ", %1" : "=r"(__tmp) : "r"(val)); \
+  __tmp; })
+
+#define set_csr(reg, bit) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(bit) && (unsigned long)(bit) < 32) \
+         asm volatile ("csrrs %0, " #reg ", %1" : "=r"(__tmp) : "i"(bit)); \
+  else \
+         asm volatile ("csrrs %0, " #reg ", %1" : "=r"(__tmp) : "r"(bit)); \
+  __tmp; })
+
+#define clear_csr(reg, bit) ({ unsigned long __tmp; \
+  if (__builtin_constant_p(bit) && (unsigned long)(bit) < 32) \
+         asm volatile ("csrrc %0, " #reg ", %1" : "=r"(__tmp) : "i"(bit)); \
+  else \
+         asm volatile ("csrrc %0, " #reg ", %1" : "=r"(__tmp) : "r"(bit)); \
+  __tmp; })
+
+#define read_time()            read_csr(mtime)
+#define read_cycle()           read_csr(mcycle)
+#define current_coreid()       read_csr(mhartid)
+
+#endif
+
+#endif
+
+#endif
+
+#endif
+
+#ifndef RISCV_ENCODING_H
+#define RISCV_ENCODING_H
+#define MATCH_BEQ                  0x63U
+#define MASK_BEQ                   0x707fU
+#define MATCH_BNE                  0x1063U
+#define MASK_BNE                   0x707fU
+#define MATCH_BLT                  0x4063U
+#define MASK_BLT                   0x707fU
+#define MATCH_BGE                  0x5063U
+#define MASK_BGE                   0x707fU
+#define MATCH_BLTU                 0x6063U
+#define MASK_BLTU                  0x707fU
+#define MATCH_BGEU                 0x7063U
+#define MASK_BGEU                  0x707fU
+#define MATCH_JALR                 0x67U
+#define MASK_JALR                  0x707fU
+#define MATCH_JAL                  0x6fU
+#define MASK_JAL                   0x7fU
+#define MATCH_LUI                  0x37U
+#define MASK_LUI                   0x7fU
+#define MATCH_AUIPC                0x17U
+#define MASK_AUIPC                 0x7fU
+#define MATCH_ADDI                 0x13U
+#define MASK_ADDI                  0x707fU
+#define MATCH_SLLI                 0x1013U
+#define MASK_SLLI                  0xfc00707fU
+#define MATCH_SLTI                 0x2013U
+#define MASK_SLTI                  0x707fU
+#define MATCH_SLTIU                0x3013U
+#define MASK_SLTIU                 0x707fU
+#define MATCH_XORI                 0x4013U
+#define MASK_XORI                  0x707fU
+#define MATCH_SRLI                 0x5013U
+#define MASK_SRLI                  0xfc00707fU
+#define MATCH_SRAI                 0x40005013U
+#define MASK_SRAI                  0xfc00707fU
+#define MATCH_ORI                  0x6013U
+#define MASK_ORI                   0x707fU
+#define MATCH_ANDI                 0x7013U
+#define MASK_ANDI                  0x707fU
+#define MATCH_ADD                  0x33U
+#define MASK_ADD                   0xfe00707fU
+#define MATCH_SUB                  0x40000033U
+#define MASK_SUB                   0xfe00707fU
+#define MATCH_SLL                  0x1033U
+#define MASK_SLL                   0xfe00707fU
+#define MATCH_SLT                  0x2033U
+#define MASK_SLT                   0xfe00707fU
+#define MATCH_SLTU                 0x3033U
+#define MASK_SLTU                  0xfe00707fU
+#define MATCH_XOR                  0x4033U
+#define MASK_XOR                   0xfe00707fU
+#define MATCH_SRL                  0x5033U
+#define MASK_SRL                   0xfe00707fU
+#define MATCH_SRA                  0x40005033U
+#define MASK_SRA                   0xfe00707fU
+#define MATCH_OR                   0x6033U
+#define MASK_OR                    0xfe00707fU
+#define MATCH_AND                  0x7033U
+#define MASK_AND                   0xfe00707fU
+#define MATCH_ADDIW                0x1bU
+#define MASK_ADDIW                 0x707fU
+#define MATCH_SLLIW                0x101bU
+#define MASK_SLLIW                 0xfe00707fU
+#define MATCH_SRLIW                0x501bU
+#define MASK_SRLIW                 0xfe00707fU
+#define MATCH_SRAIW                0x4000501bU
+#define MASK_SRAIW                 0xfe00707fU
+#define MATCH_ADDW                 0x3bU
+#define MASK_ADDW                  0xfe00707fU
+#define MATCH_SUBW                 0x4000003bU
+#define MASK_SUBW                  0xfe00707fU
+#define MATCH_SLLW                 0x103bU
+#define MASK_SLLW                  0xfe00707fU
+#define MATCH_SRLW                 0x503bU
+#define MASK_SRLW                  0xfe00707fU
+#define MATCH_SRAW                 0x4000503bU
+#define MASK_SRAW                  0xfe00707fU
+#define MATCH_LB                   0x3U
+#define MASK_LB                    0x707fU
+#define MATCH_LH                   0x1003U
+#define MASK_LH                    0x707fU
+#define MATCH_LW                   0x2003U
+#define MASK_LW                    0x707fU
+#define MATCH_LD                   0x3003U
+#define MASK_LD                    0x707fU
+#define MATCH_LBU                  0x4003U
+#define MASK_LBU                   0x707fU
+#define MATCH_LHU                  0x5003U
+#define MASK_LHU                   0x707fU
+#define MATCH_LWU                  0x6003U
+#define MASK_LWU                   0x707fU
+#define MATCH_SB                   0x23U
+#define MASK_SB                    0x707fU
+#define MATCH_SH                   0x1023U
+#define MASK_SH                    0x707fU
+#define MATCH_SW                   0x2023U
+#define MASK_SW                    0x707fU
+#define MATCH_SD                   0x3023U
+#define MASK_SD                    0x707fU
+#define MATCH_FENCE                0xfU
+#define MASK_FENCE                 0x707fU
+#define MATCH_FENCE_I              0x100fU
+#define MASK_FENCE_I               0x707fU
+#define MATCH_MUL                  0x2000033U
+#define MASK_MUL                   0xfe00707fU
+#define MATCH_MULH                 0x2001033U
+#define MASK_MULH                  0xfe00707fU
+#define MATCH_MULHSU               0x2002033U
+#define MASK_MULHSU                0xfe00707fU
+#define MATCH_MULHU                0x2003033U
+#define MASK_MULHU                 0xfe00707fU
+#define MATCH_DIV                  0x2004033U
+#define MASK_DIV                   0xfe00707fU
+#define MATCH_DIVU                 0x2005033U
+#define MASK_DIVU                  0xfe00707fU
+#define MATCH_REM                  0x2006033U
+#define MASK_REM                   0xfe00707fU
+#define MATCH_REMU                 0x2007033U
+#define MASK_REMU                  0xfe00707fU
+#define MATCH_MULW                 0x200003bU
+#define MASK_MULW                  0xfe00707fU
+#define MATCH_DIVW                 0x200403bU
+#define MASK_DIVW                  0xfe00707fU
+#define MATCH_DIVUW                0x200503bU
+#define MASK_DIVUW                 0xfe00707fU
+#define MATCH_REMW                 0x200603bU
+#define MASK_REMW                  0xfe00707fU
+#define MATCH_REMUW                0x200703bU
+#define MASK_REMUW                 0xfe00707fU
+#define MATCH_AMOADD_W             0x202fU
+#define MASK_AMOADD_W              0xf800707fU
+#define MATCH_AMOXOR_W             0x2000202fU
+#define MASK_AMOXOR_W              0xf800707fU
+#define MATCH_AMOOR_W              0x4000202fU
+#define MASK_AMOOR_W               0xf800707fU
+#define MATCH_AMOAND_W             0x6000202fU
+#define MASK_AMOAND_W              0xf800707fU
+#define MATCH_AMOMIN_W             0x8000202fU
+#define MASK_AMOMIN_W              0xf800707fU
+#define MATCH_AMOMAX_W             0xa000202fU
+#define MASK_AMOMAX_W              0xf800707fU
+#define MATCH_AMOMINU_W            0xc000202fU
+#define MASK_AMOMINU_W             0xf800707fU
+#define MATCH_AMOMAXU_W            0xe000202fU
+#define MASK_AMOMAXU_W             0xf800707fU
+#define MATCH_AMOSWAP_W            0x800202fU
+#define MASK_AMOSWAP_W             0xf800707fU
+#define MATCH_LR_W                 0x1000202fU
+#define MASK_LR_W                  0xf9f0707fU
+#define MATCH_SC_W                 0x1800202fU
+#define MASK_SC_W                  0xf800707fU
+#define MATCH_AMOADD_D             0x302fU
+#define MASK_AMOADD_D              0xf800707fU
+#define MATCH_AMOXOR_D             0x2000302fU
+#define MASK_AMOXOR_D              0xf800707fU
+#define MATCH_AMOOR_D              0x4000302fU
+#define MASK_AMOOR_D               0xf800707fU
+#define MATCH_AMOAND_D             0x6000302fU
+#define MASK_AMOAND_D              0xf800707fU
+#define MATCH_AMOMIN_D             0x8000302fU
+#define MASK_AMOMIN_D              0xf800707fU
+#define MATCH_AMOMAX_D             0xa000302fU
+#define MASK_AMOMAX_D              0xf800707fU
+#define MATCH_AMOMINU_D            0xc000302fU
+#define MASK_AMOMINU_D             0xf800707fU
+#define MATCH_AMOMAXU_D            0xe000302fU
+#define MASK_AMOMAXU_D             0xf800707fU
+#define MATCH_AMOSWAP_D            0x800302fU
+#define MASK_AMOSWAP_D             0xf800707fU
+#define MATCH_LR_D                 0x1000302fU
+#define MASK_LR_D                  0xf9f0707fU
+#define MATCH_SC_D                 0x1800302fU
+#define MASK_SC_D                  0xf800707fU
+#define MATCH_ECALL                0x73U
+#define MASK_ECALL                 0xffffffffU
+#define MATCH_EBREAK               0x100073U
+#define MASK_EBREAK                0xffffffffU
+#define MATCH_URET                 0x200073U
+#define MASK_URET                  0xffffffffU
+#define MATCH_SRET                 0x10200073U
+#define MASK_SRET                  0xffffffffU
+#define MATCH_HRET                 0x20200073U
+#define MASK_HRET                  0xffffffffU
+#define MATCH_MRET                 0x30200073U
+#define MASK_MRET                  0xffffffffU
+#define MATCH_DRET                 0x7b200073U
+#define MASK_DRET                  0xffffffffU
+#define MATCH_SFENCE_VM            0x10400073U
+#define MASK_SFENCE_VM             0xfff07fffU
+#define MATCH_WFI                  0x10500073U
+#define MASK_WFI                   0xffffffffU
+#define MATCH_CSRRW                0x1073U
+#define MASK_CSRRW                 0x707fU
+#define MATCH_CSRRS                0x2073U
+#define MASK_CSRRS                 0x707fU
+#define MATCH_CSRRC                0x3073U
+#define MASK_CSRRC                 0x707fU
+#define MATCH_CSRRWI               0x5073U
+#define MASK_CSRRWI                0x707fU
+#define MATCH_CSRRSI               0x6073U
+#define MASK_CSRRSI                0x707fU
+#define MATCH_CSRRCI               0x7073U
+#define MASK_CSRRCI                0x707fU
+#define MATCH_FADD_S               0x53U
+#define MASK_FADD_S                0xfe00007fU
+#define MATCH_FSUB_S               0x8000053U
+#define MASK_FSUB_S                0xfe00007fU
+#define MATCH_FMUL_S               0x10000053U
+#define MASK_FMUL_S                0xfe00007fU
+#define MATCH_FDIV_S               0x18000053U
+#define MASK_FDIV_S                0xfe00007fU
+#define MATCH_FSGNJ_S              0x20000053U
+#define MASK_FSGNJ_S               0xfe00707fU
+#define MATCH_FSGNJN_S             0x20001053U
+#define MASK_FSGNJN_S              0xfe00707fU
+#define MATCH_FSGNJX_S             0x20002053U
+#define MASK_FSGNJX_S              0xfe00707fU
+#define MATCH_FMIN_S               0x28000053U
+#define MASK_FMIN_S                0xfe00707fU
+#define MATCH_FMAX_S               0x28001053U
+#define MASK_FMAX_S                0xfe00707fU
+#define MATCH_FSQRT_S              0x58000053U
+#define MASK_FSQRT_S               0xfff0007fU
+#define MATCH_FADD_D               0x2000053U
+#define MASK_FADD_D                0xfe00007fU
+#define MATCH_FSUB_D               0xa000053U
+#define MASK_FSUB_D                0xfe00007fU
+#define MATCH_FMUL_D               0x12000053U
+#define MASK_FMUL_D                0xfe00007fU
+#define MATCH_FDIV_D               0x1a000053U
+#define MASK_FDIV_D                0xfe00007fU
+#define MATCH_FSGNJ_D              0x22000053U
+#define MASK_FSGNJ_D               0xfe00707fU
+#define MATCH_FSGNJN_D             0x22001053U
+#define MASK_FSGNJN_D              0xfe00707fU
+#define MATCH_FSGNJX_D             0x22002053U
+#define MASK_FSGNJX_D              0xfe00707fU
+#define MATCH_FMIN_D               0x2a000053U
+#define MASK_FMIN_D                0xfe00707fU
+#define MATCH_FMAX_D               0x2a001053U
+#define MASK_FMAX_D                0xfe00707fU
+#define MATCH_FCVT_S_D             0x40100053U
+#define MASK_FCVT_S_D              0xfff0007fU
+#define MATCH_FCVT_D_S             0x42000053U
+#define MASK_FCVT_D_S              0xfff0007fU
+#define MATCH_FSQRT_D              0x5a000053U
+#define MASK_FSQRT_D               0xfff0007fU
+#define MATCH_FLE_S                0xa0000053U
+#define MASK_FLE_S                 0xfe00707fU
+#define MATCH_FLT_S                0xa0001053U
+#define MASK_FLT_S                 0xfe00707fU
+#define MATCH_FEQ_S                0xa0002053U
+#define MASK_FEQ_S                 0xfe00707fU
+#define MATCH_FLE_D                0xa2000053U
+#define MASK_FLE_D                 0xfe00707fU
+#define MATCH_FLT_D                0xa2001053U
+#define MASK_FLT_D                 0xfe00707fU
+#define MATCH_FEQ_D                0xa2002053U
+#define MASK_FEQ_D                 0xfe00707fU
+#define MATCH_FCVT_W_S             0xc0000053U
+#define MASK_FCVT_W_S              0xfff0007fU
+#define MATCH_FCVT_WU_S            0xc0100053U
+#define MASK_FCVT_WU_S             0xfff0007fU
+#define MATCH_FCVT_L_S             0xc0200053U
+#define MASK_FCVT_L_S              0xfff0007fU
+#define MATCH_FCVT_LU_S            0xc0300053U
+#define MASK_FCVT_LU_S             0xfff0007fU
+#define MATCH_FMV_X_S              0xe0000053U
+#define MASK_FMV_X_S               0xfff0707fU
+#define MATCH_FCLASS_S             0xe0001053U
+#define MASK_FCLASS_S              0xfff0707fU
+#define MATCH_FCVT_W_D             0xc2000053U
+#define MASK_FCVT_W_D              0xfff0007fU
+#define MATCH_FCVT_WU_D            0xc2100053U
+#define MASK_FCVT_WU_D             0xfff0007fU
+#define MATCH_FCVT_L_D             0xc2200053U
+#define MASK_FCVT_L_D              0xfff0007fU
+#define MATCH_FCVT_LU_D            0xc2300053U
+#define MASK_FCVT_LU_D             0xfff0007fU
+#define MATCH_FMV_X_D              0xe2000053U
+#define MASK_FMV_X_D               0xfff0707fU
+#define MATCH_FCLASS_D             0xe2001053U
+#define MASK_FCLASS_D              0xfff0707fU
+#define MATCH_FCVT_S_W             0xd0000053U
+#define MASK_FCVT_S_W              0xfff0007fU
+#define MATCH_FCVT_S_WU            0xd0100053U
+#define MASK_FCVT_S_WU             0xfff0007fU
+#define MATCH_FCVT_S_L             0xd0200053U
+#define MASK_FCVT_S_L              0xfff0007fU
+#define MATCH_FCVT_S_LU            0xd0300053U
+#define MASK_FCVT_S_LU             0xfff0007fU
+#define MATCH_FMV_S_X              0xf0000053U
+#define MASK_FMV_S_X               0xfff0707fU
+#define MATCH_FCVT_D_W             0xd2000053U
+#define MASK_FCVT_D_W              0xfff0007fU
+#define MATCH_FCVT_D_WU            0xd2100053U
+#define MASK_FCVT_D_WU             0xfff0007fU
+#define MATCH_FCVT_D_L             0xd2200053U
+#define MASK_FCVT_D_L              0xfff0007fU
+#define MATCH_FCVT_D_LU            0xd2300053U
+#define MASK_FCVT_D_LU             0xfff0007fU
+#define MATCH_FMV_D_X              0xf2000053U
+#define MASK_FMV_D_X               0xfff0707fU
+#define MATCH_FLW                  0x2007U
+#define MASK_FLW                   0x707fU
+#define MATCH_FLD                  0x3007U
+#define MASK_FLD                   0x707fU
+#define MATCH_FSW                  0x2027U
+#define MASK_FSW                   0x707fU
+#define MATCH_FSD                  0x3027U
+#define MASK_FSD                   0x707fU
+#define MATCH_FMADD_S              0x43U
+#define MASK_FMADD_S               0x600007fU
+#define MATCH_FMSUB_S              0x47U
+#define MASK_FMSUB_S               0x600007fU
+#define MATCH_FNMSUB_S             0x4bU
+#define MASK_FNMSUB_S              0x600007fU
+#define MATCH_FNMADD_S             0x4fU
+#define MASK_FNMADD_S              0x600007fU
+#define MATCH_FMADD_D              0x2000043U
+#define MASK_FMADD_D               0x600007fU
+#define MATCH_FMSUB_D              0x2000047U
+#define MASK_FMSUB_D               0x600007fU
+#define MATCH_FNMSUB_D             0x200004bU
+#define MASK_FNMSUB_D              0x600007fU
+#define MATCH_FNMADD_D             0x200004fU
+#define MASK_FNMADD_D              0x600007fU
+#define MATCH_C_NOP                0x1U
+#define MASK_C_NOP                 0xffffU
+#define MATCH_C_ADDI16SP           0x6101U
+#define MASK_C_ADDI16SP            0xef83U
+#define MATCH_C_JR                 0x8002U
+#define MASK_C_JR                  0xf07fU
+#define MATCH_C_JALR               0x9002U
+#define MASK_C_JALR                0xf07fU
+#define MATCH_C_EBREAK             0x9002U
+#define MASK_C_EBREAK              0xffffU
+#define MATCH_C_LD                 0x6000U
+#define MASK_C_LD                  0xe003U
+#define MATCH_C_SD                 0xe000U
+#define MASK_C_SD                  0xe003U
+#define MATCH_C_ADDIW              0x2001U
+#define MASK_C_ADDIW               0xe003U
+#define MATCH_C_LDSP               0x6002U
+#define MASK_C_LDSP                0xe003U
+#define MATCH_C_SDSP               0xe002U
+#define MASK_C_SDSP                0xe003U
+#define MATCH_C_ADDI4SPN           0x0U
+#define MASK_C_ADDI4SPN            0xe003U
+#define MATCH_C_FLD                0x2000U
+#define MASK_C_FLD                 0xe003U
+#define MATCH_C_LW                 0x4000U
+#define MASK_C_LW                  0xe003U
+#define MATCH_C_FLW                0x6000U
+#define MASK_C_FLW                 0xe003U
+#define MATCH_C_FSD                0xa000U
+#define MASK_C_FSD                 0xe003U
+#define MATCH_C_SW                 0xc000U
+#define MASK_C_SW                  0xe003U
+#define MATCH_C_FSW                0xe000U
+#define MASK_C_FSW                 0xe003U
+#define MATCH_C_ADDI               0x1U
+#define MASK_C_ADDI                0xe003U
+#define MATCH_C_JAL                0x2001U
+#define MASK_C_JAL                 0xe003U
+#define MATCH_C_LI                 0x4001U
+#define MASK_C_LI                  0xe003U
+#define MATCH_C_LUI                0x6001U
+#define MASK_C_LUI                 0xe003U
+#define MATCH_C_SRLI               0x8001U
+#define MASK_C_SRLI                0xec03U
+#define MATCH_C_SRAI               0x8401U
+#define MASK_C_SRAI                0xec03U
+#define MATCH_C_ANDI               0x8801U
+#define MASK_C_ANDI                0xec03U
+#define MATCH_C_SUB                0x8c01U
+#define MASK_C_SUB                 0xfc63U
+#define MATCH_C_XOR                0x8c21U
+#define MASK_C_XOR                 0xfc63U
+#define MATCH_C_OR                 0x8c41U
+#define MASK_C_OR                  0xfc63U
+#define MATCH_C_AND                0x8c61U
+#define MASK_C_AND                 0xfc63U
+#define MATCH_C_SUBW               0x9c01U
+#define MASK_C_SUBW                0xfc63U
+#define MATCH_C_ADDW               0x9c21U
+#define MASK_C_ADDW                0xfc63U
+#define MATCH_C_J                  0xa001U
+#define MASK_C_J                   0xe003U
+#define MATCH_C_BEQZ               0xc001U
+#define MASK_C_BEQZ                0xe003U
+#define MATCH_C_BNEZ               0xe001U
+#define MASK_C_BNEZ                0xe003U
+#define MATCH_C_SLLI               0x2U
+#define MASK_C_SLLI                0xe003U
+#define MATCH_C_FLDSP              0x2002U
+#define MASK_C_FLDSP               0xe003U
+#define MATCH_C_LWSP               0x4002U
+#define MASK_C_LWSP                0xe003U
+#define MATCH_C_FLWSP              0x6002U
+#define MASK_C_FLWSP               0xe003U
+#define MATCH_C_MV                 0x8002U
+#define MASK_C_MV                  0xf003U
+#define MATCH_C_ADD                0x9002U
+#define MASK_C_ADD                 0xf003U
+#define MATCH_C_FSDSP              0xa002U
+#define MASK_C_FSDSP               0xe003U
+#define MATCH_C_SWSP               0xc002U
+#define MASK_C_SWSP                0xe003U
+#define MATCH_C_FSWSP              0xe002U
+#define MASK_C_FSWSP               0xe003U
+#define MATCH_CUSTOM0              0xbU
+#define MASK_CUSTOM0               0x707fU
+#define MATCH_CUSTOM0_RS1          0x200bU
+#define MASK_CUSTOM0_RS1           0x707fU
+#define MATCH_CUSTOM0_RS1_RS2      0x300bU
+#define MASK_CUSTOM0_RS1_RS2       0x707fU
+#define MATCH_CUSTOM0_RD           0x400bU
+#define MASK_CUSTOM0_RD            0x707fU
+#define MATCH_CUSTOM0_RD_RS1       0x600bU
+#define MASK_CUSTOM0_RD_RS1        0x707fU
+#define MATCH_CUSTOM0_RD_RS1_RS2   0x700bU
+#define MASK_CUSTOM0_RD_RS1_RS2    0x707fU
+#define MATCH_CUSTOM1              0x2bU
+#define MASK_CUSTOM1               0x707fU
+#define MATCH_CUSTOM1_RS1          0x202bU
+#define MASK_CUSTOM1_RS1           0x707fU
+#define MATCH_CUSTOM1_RS1_RS2      0x302bU
+#define MASK_CUSTOM1_RS1_RS2       0x707fU
+#define MATCH_CUSTOM1_RD           0x402bU
+#define MASK_CUSTOM1_RD            0x707fU
+#define MATCH_CUSTOM1_RD_RS1       0x602bU
+#define MASK_CUSTOM1_RD_RS1        0x707fU
+#define MATCH_CUSTOM1_RD_RS1_RS2   0x702bU
+#define MASK_CUSTOM1_RD_RS1_RS2    0x707fU
+#define MATCH_CUSTOM2              0x5bU
+#define MASK_CUSTOM2               0x707fU
+#define MATCH_CUSTOM2_RS1          0x205bU
+#define MASK_CUSTOM2_RS1           0x707fU
+#define MATCH_CUSTOM2_RS1_RS2      0x305bU
+#define MASK_CUSTOM2_RS1_RS2       0x707fU
+#define MATCH_CUSTOM2_RD           0x405bU
+#define MASK_CUSTOM2_RD            0x707fU
+#define MATCH_CUSTOM2_RD_RS1       0x605bU
+#define MASK_CUSTOM2_RD_RS1        0x707fU
+#define MATCH_CUSTOM2_RD_RS1_RS2   0x705bU
+#define MASK_CUSTOM2_RD_RS1_RS2    0x707fU
+#define MATCH_CUSTOM3              0x7bU
+#define MASK_CUSTOM3               0x707fU
+#define MATCH_CUSTOM3_RS1          0x207bU
+#define MASK_CUSTOM3_RS1           0x707fU
+#define MATCH_CUSTOM3_RS1_RS2      0x307bU
+#define MASK_CUSTOM3_RS1_RS2       0x707fU
+#define MATCH_CUSTOM3_RD           0x407bU
+#define MASK_CUSTOM3_RD            0x707fU
+#define MATCH_CUSTOM3_RD_RS1       0x607bU
+#define MASK_CUSTOM3_RD_RS1        0x707fU
+#define MATCH_CUSTOM3_RD_RS1_RS2   0x707bU
+#define MASK_CUSTOM3_RD_RS1_RS2    0x707fU
+#define CSR_FFLAGS                 0x1U
+#define CSR_FRM                    0x2U
+#define CSR_FCSR                   0x3U
+#define CSR_CYCLE                  0xc00U
+#define CSR_TIME                   0xc01U
+#define CSR_INSTRET                0xc02U
+#define CSR_HPMCOUNTER3            0xc03U
+#define CSR_HPMCOUNTER4            0xc04U
+#define CSR_HPMCOUNTER5            0xc05U
+#define CSR_HPMCOUNTER6            0xc06U
+#define CSR_HPMCOUNTER7            0xc07U
+#define CSR_HPMCOUNTER8            0xc08U
+#define CSR_HPMCOUNTER9            0xc09U
+#define CSR_HPMCOUNTER10           0xc0aU
+#define CSR_HPMCOUNTER11           0xc0bU
+#define CSR_HPMCOUNTER12           0xc0cU
+#define CSR_HPMCOUNTER13           0xc0dU
+#define CSR_HPMCOUNTER14           0xc0eU
+#define CSR_HPMCOUNTER15           0xc0fU
+#define CSR_HPMCOUNTER16           0xc10U
+#define CSR_HPMCOUNTER17           0xc11U
+#define CSR_HPMCOUNTER18           0xc12U
+#define CSR_HPMCOUNTER19           0xc13U
+#define CSR_HPMCOUNTER20           0xc14U
+#define CSR_HPMCOUNTER21           0xc15U
+#define CSR_HPMCOUNTER22           0xc16U
+#define CSR_HPMCOUNTER23           0xc17U
+#define CSR_HPMCOUNTER24           0xc18U
+#define CSR_HPMCOUNTER25           0xc19U
+#define CSR_HPMCOUNTER26           0xc1aU
+#define CSR_HPMCOUNTER27           0xc1bU
+#define CSR_HPMCOUNTER28           0xc1cU
+#define CSR_HPMCOUNTER29           0xc1dU
+#define CSR_HPMCOUNTER30           0xc1eU
+#define CSR_HPMCOUNTER31           0xc1fU
+#define CSR_SSTATUS                0x100U
+#define CSR_SIE                    0x104U
+#define CSR_STVEC                  0x105U
+#define CSR_SSCRATCH               0x140U
+#define CSR_SEPC                   0x141U
+#define CSR_SCAUSE                 0x142U
+#define CSR_SBADADDR               0x143U
+#define CSR_SIP                    0x144U
+#define CSR_SPTBR                  0x180U
+#define CSR_MSTATUS                0x300U
+#define CSR_MISA                   0x301U
+#define CSR_MEDELEG                0x302U
+#define CSR_MIDELEG                0x303U
+#define CSR_MIE                    0x304U
+#define CSR_MTVEC                  0x305U
+#define CSR_MSCRATCH               0x340U
+#define CSR_MEPC                   0x341U
+#define CSR_MCAUSE                 0x342U
+#define CSR_MBADADDR               0x343U
+#define CSR_MIP                    0x344U
+#define CSR_TSELECT                0x7a0U
+#define CSR_TDATA1                 0x7a1U
+#define CSR_TDATA2                 0x7a2U
+#define CSR_TDATA3                 0x7a3U
+#define CSR_DCSR                   0x7b0U
+#define CSR_DPC                    0x7b1U
+#define CSR_DSCRATCH               0x7b2U
+#define CSR_MCYCLE                 0xb00U
+#define CSR_MINSTRET               0xb02U
+#define CSR_MHPMCOUNTER3           0xb03U
+#define CSR_MHPMCOUNTER4           0xb04U
+#define CSR_MHPMCOUNTER5           0xb05U
+#define CSR_MHPMCOUNTER6           0xb06U
+#define CSR_MHPMCOUNTER7           0xb07U
+#define CSR_MHPMCOUNTER8           0xb08U
+#define CSR_MHPMCOUNTER9           0xb09U
+#define CSR_MHPMCOUNTER10          0xb0aU
+#define CSR_MHPMCOUNTER11          0xb0bU
+#define CSR_MHPMCOUNTER12          0xb0cU
+#define CSR_MHPMCOUNTER13          0xb0dU
+#define CSR_MHPMCOUNTER14          0xb0eU
+#define CSR_MHPMCOUNTER15          0xb0fU
+#define CSR_MHPMCOUNTER16          0xb10U
+#define CSR_MHPMCOUNTER17          0xb11U
+#define CSR_MHPMCOUNTER18          0xb12U
+#define CSR_MHPMCOUNTER19          0xb13U
+#define CSR_MHPMCOUNTER20          0xb14U
+#define CSR_MHPMCOUNTER21          0xb15U
+#define CSR_MHPMCOUNTER22          0xb16U
+#define CSR_MHPMCOUNTER23          0xb17U
+#define CSR_MHPMCOUNTER24          0xb18U
+#define CSR_MHPMCOUNTER25          0xb19U
+#define CSR_MHPMCOUNTER26          0xb1aU
+#define CSR_MHPMCOUNTER27          0xb1bU
+#define CSR_MHPMCOUNTER28          0xb1cU
+#define CSR_MHPMCOUNTER29          0xb1dU
+#define CSR_MHPMCOUNTER30          0xb1eU
+#define CSR_MHPMCOUNTER31          0xb1fU
+#define CSR_MUCOUNTEREN            0x320U
+#define CSR_MSCOUNTEREN            0x321U
+#define CSR_MHPMEVENT3             0x323U
+#define CSR_MHPMEVENT4             0x324U
+#define CSR_MHPMEVENT5             0x325U
+#define CSR_MHPMEVENT6             0x326U
+#define CSR_MHPMEVENT7             0x327U
+#define CSR_MHPMEVENT8             0x328U
+#define CSR_MHPMEVENT9             0x329U
+#define CSR_MHPMEVENT10            0x32aU
+#define CSR_MHPMEVENT11            0x32bU
+#define CSR_MHPMEVENT12            0x32cU
+#define CSR_MHPMEVENT13            0x32dU
+#define CSR_MHPMEVENT14            0x32eU
+#define CSR_MHPMEVENT15            0x32fU
+#define CSR_MHPMEVENT16            0x330U
+#define CSR_MHPMEVENT17            0x331U
+#define CSR_MHPMEVENT18            0x332U
+#define CSR_MHPMEVENT19            0x333U
+#define CSR_MHPMEVENT20            0x334U
+#define CSR_MHPMEVENT21            0x335U
+#define CSR_MHPMEVENT22            0x336U
+#define CSR_MHPMEVENT23            0x337U
+#define CSR_MHPMEVENT24            0x338U
+#define CSR_MHPMEVENT25            0x339U
+#define CSR_MHPMEVENT26            0x33aU
+#define CSR_MHPMEVENT27            0x33bU
+#define CSR_MHPMEVENT28            0x33cU
+#define CSR_MHPMEVENT29            0x33dU
+#define CSR_MHPMEVENT30            0x33eU
+#define CSR_MHPMEVENT31            0x33fU
+#define CSR_MVENDORID              0xf11U
+#define CSR_MARCHID                0xf12U
+#define CSR_MIMPID                 0xf13U
+#define CSR_MHARTID                0xf14U
+#define CSR_CYCLEH                 0xc80U
+#define CSR_TIMEH                  0xc81U
+#define CSR_INSTRETH               0xc82U
+#define CSR_HPMCOUNTER3H           0xc83U
+#define CSR_HPMCOUNTER4H           0xc84U
+#define CSR_HPMCOUNTER5H           0xc85U
+#define CSR_HPMCOUNTER6H           0xc86U
+#define CSR_HPMCOUNTER7H           0xc87U
+#define CSR_HPMCOUNTER8H           0xc88U
+#define CSR_HPMCOUNTER9H           0xc89U
+#define CSR_HPMCOUNTER10H          0xc8aU
+#define CSR_HPMCOUNTER11H          0xc8bU
+#define CSR_HPMCOUNTER12H          0xc8cU
+#define CSR_HPMCOUNTER13H          0xc8dU
+#define CSR_HPMCOUNTER14H          0xc8eU
+#define CSR_HPMCOUNTER15H          0xc8fU
+#define CSR_HPMCOUNTER16H          0xc90U
+#define CSR_HPMCOUNTER17H          0xc91U
+#define CSR_HPMCOUNTER18H          0xc92U
+#define CSR_HPMCOUNTER19H          0xc93U
+#define CSR_HPMCOUNTER20H          0xc94U
+#define CSR_HPMCOUNTER21H          0xc95U
+#define CSR_HPMCOUNTER22H          0xc96U
+#define CSR_HPMCOUNTER23H          0xc97U
+#define CSR_HPMCOUNTER24H          0xc98U
+#define CSR_HPMCOUNTER25H          0xc99U
+#define CSR_HPMCOUNTER26H          0xc9aU
+#define CSR_HPMCOUNTER27H          0xc9bU
+#define CSR_HPMCOUNTER28H          0xc9cU
+#define CSR_HPMCOUNTER29H          0xc9dU
+#define CSR_HPMCOUNTER30H          0xc9eU
+#define CSR_HPMCOUNTER31H          0xc9fU
+#define CSR_MCYCLEH                0xb80U
+#define CSR_MINSTRETH              0xb82U
+#define CSR_MHPMCOUNTER3H          0xb83U
+#define CSR_MHPMCOUNTER4H          0xb84U
+#define CSR_MHPMCOUNTER5H          0xb85U
+#define CSR_MHPMCOUNTER6H          0xb86U
+#define CSR_MHPMCOUNTER7H          0xb87U
+#define CSR_MHPMCOUNTER8H          0xb88U
+#define CSR_MHPMCOUNTER9H          0xb89U
+#define CSR_MHPMCOUNTER10H         0xb8aU
+#define CSR_MHPMCOUNTER11H         0xb8bU
+#define CSR_MHPMCOUNTER12H         0xb8cU
+#define CSR_MHPMCOUNTER13H         0xb8dU
+#define CSR_MHPMCOUNTER14H         0xb8eU
+#define CSR_MHPMCOUNTER15H         0xb8fU
+#define CSR_MHPMCOUNTER16H         0xb90U
+#define CSR_MHPMCOUNTER17H         0xb91U
+#define CSR_MHPMCOUNTER18H         0xb92U
+#define CSR_MHPMCOUNTER19H         0xb93U
+#define CSR_MHPMCOUNTER20H         0xb94U
+#define CSR_MHPMCOUNTER21H         0xb95U
+#define CSR_MHPMCOUNTER22H         0xb96U
+#define CSR_MHPMCOUNTER23H         0xb97U
+#define CSR_MHPMCOUNTER24H         0xb98U
+#define CSR_MHPMCOUNTER25H         0xb99U
+#define CSR_MHPMCOUNTER26H         0xb9aU
+#define CSR_MHPMCOUNTER27H         0xb9bU
+#define CSR_MHPMCOUNTER28H         0xb9cU
+#define CSR_MHPMCOUNTER29H         0xb9dU
+#define CSR_MHPMCOUNTER30H         0xb9eU
+#define CSR_MHPMCOUNTER31H         0xb9fU
+#define CAUSE_MISALIGNED_FETCH     0x0
+#define CAUSE_FAULT_FETCH          0x1
+#define CAUSE_ILLEGAL_INSTRUCTION  0x2
+#define CAUSE_BREAKPOINT           0x3
+#define CAUSE_MISALIGNED_LOAD      0x4
+#define CAUSE_FAULT_LOAD           0x5
+#define CAUSE_MISALIGNED_STORE     0x6
+#define CAUSE_FAULT_STORE          0x7
+#define CAUSE_USER_ECALL           0x8
+#define CAUSE_SUPERVISOR_ECALL     0x9
+#define CAUSE_HYPERVISOR_ECALL     0xa
+#define CAUSE_MACHINE_ECALL        0xb
+#endif
+#if defined(DECLARE_INSN)
+DECLARE_INSN(beq, MATCH_BEQ, MASK_BEQ)
+DECLARE_INSN(bne, MATCH_BNE, MASK_BNE)
+DECLARE_INSN(blt, MATCH_BLT, MASK_BLT)
+DECLARE_INSN(bge, MATCH_BGE, MASK_BGE)
+DECLARE_INSN(bltu, MATCH_BLTU, MASK_BLTU)
+DECLARE_INSN(bgeu, MATCH_BGEU, MASK_BGEU)
+DECLARE_INSN(jalr, MATCH_JALR, MASK_JALR)
+DECLARE_INSN(jal, MATCH_JAL, MASK_JAL)
+DECLARE_INSN(lui, MATCH_LUI, MASK_LUI)
+DECLARE_INSN(auipc, MATCH_AUIPC, MASK_AUIPC)
+DECLARE_INSN(addi, MATCH_ADDI, MASK_ADDI)
+DECLARE_INSN(slli, MATCH_SLLI, MASK_SLLI)
+DECLARE_INSN(slti, MATCH_SLTI, MASK_SLTI)
+DECLARE_INSN(sltiu, MATCH_SLTIU, MASK_SLTIU)
+DECLARE_INSN(xori, MATCH_XORI, MASK_XORI)
+DECLARE_INSN(srli, MATCH_SRLI, MASK_SRLI)
+DECLARE_INSN(srai, MATCH_SRAI, MASK_SRAI)
+DECLARE_INSN(ori, MATCH_ORI, MASK_ORI)
+DECLARE_INSN(andi, MATCH_ANDI, MASK_ANDI)
+DECLARE_INSN(add, MATCH_ADD, MASK_ADD)
+DECLARE_INSN(sub, MATCH_SUB, MASK_SUB)
+DECLARE_INSN(sll, MATCH_SLL, MASK_SLL)
+DECLARE_INSN(slt, MATCH_SLT, MASK_SLT)
+DECLARE_INSN(sltu, MATCH_SLTU, MASK_SLTU)
+DECLARE_INSN(xor, MATCH_XOR, MASK_XOR)
+DECLARE_INSN(srl, MATCH_SRL, MASK_SRL)
+DECLARE_INSN(sra, MATCH_SRA, MASK_SRA)
+DECLARE_INSN(or, MATCH_OR, MASK_OR)
+DECLARE_INSN(and, MATCH_AND, MASK_AND)
+DECLARE_INSN(addiw, MATCH_ADDIW, MASK_ADDIW)
+DECLARE_INSN(slliw, MATCH_SLLIW, MASK_SLLIW)
+DECLARE_INSN(srliw, MATCH_SRLIW, MASK_SRLIW)
+DECLARE_INSN(sraiw, MATCH_SRAIW, MASK_SRAIW)
+DECLARE_INSN(addw, MATCH_ADDW, MASK_ADDW)
+DECLARE_INSN(subw, MATCH_SUBW, MASK_SUBW)
+DECLARE_INSN(sllw, MATCH_SLLW, MASK_SLLW)
+DECLARE_INSN(srlw, MATCH_SRLW, MASK_SRLW)
+DECLARE_INSN(sraw, MATCH_SRAW, MASK_SRAW)
+DECLARE_INSN(lb, MATCH_LB, MASK_LB)
+DECLARE_INSN(lh, MATCH_LH, MASK_LH)
+DECLARE_INSN(lw, MATCH_LW, MASK_LW)
+DECLARE_INSN(ld, MATCH_LD, MASK_LD)
+DECLARE_INSN(lbu, MATCH_LBU, MASK_LBU)
+DECLARE_INSN(lhu, MATCH_LHU, MASK_LHU)
+DECLARE_INSN(lwu, MATCH_LWU, MASK_LWU)
+DECLARE_INSN(sb, MATCH_SB, MASK_SB)
+DECLARE_INSN(sh, MATCH_SH, MASK_SH)
+DECLARE_INSN(sw, MATCH_SW, MASK_SW)
+DECLARE_INSN(sd, MATCH_SD, MASK_SD)
+DECLARE_INSN(fence, MATCH_FENCE, MASK_FENCE)
+DECLARE_INSN(fence_i, MATCH_FENCE_I, MASK_FENCE_I)
+DECLARE_INSN(mul, MATCH_MUL, MASK_MUL)
+DECLARE_INSN(mulh, MATCH_MULH, MASK_MULH)
+DECLARE_INSN(mulhsu, MATCH_MULHSU, MASK_MULHSU)
+DECLARE_INSN(mulhu, MATCH_MULHU, MASK_MULHU)
+DECLARE_INSN(div, MATCH_DIV, MASK_DIV)
+DECLARE_INSN(divu, MATCH_DIVU, MASK_DIVU)
+DECLARE_INSN(rem, MATCH_REM, MASK_REM)
+DECLARE_INSN(remu, MATCH_REMU, MASK_REMU)
+DECLARE_INSN(mulw, MATCH_MULW, MASK_MULW)
+DECLARE_INSN(divw, MATCH_DIVW, MASK_DIVW)
+DECLARE_INSN(divuw, MATCH_DIVUW, MASK_DIVUW)
+DECLARE_INSN(remw, MATCH_REMW, MASK_REMW)
+DECLARE_INSN(remuw, MATCH_REMUW, MASK_REMUW)
+DECLARE_INSN(amoadd_w, MATCH_AMOADD_W, MASK_AMOADD_W)
+DECLARE_INSN(amoxor_w, MATCH_AMOXOR_W, MASK_AMOXOR_W)
+DECLARE_INSN(amoor_w, MATCH_AMOOR_W, MASK_AMOOR_W)
+DECLARE_INSN(amoand_w, MATCH_AMOAND_W, MASK_AMOAND_W)
+DECLARE_INSN(amomin_w, MATCH_AMOMIN_W, MASK_AMOMIN_W)
+DECLARE_INSN(amomax_w, MATCH_AMOMAX_W, MASK_AMOMAX_W)
+DECLARE_INSN(amominu_w, MATCH_AMOMINU_W, MASK_AMOMINU_W)
+DECLARE_INSN(amomaxu_w, MATCH_AMOMAXU_W, MASK_AMOMAXU_W)
+DECLARE_INSN(amoswap_w, MATCH_AMOSWAP_W, MASK_AMOSWAP_W)
+DECLARE_INSN(lr_w, MATCH_LR_W, MASK_LR_W)
+DECLARE_INSN(sc_w, MATCH_SC_W, MASK_SC_W)
+DECLARE_INSN(amoadd_d, MATCH_AMOADD_D, MASK_AMOADD_D)
+DECLARE_INSN(amoxor_d, MATCH_AMOXOR_D, MASK_AMOXOR_D)
+DECLARE_INSN(amoor_d, MATCH_AMOOR_D, MASK_AMOOR_D)
+DECLARE_INSN(amoand_d, MATCH_AMOAND_D, MASK_AMOAND_D)
+DECLARE_INSN(amomin_d, MATCH_AMOMIN_D, MASK_AMOMIN_D)
+DECLARE_INSN(amomax_d, MATCH_AMOMAX_D, MASK_AMOMAX_D)
+DECLARE_INSN(amominu_d, MATCH_AMOMINU_D, MASK_AMOMINU_D)
+DECLARE_INSN(amomaxu_d, MATCH_AMOMAXU_D, MASK_AMOMAXU_D)
+DECLARE_INSN(amoswap_d, MATCH_AMOSWAP_D, MASK_AMOSWAP_D)
+DECLARE_INSN(lr_d, MATCH_LR_D, MASK_LR_D)
+DECLARE_INSN(sc_d, MATCH_SC_D, MASK_SC_D)
+DECLARE_INSN(ecall, MATCH_ECALL, MASK_ECALL)
+DECLARE_INSN(ebreak, MATCH_EBREAK, MASK_EBREAK)
+DECLARE_INSN(uret, MATCH_URET, MASK_URET)
+DECLARE_INSN(sret, MATCH_SRET, MASK_SRET)
+DECLARE_INSN(hret, MATCH_HRET, MASK_HRET)
+DECLARE_INSN(mret, MATCH_MRET, MASK_MRET)
+DECLARE_INSN(dret, MATCH_DRET, MASK_DRET)
+DECLARE_INSN(sfence_vm, MATCH_SFENCE_VM, MASK_SFENCE_VM)
+DECLARE_INSN(wfi, MATCH_WFI, MASK_WFI)
+DECLARE_INSN(csrrw, MATCH_CSRRW, MASK_CSRRW)
+DECLARE_INSN(csrrs, MATCH_CSRRS, MASK_CSRRS)
+DECLARE_INSN(csrrc, MATCH_CSRRC, MASK_CSRRC)
+DECLARE_INSN(csrrwi, MATCH_CSRRWI, MASK_CSRRWI)
+DECLARE_INSN(csrrsi, MATCH_CSRRSI, MASK_CSRRSI)
+DECLARE_INSN(csrrci, MATCH_CSRRCI, MASK_CSRRCI)
+DECLARE_INSN(fadd_s, MATCH_FADD_S, MASK_FADD_S)
+DECLARE_INSN(fsub_s, MATCH_FSUB_S, MASK_FSUB_S)
+DECLARE_INSN(fmul_s, MATCH_FMUL_S, MASK_FMUL_S)
+DECLARE_INSN(fdiv_s, MATCH_FDIV_S, MASK_FDIV_S)
+DECLARE_INSN(fsgnj_s, MATCH_FSGNJ_S, MASK_FSGNJ_S)
+DECLARE_INSN(fsgnjn_s, MATCH_FSGNJN_S, MASK_FSGNJN_S)
+DECLARE_INSN(fsgnjx_s, MATCH_FSGNJX_S, MASK_FSGNJX_S)
+DECLARE_INSN(fmin_s, MATCH_FMIN_S, MASK_FMIN_S)
+DECLARE_INSN(fmax_s, MATCH_FMAX_S, MASK_FMAX_S)
+DECLARE_INSN(fsqrt_s, MATCH_FSQRT_S, MASK_FSQRT_S)
+DECLARE_INSN(fadd_d, MATCH_FADD_D, MASK_FADD_D)
+DECLARE_INSN(fsub_d, MATCH_FSUB_D, MASK_FSUB_D)
+DECLARE_INSN(fmul_d, MATCH_FMUL_D, MASK_FMUL_D)
+DECLARE_INSN(fdiv_d, MATCH_FDIV_D, MASK_FDIV_D)
+DECLARE_INSN(fsgnj_d, MATCH_FSGNJ_D, MASK_FSGNJ_D)
+DECLARE_INSN(fsgnjn_d, MATCH_FSGNJN_D, MASK_FSGNJN_D)
+DECLARE_INSN(fsgnjx_d, MATCH_FSGNJX_D, MASK_FSGNJX_D)
+DECLARE_INSN(fmin_d, MATCH_FMIN_D, MASK_FMIN_D)
+DECLARE_INSN(fmax_d, MATCH_FMAX_D, MASK_FMAX_D)
+DECLARE_INSN(fcvt_s_d, MATCH_FCVT_S_D, MASK_FCVT_S_D)
+DECLARE_INSN(fcvt_d_s, MATCH_FCVT_D_S, MASK_FCVT_D_S)
+DECLARE_INSN(fsqrt_d, MATCH_FSQRT_D, MASK_FSQRT_D)
+DECLARE_INSN(fle_s, MATCH_FLE_S, MASK_FLE_S)
+DECLARE_INSN(flt_s, MATCH_FLT_S, MASK_FLT_S)
+DECLARE_INSN(feq_s, MATCH_FEQ_S, MASK_FEQ_S)
+DECLARE_INSN(fle_d, MATCH_FLE_D, MASK_FLE_D)
+DECLARE_INSN(flt_d, MATCH_FLT_D, MASK_FLT_D)
+DECLARE_INSN(feq_d, MATCH_FEQ_D, MASK_FEQ_D)
+DECLARE_INSN(fcvt_w_s, MATCH_FCVT_W_S, MASK_FCVT_W_S)
+DECLARE_INSN(fcvt_wu_s, MATCH_FCVT_WU_S, MASK_FCVT_WU_S)
+DECLARE_INSN(fcvt_l_s, MATCH_FCVT_L_S, MASK_FCVT_L_S)
+DECLARE_INSN(fcvt_lu_s, MATCH_FCVT_LU_S, MASK_FCVT_LU_S)
+DECLARE_INSN(fmv_x_s, MATCH_FMV_X_S, MASK_FMV_X_S)
+DECLARE_INSN(fclass_s, MATCH_FCLASS_S, MASK_FCLASS_S)
+DECLARE_INSN(fcvt_w_d, MATCH_FCVT_W_D, MASK_FCVT_W_D)
+DECLARE_INSN(fcvt_wu_d, MATCH_FCVT_WU_D, MASK_FCVT_WU_D)
+DECLARE_INSN(fcvt_l_d, MATCH_FCVT_L_D, MASK_FCVT_L_D)
+DECLARE_INSN(fcvt_lu_d, MATCH_FCVT_LU_D, MASK_FCVT_LU_D)
+DECLARE_INSN(fmv_x_d, MATCH_FMV_X_D, MASK_FMV_X_D)
+DECLARE_INSN(fclass_d, MATCH_FCLASS_D, MASK_FCLASS_D)
+DECLARE_INSN(fcvt_s_w, MATCH_FCVT_S_W, MASK_FCVT_S_W)
+DECLARE_INSN(fcvt_s_wu, MATCH_FCVT_S_WU, MASK_FCVT_S_WU)
+DECLARE_INSN(fcvt_s_l, MATCH_FCVT_S_L, MASK_FCVT_S_L)
+DECLARE_INSN(fcvt_s_lu, MATCH_FCVT_S_LU, MASK_FCVT_S_LU)
+DECLARE_INSN(fmv_s_x, MATCH_FMV_S_X, MASK_FMV_S_X)
+DECLARE_INSN(fcvt_d_w, MATCH_FCVT_D_W, MASK_FCVT_D_W)
+DECLARE_INSN(fcvt_d_wu, MATCH_FCVT_D_WU, MASK_FCVT_D_WU)
+DECLARE_INSN(fcvt_d_l, MATCH_FCVT_D_L, MASK_FCVT_D_L)
+DECLARE_INSN(fcvt_d_lu, MATCH_FCVT_D_LU, MASK_FCVT_D_LU)
+DECLARE_INSN(fmv_d_x, MATCH_FMV_D_X, MASK_FMV_D_X)
+DECLARE_INSN(flw, MATCH_FLW, MASK_FLW)
+DECLARE_INSN(fld, MATCH_FLD, MASK_FLD)
+DECLARE_INSN(fsw, MATCH_FSW, MASK_FSW)
+DECLARE_INSN(fsd, MATCH_FSD, MASK_FSD)
+DECLARE_INSN(fmadd_s, MATCH_FMADD_S, MASK_FMADD_S)
+DECLARE_INSN(fmsub_s, MATCH_FMSUB_S, MASK_FMSUB_S)
+DECLARE_INSN(fnmsub_s, MATCH_FNMSUB_S, MASK_FNMSUB_S)
+DECLARE_INSN(fnmadd_s, MATCH_FNMADD_S, MASK_FNMADD_S)
+DECLARE_INSN(fmadd_d, MATCH_FMADD_D, MASK_FMADD_D)
+DECLARE_INSN(fmsub_d, MATCH_FMSUB_D, MASK_FMSUB_D)
+DECLARE_INSN(fnmsub_d, MATCH_FNMSUB_D, MASK_FNMSUB_D)
+DECLARE_INSN(fnmadd_d, MATCH_FNMADD_D, MASK_FNMADD_D)
+DECLARE_INSN(c_nop, MATCH_C_NOP, MASK_C_NOP)
+DECLARE_INSN(c_addi16sp, MATCH_C_ADDI16SP, MASK_C_ADDI16SP)
+DECLARE_INSN(c_jr, MATCH_C_JR, MASK_C_JR)
+DECLARE_INSN(c_jalr, MATCH_C_JALR, MASK_C_JALR)
+DECLARE_INSN(c_ebreak, MATCH_C_EBREAK, MASK_C_EBREAK)
+DECLARE_INSN(c_ld, MATCH_C_LD, MASK_C_LD)
+DECLARE_INSN(c_sd, MATCH_C_SD, MASK_C_SD)
+DECLARE_INSN(c_addiw, MATCH_C_ADDIW, MASK_C_ADDIW)
+DECLARE_INSN(c_ldsp, MATCH_C_LDSP, MASK_C_LDSP)
+DECLARE_INSN(c_sdsp, MATCH_C_SDSP, MASK_C_SDSP)
+DECLARE_INSN(c_addi4spn, MATCH_C_ADDI4SPN, MASK_C_ADDI4SPN)
+DECLARE_INSN(c_fld, MATCH_C_FLD, MASK_C_FLD)
+DECLARE_INSN(c_lw, MATCH_C_LW, MASK_C_LW)
+DECLARE_INSN(c_flw, MATCH_C_FLW, MASK_C_FLW)
+DECLARE_INSN(c_fsd, MATCH_C_FSD, MASK_C_FSD)
+DECLARE_INSN(c_sw, MATCH_C_SW, MASK_C_SW)
+DECLARE_INSN(c_fsw, MATCH_C_FSW, MASK_C_FSW)
+DECLARE_INSN(c_addi, MATCH_C_ADDI, MASK_C_ADDI)
+DECLARE_INSN(c_jal, MATCH_C_JAL, MASK_C_JAL)
+DECLARE_INSN(c_li, MATCH_C_LI, MASK_C_LI)
+DECLARE_INSN(c_lui, MATCH_C_LUI, MASK_C_LUI)
+DECLARE_INSN(c_srli, MATCH_C_SRLI, MASK_C_SRLI)
+DECLARE_INSN(c_srai, MATCH_C_SRAI, MASK_C_SRAI)
+DECLARE_INSN(c_andi, MATCH_C_ANDI, MASK_C_ANDI)
+DECLARE_INSN(c_sub, MATCH_C_SUB, MASK_C_SUB)
+DECLARE_INSN(c_xor, MATCH_C_XOR, MASK_C_XOR)
+DECLARE_INSN(c_or, MATCH_C_OR, MASK_C_OR)
+DECLARE_INSN(c_and, MATCH_C_AND, MASK_C_AND)
+DECLARE_INSN(c_subw, MATCH_C_SUBW, MASK_C_SUBW)
+DECLARE_INSN(c_addw, MATCH_C_ADDW, MASK_C_ADDW)
+DECLARE_INSN(c_j, MATCH_C_J, MASK_C_J)
+DECLARE_INSN(c_beqz, MATCH_C_BEQZ, MASK_C_BEQZ)
+DECLARE_INSN(c_bnez, MATCH_C_BNEZ, MASK_C_BNEZ)
+DECLARE_INSN(c_slli, MATCH_C_SLLI, MASK_C_SLLI)
+DECLARE_INSN(c_fldsp, MATCH_C_FLDSP, MASK_C_FLDSP)
+DECLARE_INSN(c_lwsp, MATCH_C_LWSP, MASK_C_LWSP)
+DECLARE_INSN(c_flwsp, MATCH_C_FLWSP, MASK_C_FLWSP)
+DECLARE_INSN(c_mv, MATCH_C_MV, MASK_C_MV)
+DECLARE_INSN(c_add, MATCH_C_ADD, MASK_C_ADD)
+DECLARE_INSN(c_fsdsp, MATCH_C_FSDSP, MASK_C_FSDSP)
+DECLARE_INSN(c_swsp, MATCH_C_SWSP, MASK_C_SWSP)
+DECLARE_INSN(c_fswsp, MATCH_C_FSWSP, MASK_C_FSWSP)
+DECLARE_INSN(custom0, MATCH_CUSTOM0, MASK_CUSTOM0)
+DECLARE_INSN(custom0_rs1, MATCH_CUSTOM0_RS1, MASK_CUSTOM0_RS1)
+DECLARE_INSN(custom0_rs1_rs2, MATCH_CUSTOM0_RS1_RS2, MASK_CUSTOM0_RS1_RS2)
+DECLARE_INSN(custom0_rd, MATCH_CUSTOM0_RD, MASK_CUSTOM0_RD)
+DECLARE_INSN(custom0_rd_rs1, MATCH_CUSTOM0_RD_RS1, MASK_CUSTOM0_RD_RS1)
+DECLARE_INSN(custom0_rd_rs1_rs2, MATCH_CUSTOM0_RD_RS1_RS2, MASK_CUSTOM0_RD_RS1_RS2)
+DECLARE_INSN(custom1, MATCH_CUSTOM1, MASK_CUSTOM1)
+DECLARE_INSN(custom1_rs1, MATCH_CUSTOM1_RS1, MASK_CUSTOM1_RS1)
+DECLARE_INSN(custom1_rs1_rs2, MATCH_CUSTOM1_RS1_RS2, MASK_CUSTOM1_RS1_RS2)
+DECLARE_INSN(custom1_rd, MATCH_CUSTOM1_RD, MASK_CUSTOM1_RD)
+DECLARE_INSN(custom1_rd_rs1, MATCH_CUSTOM1_RD_RS1, MASK_CUSTOM1_RD_RS1)
+DECLARE_INSN(custom1_rd_rs1_rs2, MATCH_CUSTOM1_RD_RS1_RS2, MASK_CUSTOM1_RD_RS1_RS2)
+DECLARE_INSN(custom2, MATCH_CUSTOM2, MASK_CUSTOM2)
+DECLARE_INSN(custom2_rs1, MATCH_CUSTOM2_RS1, MASK_CUSTOM2_RS1)
+DECLARE_INSN(custom2_rs1_rs2, MATCH_CUSTOM2_RS1_RS2, MASK_CUSTOM2_RS1_RS2)
+DECLARE_INSN(custom2_rd, MATCH_CUSTOM2_RD, MASK_CUSTOM2_RD)
+DECLARE_INSN(custom2_rd_rs1, MATCH_CUSTOM2_RD_RS1, MASK_CUSTOM2_RD_RS1)
+DECLARE_INSN(custom2_rd_rs1_rs2, MATCH_CUSTOM2_RD_RS1_RS2, MASK_CUSTOM2_RD_RS1_RS2)
+DECLARE_INSN(custom3, MATCH_CUSTOM3, MASK_CUSTOM3)
+DECLARE_INSN(custom3_rs1, MATCH_CUSTOM3_RS1, MASK_CUSTOM3_RS1)
+DECLARE_INSN(custom3_rs1_rs2, MATCH_CUSTOM3_RS1_RS2, MASK_CUSTOM3_RS1_RS2)
+DECLARE_INSN(custom3_rd, MATCH_CUSTOM3_RD, MASK_CUSTOM3_RD)
+DECLARE_INSN(custom3_rd_rs1, MATCH_CUSTOM3_RD_RS1, MASK_CUSTOM3_RD_RS1)
+DECLARE_INSN(custom3_rd_rs1_rs2, MATCH_CUSTOM3_RD_RS1_RS2, MASK_CUSTOM3_RD_RS1_RS2)
+#endif
+#if defined(DECLARE_CSR)
+DECLARE_CSR(fflags, CSR_FFLAGS)
+DECLARE_CSR(frm, CSR_FRM)
+DECLARE_CSR(fcsr, CSR_FCSR)
+DECLARE_CSR(cycle, CSR_CYCLE)
+DECLARE_CSR(time, CSR_TIME)
+DECLARE_CSR(instret, CSR_INSTRET)
+DECLARE_CSR(hpmcounter3, CSR_HPMCOUNTER3)
+DECLARE_CSR(hpmcounter4, CSR_HPMCOUNTER4)
+DECLARE_CSR(hpmcounter5, CSR_HPMCOUNTER5)
+DECLARE_CSR(hpmcounter6, CSR_HPMCOUNTER6)
+DECLARE_CSR(hpmcounter7, CSR_HPMCOUNTER7)
+DECLARE_CSR(hpmcounter8, CSR_HPMCOUNTER8)
+DECLARE_CSR(hpmcounter9, CSR_HPMCOUNTER9)
+DECLARE_CSR(hpmcounter10, CSR_HPMCOUNTER10)
+DECLARE_CSR(hpmcounter11, CSR_HPMCOUNTER11)
+DECLARE_CSR(hpmcounter12, CSR_HPMCOUNTER12)
+DECLARE_CSR(hpmcounter13, CSR_HPMCOUNTER13)
+DECLARE_CSR(hpmcounter14, CSR_HPMCOUNTER14)
+DECLARE_CSR(hpmcounter15, CSR_HPMCOUNTER15)
+DECLARE_CSR(hpmcounter16, CSR_HPMCOUNTER16)
+DECLARE_CSR(hpmcounter17, CSR_HPMCOUNTER17)
+DECLARE_CSR(hpmcounter18, CSR_HPMCOUNTER18)
+DECLARE_CSR(hpmcounter19, CSR_HPMCOUNTER19)
+DECLARE_CSR(hpmcounter20, CSR_HPMCOUNTER20)
+DECLARE_CSR(hpmcounter21, CSR_HPMCOUNTER21)
+DECLARE_CSR(hpmcounter22, CSR_HPMCOUNTER22)
+DECLARE_CSR(hpmcounter23, CSR_HPMCOUNTER23)
+DECLARE_CSR(hpmcounter24, CSR_HPMCOUNTER24)
+DECLARE_CSR(hpmcounter25, CSR_HPMCOUNTER25)
+DECLARE_CSR(hpmcounter26, CSR_HPMCOUNTER26)
+DECLARE_CSR(hpmcounter27, CSR_HPMCOUNTER27)
+DECLARE_CSR(hpmcounter28, CSR_HPMCOUNTER28)
+DECLARE_CSR(hpmcounter29, CSR_HPMCOUNTER29)
+DECLARE_CSR(hpmcounter30, CSR_HPMCOUNTER30)
+DECLARE_CSR(hpmcounter31, CSR_HPMCOUNTER31)
+DECLARE_CSR(sstatus, CSR_SSTATUS)
+DECLARE_CSR(sie, CSR_SIE)
+DECLARE_CSR(stvec, CSR_STVEC)
+DECLARE_CSR(sscratch, CSR_SSCRATCH)
+DECLARE_CSR(sepc, CSR_SEPC)
+DECLARE_CSR(scause, CSR_SCAUSE)
+DECLARE_CSR(sbadaddr, CSR_SBADADDR)
+DECLARE_CSR(sip, CSR_SIP)
+DECLARE_CSR(sptbr, CSR_SPTBR)
+DECLARE_CSR(mstatus, CSR_MSTATUS)
+DECLARE_CSR(misa, CSR_MISA)
+DECLARE_CSR(medeleg, CSR_MEDELEG)
+DECLARE_CSR(mideleg, CSR_MIDELEG)
+DECLARE_CSR(mie, CSR_MIE)
+DECLARE_CSR(mtvec, CSR_MTVEC)
+DECLARE_CSR(mscratch, CSR_MSCRATCH)
+DECLARE_CSR(mepc, CSR_MEPC)
+DECLARE_CSR(mcause, CSR_MCAUSE)
+DECLARE_CSR(mbadaddr, CSR_MBADADDR)
+DECLARE_CSR(mip, CSR_MIP)
+DECLARE_CSR(tselect, CSR_TSELECT)
+DECLARE_CSR(tdata1, CSR_TDATA1)
+DECLARE_CSR(tdata2, CSR_TDATA2)
+DECLARE_CSR(tdata3, CSR_TDATA3)
+DECLARE_CSR(dcsr, CSR_DCSR)
+DECLARE_CSR(dpc, CSR_DPC)
+DECLARE_CSR(dscratch, CSR_DSCRATCH)
+DECLARE_CSR(mcycle, CSR_MCYCLE)
+DECLARE_CSR(minstret, CSR_MINSTRET)
+DECLARE_CSR(mhpmcounter3, CSR_MHPMCOUNTER3)
+DECLARE_CSR(mhpmcounter4, CSR_MHPMCOUNTER4)
+DECLARE_CSR(mhpmcounter5, CSR_MHPMCOUNTER5)
+DECLARE_CSR(mhpmcounter6, CSR_MHPMCOUNTER6)
+DECLARE_CSR(mhpmcounter7, CSR_MHPMCOUNTER7)
+DECLARE_CSR(mhpmcounter8, CSR_MHPMCOUNTER8)
+DECLARE_CSR(mhpmcounter9, CSR_MHPMCOUNTER9)
+DECLARE_CSR(mhpmcounter10, CSR_MHPMCOUNTER10)
+DECLARE_CSR(mhpmcounter11, CSR_MHPMCOUNTER11)
+DECLARE_CSR(mhpmcounter12, CSR_MHPMCOUNTER12)
+DECLARE_CSR(mhpmcounter13, CSR_MHPMCOUNTER13)
+DECLARE_CSR(mhpmcounter14, CSR_MHPMCOUNTER14)
+DECLARE_CSR(mhpmcounter15, CSR_MHPMCOUNTER15)
+DECLARE_CSR(mhpmcounter16, CSR_MHPMCOUNTER16)
+DECLARE_CSR(mhpmcounter17, CSR_MHPMCOUNTER17)
+DECLARE_CSR(mhpmcounter18, CSR_MHPMCOUNTER18)
+DECLARE_CSR(mhpmcounter19, CSR_MHPMCOUNTER19)
+DECLARE_CSR(mhpmcounter20, CSR_MHPMCOUNTER20)
+DECLARE_CSR(mhpmcounter21, CSR_MHPMCOUNTER21)
+DECLARE_CSR(mhpmcounter22, CSR_MHPMCOUNTER22)
+DECLARE_CSR(mhpmcounter23, CSR_MHPMCOUNTER23)
+DECLARE_CSR(mhpmcounter24, CSR_MHPMCOUNTER24)
+DECLARE_CSR(mhpmcounter25, CSR_MHPMCOUNTER25)
+DECLARE_CSR(mhpmcounter26, CSR_MHPMCOUNTER26)
+DECLARE_CSR(mhpmcounter27, CSR_MHPMCOUNTER27)
+DECLARE_CSR(mhpmcounter28, CSR_MHPMCOUNTER28)
+DECLARE_CSR(mhpmcounter29, CSR_MHPMCOUNTER29)
+DECLARE_CSR(mhpmcounter30, CSR_MHPMCOUNTER30)
+DECLARE_CSR(mhpmcounter31, CSR_MHPMCOUNTER31)
+DECLARE_CSR(mucounteren, CSR_MUCOUNTEREN)
+DECLARE_CSR(mscounteren, CSR_MSCOUNTEREN)
+DECLARE_CSR(mhpmevent3, CSR_MHPMEVENT3)
+DECLARE_CSR(mhpmevent4, CSR_MHPMEVENT4)
+DECLARE_CSR(mhpmevent5, CSR_MHPMEVENT5)
+DECLARE_CSR(mhpmevent6, CSR_MHPMEVENT6)
+DECLARE_CSR(mhpmevent7, CSR_MHPMEVENT7)
+DECLARE_CSR(mhpmevent8, CSR_MHPMEVENT8)
+DECLARE_CSR(mhpmevent9, CSR_MHPMEVENT9)
+DECLARE_CSR(mhpmevent10, CSR_MHPMEVENT10)
+DECLARE_CSR(mhpmevent11, CSR_MHPMEVENT11)
+DECLARE_CSR(mhpmevent12, CSR_MHPMEVENT12)
+DECLARE_CSR(mhpmevent13, CSR_MHPMEVENT13)
+DECLARE_CSR(mhpmevent14, CSR_MHPMEVENT14)
+DECLARE_CSR(mhpmevent15, CSR_MHPMEVENT15)
+DECLARE_CSR(mhpmevent16, CSR_MHPMEVENT16)
+DECLARE_CSR(mhpmevent17, CSR_MHPMEVENT17)
+DECLARE_CSR(mhpmevent18, CSR_MHPMEVENT18)
+DECLARE_CSR(mhpmevent19, CSR_MHPMEVENT19)
+DECLARE_CSR(mhpmevent20, CSR_MHPMEVENT20)
+DECLARE_CSR(mhpmevent21, CSR_MHPMEVENT21)
+DECLARE_CSR(mhpmevent22, CSR_MHPMEVENT22)
+DECLARE_CSR(mhpmevent23, CSR_MHPMEVENT23)
+DECLARE_CSR(mhpmevent24, CSR_MHPMEVENT24)
+DECLARE_CSR(mhpmevent25, CSR_MHPMEVENT25)
+DECLARE_CSR(mhpmevent26, CSR_MHPMEVENT26)
+DECLARE_CSR(mhpmevent27, CSR_MHPMEVENT27)
+DECLARE_CSR(mhpmevent28, CSR_MHPMEVENT28)
+DECLARE_CSR(mhpmevent29, CSR_MHPMEVENT29)
+DECLARE_CSR(mhpmevent30, CSR_MHPMEVENT30)
+DECLARE_CSR(mhpmevent31, CSR_MHPMEVENT31)
+DECLARE_CSR(mvendorid, CSR_MVENDORID)
+DECLARE_CSR(marchid, CSR_MARCHID)
+DECLARE_CSR(mimpid, CSR_MIMPID)
+DECLARE_CSR(mhartid, CSR_MHARTID)
+DECLARE_CSR(cycleh, CSR_CYCLEH)
+DECLARE_CSR(timeh, CSR_TIMEH)
+DECLARE_CSR(instreth, CSR_INSTRETH)
+DECLARE_CSR(hpmcounter3h, CSR_HPMCOUNTER3H)
+DECLARE_CSR(hpmcounter4h, CSR_HPMCOUNTER4H)
+DECLARE_CSR(hpmcounter5h, CSR_HPMCOUNTER5H)
+DECLARE_CSR(hpmcounter6h, CSR_HPMCOUNTER6H)
+DECLARE_CSR(hpmcounter7h, CSR_HPMCOUNTER7H)
+DECLARE_CSR(hpmcounter8h, CSR_HPMCOUNTER8H)
+DECLARE_CSR(hpmcounter9h, CSR_HPMCOUNTER9H)
+DECLARE_CSR(hpmcounter10h, CSR_HPMCOUNTER10H)
+DECLARE_CSR(hpmcounter11h, CSR_HPMCOUNTER11H)
+DECLARE_CSR(hpmcounter12h, CSR_HPMCOUNTER12H)
+DECLARE_CSR(hpmcounter13h, CSR_HPMCOUNTER13H)
+DECLARE_CSR(hpmcounter14h, CSR_HPMCOUNTER14H)
+DECLARE_CSR(hpmcounter15h, CSR_HPMCOUNTER15H)
+DECLARE_CSR(hpmcounter16h, CSR_HPMCOUNTER16H)
+DECLARE_CSR(hpmcounter17h, CSR_HPMCOUNTER17H)
+DECLARE_CSR(hpmcounter18h, CSR_HPMCOUNTER18H)
+DECLARE_CSR(hpmcounter19h, CSR_HPMCOUNTER19H)
+DECLARE_CSR(hpmcounter20h, CSR_HPMCOUNTER20H)
+DECLARE_CSR(hpmcounter21h, CSR_HPMCOUNTER21H)
+DECLARE_CSR(hpmcounter22h, CSR_HPMCOUNTER22H)
+DECLARE_CSR(hpmcounter23h, CSR_HPMCOUNTER23H)
+DECLARE_CSR(hpmcounter24h, CSR_HPMCOUNTER24H)
+DECLARE_CSR(hpmcounter25h, CSR_HPMCOUNTER25H)
+DECLARE_CSR(hpmcounter26h, CSR_HPMCOUNTER26H)
+DECLARE_CSR(hpmcounter27h, CSR_HPMCOUNTER27H)
+DECLARE_CSR(hpmcounter28h, CSR_HPMCOUNTER28H)
+DECLARE_CSR(hpmcounter29h, CSR_HPMCOUNTER29H)
+DECLARE_CSR(hpmcounter30h, CSR_HPMCOUNTER30H)
+DECLARE_CSR(hpmcounter31h, CSR_HPMCOUNTER31H)
+DECLARE_CSR(mcycleh, CSR_MCYCLEH)
+DECLARE_CSR(minstreth, CSR_MINSTRETH)
+DECLARE_CSR(mhpmcounter3h, CSR_MHPMCOUNTER3H)
+DECLARE_CSR(mhpmcounter4h, CSR_MHPMCOUNTER4H)
+DECLARE_CSR(mhpmcounter5h, CSR_MHPMCOUNTER5H)
+DECLARE_CSR(mhpmcounter6h, CSR_MHPMCOUNTER6H)
+DECLARE_CSR(mhpmcounter7h, CSR_MHPMCOUNTER7H)
+DECLARE_CSR(mhpmcounter8h, CSR_MHPMCOUNTER8H)
+DECLARE_CSR(mhpmcounter9h, CSR_MHPMCOUNTER9H)
+DECLARE_CSR(mhpmcounter10h, CSR_MHPMCOUNTER10H)
+DECLARE_CSR(mhpmcounter11h, CSR_MHPMCOUNTER11H)
+DECLARE_CSR(mhpmcounter12h, CSR_MHPMCOUNTER12H)
+DECLARE_CSR(mhpmcounter13h, CSR_MHPMCOUNTER13H)
+DECLARE_CSR(mhpmcounter14h, CSR_MHPMCOUNTER14H)
+DECLARE_CSR(mhpmcounter15h, CSR_MHPMCOUNTER15H)
+DECLARE_CSR(mhpmcounter16h, CSR_MHPMCOUNTER16H)
+DECLARE_CSR(mhpmcounter17h, CSR_MHPMCOUNTER17H)
+DECLARE_CSR(mhpmcounter18h, CSR_MHPMCOUNTER18H)
+DECLARE_CSR(mhpmcounter19h, CSR_MHPMCOUNTER19H)
+DECLARE_CSR(mhpmcounter20h, CSR_MHPMCOUNTER20H)
+DECLARE_CSR(mhpmcounter21h, CSR_MHPMCOUNTER21H)
+DECLARE_CSR(mhpmcounter22h, CSR_MHPMCOUNTER22H)
+DECLARE_CSR(mhpmcounter23h, CSR_MHPMCOUNTER23H)
+DECLARE_CSR(mhpmcounter24h, CSR_MHPMCOUNTER24H)
+DECLARE_CSR(mhpmcounter25h, CSR_MHPMCOUNTER25H)
+DECLARE_CSR(mhpmcounter26h, CSR_MHPMCOUNTER26H)
+DECLARE_CSR(mhpmcounter27h, CSR_MHPMCOUNTER27H)
+DECLARE_CSR(mhpmcounter28h, CSR_MHPMCOUNTER28H)
+DECLARE_CSR(mhpmcounter29h, CSR_MHPMCOUNTER29H)
+DECLARE_CSR(mhpmcounter30h, CSR_MHPMCOUNTER30H)
+DECLARE_CSR(mhpmcounter31h, CSR_MHPMCOUNTER31H)
+#endif
+#if defined(DECLARE_CAUSE)
+DECLARE_CAUSE("misaligned fetch", CAUSE_MISALIGNED_FETCH)
+DECLARE_CAUSE("fault fetch", CAUSE_FAULT_FETCH)
+DECLARE_CAUSE("illegal instruction", CAUSE_ILLEGAL_INSTRUCTION)
+DECLARE_CAUSE("breakpoint", CAUSE_BREAKPOINT)
+DECLARE_CAUSE("misaligned load", CAUSE_MISALIGNED_LOAD)
+DECLARE_CAUSE("fault load", CAUSE_FAULT_LOAD)
+DECLARE_CAUSE("misaligned store", CAUSE_MISALIGNED_STORE)
+DECLARE_CAUSE("fault store", CAUSE_FAULT_STORE)
+DECLARE_CAUSE("user_ecall", CAUSE_USER_ECALL)
+DECLARE_CAUSE("supervisor_ecall", CAUSE_SUPERVISOR_ECALL)
+DECLARE_CAUSE("hypervisor_ecall", CAUSE_HYPERVISOR_ECALL)
+DECLARE_CAUSE("machine_ecall", CAUSE_MACHINE_ECALL)
+#endif
+
+#endif /* if 0 */
+
diff --git a/plat/kendryte/k210/sysctl.c b/plat/kendryte/k210/sysctl.c
new file mode 100644 (file)
index 0000000..c19859d
--- /dev/null
@@ -0,0 +1,1784 @@
+/* Copyright 2018 Canaan Inc.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+#include <sbi/riscv_encoding.h>
+#include <math.h>
+#include "sysctl.h"
+
+#define SYSCTRL_CLOCK_FREQ_IN0 (26000000UL)
+
+const u8 get_select_pll2[] = {
+       [SYSCTL_SOURCE_IN0] = 0,
+       [SYSCTL_SOURCE_PLL0] = 1,
+       [SYSCTL_SOURCE_PLL1] = 2,
+};
+
+const u8 get_source_pll2[] = {
+       [0] = SYSCTL_SOURCE_IN0,
+       [1] = SYSCTL_SOURCE_PLL0,
+       [2] = SYSCTL_SOURCE_PLL1,
+};
+
+const u8 get_select_aclk[] = {
+       [SYSCTL_SOURCE_IN0] = 0,
+       [SYSCTL_SOURCE_PLL0] = 1,
+};
+
+const u8 get_source_aclk[] = {
+       [0] = SYSCTL_SOURCE_IN0,
+       [1] = SYSCTL_SOURCE_PLL0,
+};
+
+volatile sysctl_t *const sysctl = (volatile sysctl_t *)SYSCTL_BASE_ADDR;
+
+u32 sysctl_get_git_id(void)
+{
+       return sysctl->git_id.git_id;
+}
+
+u32 sysctl_get_freq(void)
+{
+       return sysctl->clk_freq.clk_freq;
+}
+
+static void sysctl_reset_ctl(sysctl_reset_t reset, u8 rst_value)
+{
+       switch (reset) {
+       case SYSCTL_RESET_SOC:
+               sysctl->soft_reset.soft_reset = rst_value;
+               break;
+       case SYSCTL_RESET_ROM:
+               sysctl->peri_reset.rom_reset = rst_value;
+               break;
+       case SYSCTL_RESET_DMA:
+               sysctl->peri_reset.dma_reset = rst_value;
+               break;
+       case SYSCTL_RESET_AI:
+               sysctl->peri_reset.ai_reset = rst_value;
+               break;
+       case SYSCTL_RESET_DVP:
+               sysctl->peri_reset.dvp_reset = rst_value;
+               break;
+       case SYSCTL_RESET_FFT:
+               sysctl->peri_reset.fft_reset = rst_value;
+               break;
+       case SYSCTL_RESET_GPIO:
+               sysctl->peri_reset.gpio_reset = rst_value;
+               break;
+       case SYSCTL_RESET_SPI0:
+               sysctl->peri_reset.spi0_reset = rst_value;
+               break;
+       case SYSCTL_RESET_SPI1:
+               sysctl->peri_reset.spi1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_SPI2:
+               sysctl->peri_reset.spi2_reset = rst_value;
+               break;
+       case SYSCTL_RESET_SPI3:
+               sysctl->peri_reset.spi3_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2S0:
+               sysctl->peri_reset.i2s0_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2S1:
+               sysctl->peri_reset.i2s1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2S2:
+               sysctl->peri_reset.i2s2_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2C0:
+               sysctl->peri_reset.i2c0_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2C1:
+               sysctl->peri_reset.i2c1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_I2C2:
+               sysctl->peri_reset.i2c2_reset = rst_value;
+               break;
+       case SYSCTL_RESET_UART1:
+               sysctl->peri_reset.uart1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_UART2:
+               sysctl->peri_reset.uart2_reset = rst_value;
+               break;
+       case SYSCTL_RESET_UART3:
+               sysctl->peri_reset.uart3_reset = rst_value;
+               break;
+       case SYSCTL_RESET_AES:
+               sysctl->peri_reset.aes_reset = rst_value;
+               break;
+       case SYSCTL_RESET_FPIOA:
+               sysctl->peri_reset.fpioa_reset = rst_value;
+               break;
+       case SYSCTL_RESET_TIMER0:
+               sysctl->peri_reset.timer0_reset = rst_value;
+               break;
+       case SYSCTL_RESET_TIMER1:
+               sysctl->peri_reset.timer1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_TIMER2:
+               sysctl->peri_reset.timer2_reset = rst_value;
+               break;
+       case SYSCTL_RESET_WDT0:
+               sysctl->peri_reset.wdt0_reset = rst_value;
+               break;
+       case SYSCTL_RESET_WDT1:
+               sysctl->peri_reset.wdt1_reset = rst_value;
+               break;
+       case SYSCTL_RESET_SHA:
+               sysctl->peri_reset.sha_reset = rst_value;
+               break;
+       case SYSCTL_RESET_RTC:
+               sysctl->peri_reset.rtc_reset = rst_value;
+               break;
+
+       default:
+               break;
+       }
+}
+
+void sysctl_reset(sysctl_reset_t reset)
+{
+       sysctl_reset_ctl(reset, 1);
+       sysctl_reset_ctl(reset, 0);
+}
+
+static int sysctl_clock_bus_en(sysctl_clock_t clock, u8 en)
+{
+       /*
+        * The timer is under APB0, to prevent apb0_clk_en1 and apb0_clk_en0
+        * on same register, we split it to peripheral and central two
+        * registers, to protect CPU close apb0 clock accidentally.
+        *
+        * The apb0_clk_en0 and apb0_clk_en1 have same function,
+        * one of them set, the APB0 clock enable.
+        */
+
+       /* The APB clock should carefully disable */
+       if (en) {
+               switch (clock) {
+               /*
+                * These peripheral devices are under APB0
+                * GPIO, UART1, UART2, UART3, SPI_SLAVE, I2S0, I2S1,
+                * I2S2, I2C0, I2C1, I2C2, FPIOA, SHA256, TIMER0,
+                * TIMER1, TIMER2
+                */
+               case SYSCTL_CLOCK_GPIO:
+               case SYSCTL_CLOCK_SPI2:
+               case SYSCTL_CLOCK_I2S0:
+               case SYSCTL_CLOCK_I2S1:
+               case SYSCTL_CLOCK_I2S2:
+               case SYSCTL_CLOCK_I2C0:
+               case SYSCTL_CLOCK_I2C1:
+               case SYSCTL_CLOCK_I2C2:
+               case SYSCTL_CLOCK_UART1:
+               case SYSCTL_CLOCK_UART2:
+               case SYSCTL_CLOCK_UART3:
+               case SYSCTL_CLOCK_FPIOA:
+               case SYSCTL_CLOCK_TIMER0:
+               case SYSCTL_CLOCK_TIMER1:
+               case SYSCTL_CLOCK_TIMER2:
+               case SYSCTL_CLOCK_SHA:
+                       sysctl->clk_en_cent.apb0_clk_en = en;
+                       break;
+
+               /*
+                * These peripheral devices are under APB1
+                * WDT, AES, OTP, DVP, SYSCTL
+                */
+               case SYSCTL_CLOCK_AES:
+               case SYSCTL_CLOCK_WDT0:
+               case SYSCTL_CLOCK_WDT1:
+               case SYSCTL_CLOCK_OTP:
+               case SYSCTL_CLOCK_RTC:
+                       sysctl->clk_en_cent.apb1_clk_en = en;
+                       break;
+
+               /*
+                * These peripheral devices are under APB2
+                * SPI0, SPI1
+                */
+               case SYSCTL_CLOCK_SPI0:
+               case SYSCTL_CLOCK_SPI1:
+                       sysctl->clk_en_cent.apb2_clk_en = en;
+                       break;
+
+               default:
+                       break;
+               }
+       }
+
+       return 0;
+}
+
+static int sysctl_clock_device_en(sysctl_clock_t clock, u8 en)
+{
+       switch (clock) {
+       /*
+        * These devices are PLL
+        */
+       case SYSCTL_CLOCK_PLL0:
+               sysctl->pll0.pll_out_en0 = en;
+               break;
+       case SYSCTL_CLOCK_PLL1:
+               sysctl->pll1.pll_out_en1 = en;
+               break;
+       case SYSCTL_CLOCK_PLL2:
+               sysctl->pll2.pll_out_en2 = en;
+               break;
+
+       /*
+        * These devices are CPU, SRAM, APB bus, ROM, DMA, AI
+        */
+       case SYSCTL_CLOCK_CPU:
+               sysctl->clk_en_cent.cpu_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SRAM0:
+               sysctl->clk_en_cent.sram0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SRAM1:
+               sysctl->clk_en_cent.sram1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_APB0:
+               sysctl->clk_en_cent.apb0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_APB1:
+               sysctl->clk_en_cent.apb1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_APB2:
+               sysctl->clk_en_cent.apb2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_ROM:
+               sysctl->clk_en_peri.rom_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_DMA:
+               sysctl->clk_en_peri.dma_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_AI:
+               sysctl->clk_en_peri.ai_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_DVP:
+               sysctl->clk_en_peri.dvp_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_FFT:
+               sysctl->clk_en_peri.fft_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SPI3:
+               sysctl->clk_en_peri.spi3_clk_en = en;
+               break;
+
+       /*
+        * These peripheral devices are under APB0
+        * GPIO, UART1, UART2, UART3, SPI_SLAVE, I2S0, I2S1,
+        * I2S2, I2C0, I2C1, I2C2, FPIOA, SHA256, TIMER0,
+        * TIMER1, TIMER2
+        */
+       case SYSCTL_CLOCK_GPIO:
+               sysctl->clk_en_peri.gpio_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SPI2:
+               sysctl->clk_en_peri.spi2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2S0:
+               sysctl->clk_en_peri.i2s0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2S1:
+               sysctl->clk_en_peri.i2s1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2S2:
+               sysctl->clk_en_peri.i2s2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2C0:
+               sysctl->clk_en_peri.i2c0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2C1:
+               sysctl->clk_en_peri.i2c1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_I2C2:
+               sysctl->clk_en_peri.i2c2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_UART1:
+               sysctl->clk_en_peri.uart1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_UART2:
+               sysctl->clk_en_peri.uart2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_UART3:
+               sysctl->clk_en_peri.uart3_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_FPIOA:
+               sysctl->clk_en_peri.fpioa_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_TIMER0:
+               sysctl->clk_en_peri.timer0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_TIMER1:
+               sysctl->clk_en_peri.timer1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_TIMER2:
+               sysctl->clk_en_peri.timer2_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SHA:
+               sysctl->clk_en_peri.sha_clk_en = en;
+               break;
+
+       /*
+        * These peripheral devices are under APB1
+        * WDT, AES, OTP, DVP, SYSCTL
+        */
+       case SYSCTL_CLOCK_AES:
+               sysctl->clk_en_peri.aes_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_WDT0:
+               sysctl->clk_en_peri.wdt0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_WDT1:
+               sysctl->clk_en_peri.wdt1_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_OTP:
+               sysctl->clk_en_peri.otp_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_RTC:
+               sysctl->clk_en_peri.rtc_clk_en = en;
+               break;
+
+       /*
+        * These peripheral devices are under APB2
+        * SPI0, SPI1
+        */
+       case SYSCTL_CLOCK_SPI0:
+               sysctl->clk_en_peri.spi0_clk_en = en;
+               break;
+       case SYSCTL_CLOCK_SPI1:
+               sysctl->clk_en_peri.spi1_clk_en = en;
+               break;
+
+       default:
+               break;
+       }
+
+       return 0;
+}
+
+int sysctl_clock_enable(sysctl_clock_t clock)
+{
+       if (clock >= SYSCTL_CLOCK_MAX)
+               return -1;
+
+       sysctl_clock_bus_en(clock, 1);
+       sysctl_clock_device_en(clock, 1);
+
+       return 0;
+}
+
+int sysctl_clock_disable(sysctl_clock_t clock)
+{
+       if (clock >= SYSCTL_CLOCK_MAX)
+               return -1;
+
+       sysctl_clock_bus_en(clock, 0);
+       sysctl_clock_device_en(clock, 0);
+
+       return 0;
+}
+
+int sysctl_clock_set_threshold(sysctl_threshold_t which, int threshold)
+{
+       int result = 0;
+
+       switch (which) {
+       /*
+        * These threshold is 2 bit width
+        */
+       case SYSCTL_THRESHOLD_ACLK:
+               sysctl->clk_sel0.aclk_divider_sel = (u8)threshold & 0x03;
+               break;
+
+       /*
+        * These threshold is 3 bit width
+        */
+       case SYSCTL_THRESHOLD_APB0:
+               sysctl->clk_sel0.apb0_clk_sel = (u8)threshold & 0x07;
+               break;
+       case SYSCTL_THRESHOLD_APB1:
+               sysctl->clk_sel0.apb1_clk_sel = (u8)threshold & 0x07;
+               break;
+       case SYSCTL_THRESHOLD_APB2:
+               sysctl->clk_sel0.apb2_clk_sel = (u8)threshold & 0x07;
+               break;
+
+       /*
+        * These threshold is 4 bit width
+        */
+       case SYSCTL_THRESHOLD_SRAM0:
+               sysctl->clk_th0.sram0_gclk_threshold = (u8)threshold & 0x0F;
+               break;
+       case SYSCTL_THRESHOLD_SRAM1:
+               sysctl->clk_th0.sram1_gclk_threshold = (u8)threshold & 0x0F;
+               break;
+       case SYSCTL_THRESHOLD_AI:
+               sysctl->clk_th0.ai_gclk_threshold = (u8)threshold & 0x0F;
+               break;
+       case SYSCTL_THRESHOLD_DVP:
+               sysctl->clk_th0.dvp_gclk_threshold = (u8)threshold & 0x0F;
+               break;
+       case SYSCTL_THRESHOLD_ROM:
+               sysctl->clk_th0.rom_gclk_threshold = (u8)threshold & 0x0F;
+               break;
+
+       /*
+        * These threshold is 8 bit width
+        */
+       case SYSCTL_THRESHOLD_SPI0:
+               sysctl->clk_th1.spi0_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI1:
+               sysctl->clk_th1.spi1_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI2:
+               sysctl->clk_th1.spi2_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI3:
+               sysctl->clk_th1.spi3_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER0:
+               sysctl->clk_th2.timer0_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER1:
+               sysctl->clk_th2.timer1_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER2:
+               sysctl->clk_th2.timer2_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S0_M:
+               sysctl->clk_th4.i2s0_mclk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S1_M:
+               sysctl->clk_th4.i2s1_mclk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S2_M:
+               sysctl->clk_th5.i2s2_mclk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C0:
+               sysctl->clk_th5.i2c0_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C1:
+               sysctl->clk_th5.i2c1_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C2:
+               sysctl->clk_th5.i2c2_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_WDT0:
+               sysctl->clk_th6.wdt0_clk_threshold = (u8)threshold;
+               break;
+       case SYSCTL_THRESHOLD_WDT1:
+               sysctl->clk_th6.wdt1_clk_threshold = (u8)threshold;
+               break;
+
+       /*
+        * These threshold is 16 bit width
+        */
+       case SYSCTL_THRESHOLD_I2S0:
+               sysctl->clk_th3.i2s0_clk_threshold = (u16)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S1:
+               sysctl->clk_th3.i2s1_clk_threshold = (u16)threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S2:
+               sysctl->clk_th4.i2s2_clk_threshold = (u16)threshold;
+               break;
+
+       default:
+               result = -1;
+               break;
+       }
+
+       return result;
+}
+
+int sysctl_clock_get_threshold(sysctl_threshold_t which)
+{
+       int threshold = 0;
+
+       switch (which) {
+       /*
+        * Select and get threshold value
+        */
+       case SYSCTL_THRESHOLD_ACLK:
+               threshold = (int)sysctl->clk_sel0.aclk_divider_sel;
+               break;
+       case SYSCTL_THRESHOLD_APB0:
+               threshold = (int)sysctl->clk_sel0.apb0_clk_sel;
+               break;
+       case SYSCTL_THRESHOLD_APB1:
+               threshold = (int)sysctl->clk_sel0.apb1_clk_sel;
+               break;
+       case SYSCTL_THRESHOLD_APB2:
+               threshold = (int)sysctl->clk_sel0.apb2_clk_sel;
+               break;
+       case SYSCTL_THRESHOLD_SRAM0:
+               threshold = (int)sysctl->clk_th0.sram0_gclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_SRAM1:
+               threshold = (int)sysctl->clk_th0.sram1_gclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_AI:
+               threshold = (int)sysctl->clk_th0.ai_gclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_DVP:
+               threshold = (int)sysctl->clk_th0.dvp_gclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_ROM:
+               threshold = (int)sysctl->clk_th0.rom_gclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI0:
+               threshold = (int)sysctl->clk_th1.spi0_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI1:
+               threshold = (int)sysctl->clk_th1.spi1_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI2:
+               threshold = (int)sysctl->clk_th1.spi2_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_SPI3:
+               threshold = (int)sysctl->clk_th1.spi3_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER0:
+               threshold = (int)sysctl->clk_th2.timer0_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER1:
+               threshold = (int)sysctl->clk_th2.timer1_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_TIMER2:
+               threshold = (int)sysctl->clk_th2.timer2_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S0:
+               threshold = (int)sysctl->clk_th3.i2s0_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S1:
+               threshold = (int)sysctl->clk_th3.i2s1_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S2:
+               threshold = (int)sysctl->clk_th4.i2s2_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S0_M:
+               threshold = (int)sysctl->clk_th4.i2s0_mclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S1_M:
+               threshold = (int)sysctl->clk_th4.i2s1_mclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2S2_M:
+               threshold = (int)sysctl->clk_th5.i2s2_mclk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C0:
+               threshold = (int)sysctl->clk_th5.i2c0_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C1:
+               threshold = (int)sysctl->clk_th5.i2c1_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_I2C2:
+               threshold = (int)sysctl->clk_th5.i2c2_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_WDT0:
+               threshold = (int)sysctl->clk_th6.wdt0_clk_threshold;
+               break;
+       case SYSCTL_THRESHOLD_WDT1:
+               threshold = (int)sysctl->clk_th6.wdt1_clk_threshold;
+               break;
+
+       default:
+               break;
+       }
+
+       return threshold;
+}
+
+int sysctl_clock_set_clock_select(sysctl_clock_select_t which, int select)
+{
+       int result = 0;
+
+       switch (which) {
+       /*
+        * These clock select is 1 bit width
+        */
+       case SYSCTL_CLOCK_SELECT_PLL0_BYPASS:
+               sysctl->pll0.pll_bypass0 = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_PLL1_BYPASS:
+               sysctl->pll1.pll_bypass1 = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_PLL2_BYPASS:
+               sysctl->pll2.pll_bypass2 = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_ACLK:
+               sysctl->clk_sel0.aclk_sel = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_SPI3:
+               sysctl->clk_sel0.spi3_clk_sel = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER0:
+               sysctl->clk_sel0.timer0_clk_sel = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER1:
+               sysctl->clk_sel0.timer1_clk_sel = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER2:
+               sysctl->clk_sel0.timer2_clk_sel = select & 0x01;
+               break;
+       case SYSCTL_CLOCK_SELECT_SPI3_SAMPLE:
+               sysctl->clk_sel1.spi3_sample_clk_sel = select & 0x01;
+               break;
+
+       /*
+        * These clock select is 2 bit width
+        */
+       case SYSCTL_CLOCK_SELECT_PLL2:
+               sysctl->pll2.pll_ckin_sel2 = select & 0x03;
+               break;
+
+       default:
+               result = -1;
+               break;
+       }
+
+       return result;
+}
+
+int sysctl_clock_get_clock_select(sysctl_clock_select_t which)
+{
+       int clock_select = 0;
+
+       switch (which) {
+       /*
+        * Select and get clock select value
+        */
+       case SYSCTL_CLOCK_SELECT_PLL0_BYPASS:
+               clock_select = (int)sysctl->pll0.pll_bypass0;
+               break;
+       case SYSCTL_CLOCK_SELECT_PLL1_BYPASS:
+               clock_select = (int)sysctl->pll1.pll_bypass1;
+               break;
+       case SYSCTL_CLOCK_SELECT_PLL2_BYPASS:
+               clock_select = (int)sysctl->pll2.pll_bypass2;
+               break;
+       case SYSCTL_CLOCK_SELECT_PLL2:
+               clock_select = (int)sysctl->pll2.pll_ckin_sel2;
+               break;
+       case SYSCTL_CLOCK_SELECT_ACLK:
+               clock_select = (int)sysctl->clk_sel0.aclk_sel;
+               break;
+       case SYSCTL_CLOCK_SELECT_SPI3:
+               clock_select = (int)sysctl->clk_sel0.spi3_clk_sel;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER0:
+               clock_select = (int)sysctl->clk_sel0.timer0_clk_sel;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER1:
+               clock_select = (int)sysctl->clk_sel0.timer1_clk_sel;
+               break;
+       case SYSCTL_CLOCK_SELECT_TIMER2:
+               clock_select = (int)sysctl->clk_sel0.timer2_clk_sel;
+               break;
+       case SYSCTL_CLOCK_SELECT_SPI3_SAMPLE:
+               clock_select = (int)sysctl->clk_sel1.spi3_sample_clk_sel;
+               break;
+
+       default:
+               break;
+       }
+
+       return clock_select;
+}
+
+u32 sysctl_clock_source_get_freq(sysctl_clock_source_t input)
+{
+       u32 result;
+
+       switch (input) {
+       case SYSCTL_SOURCE_IN0:
+               result = SYSCTRL_CLOCK_FREQ_IN0;
+               break;
+       case SYSCTL_SOURCE_PLL0:
+               result = sysctl_pll_get_freq(SYSCTL_PLL0);
+               break;
+       case SYSCTL_SOURCE_PLL1:
+               result = sysctl_pll_get_freq(SYSCTL_PLL1);
+               break;
+       case SYSCTL_SOURCE_PLL2:
+               result = sysctl_pll_get_freq(SYSCTL_PLL2);
+               break;
+       case SYSCTL_SOURCE_ACLK:
+               result = sysctl_clock_get_freq(SYSCTL_CLOCK_ACLK);
+               break;
+       default:
+               result = 0;
+               break;
+       }
+
+       return result;
+}
+
+static int sysctl_pll_is_lock(sysctl_pll_t pll)
+{
+       /*
+        * All bit enable means PLL lock
+        *
+        * struct pll_lock_t
+        * {
+        *         u8 overflow : 1;
+        *         u8 rfslip : 1;
+        *         u8 fbslip : 1;
+        * };
+        *
+        */
+
+       if (pll >= SYSCTL_PLL_MAX)
+               return 0;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+               return sysctl->pll_lock.pll_lock0 == 3;
+
+       case SYSCTL_PLL1:
+               return sysctl->pll_lock.pll_lock1 & 1;
+
+       case SYSCTL_PLL2:
+               return sysctl->pll_lock.pll_lock2 & 1;
+
+       default:
+               break;
+       }
+
+       return 0;
+}
+
+static int sysctl_pll_clear_slip(sysctl_pll_t pll)
+{
+       if (pll >= SYSCTL_PLL_MAX)
+               return -1;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+               sysctl->pll_lock.pll_slip_clear0 = 1;
+               break;
+
+       case SYSCTL_PLL1:
+               sysctl->pll_lock.pll_slip_clear1 = 1;
+               break;
+
+       case SYSCTL_PLL2:
+               sysctl->pll_lock.pll_slip_clear2 = 1;
+               break;
+
+       default:
+               break;
+       }
+
+       return sysctl_pll_is_lock(pll) ? 0 : -1;
+}
+
+int sysctl_pll_enable(sysctl_pll_t pll)
+{
+       /*
+        *       ---+
+        * PWRDN    |
+        *          +-------------------------------------------------------------
+        *          ^
+        *          |
+        *          |
+        *          t1
+        *                 +------------------+
+        * RESET           |                  |
+        *       ----------+                  +-----------------------------------
+        *                 ^                  ^                              ^
+        *                 |<----- t_rst ---->|<---------- t_lock ---------->|
+        *                 |                  |                              |
+        *                 t2                 t3                             t4
+        */
+
+       if (pll >= SYSCTL_PLL_MAX)
+               return -1;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+               /* Do not bypass PLL */
+               sysctl->pll0.pll_bypass0 = 0;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll0.pll_pwrd0 = 1;
+               /*
+                * Reset trigger of the PLL, connected RESET
+                * 0 is free
+                * 1 is reset
+                */
+               sysctl->pll0.pll_reset0 = 0;
+               sysctl->pll0.pll_reset0 = 1;
+               asm volatile ("nop");
+               asm volatile ("nop");
+               sysctl->pll0.pll_reset0 = 0;
+               break;
+
+       case SYSCTL_PLL1:
+               /* Do not bypass PLL */
+               sysctl->pll1.pll_bypass1 = 0;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll1.pll_pwrd1 = 1;
+               /*
+                * Reset trigger of the PLL, connected RESET
+                * 0 is free
+                * 1 is reset
+                */
+               sysctl->pll1.pll_reset1 = 0;
+               sysctl->pll1.pll_reset1 = 1;
+               asm volatile ("nop");
+               asm volatile ("nop");
+               sysctl->pll1.pll_reset1 = 0;
+               break;
+
+       case SYSCTL_PLL2:
+               /* Do not bypass PLL */
+               sysctl->pll2.pll_bypass2 = 0;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll2.pll_pwrd2 = 1;
+               /*
+                * Reset trigger of the PLL, connected RESET
+                * 0 is free
+                * 1 is reset
+                */
+               sysctl->pll2.pll_reset2 = 0;
+               sysctl->pll2.pll_reset2 = 1;
+               asm volatile ("nop");
+               asm volatile ("nop");
+               sysctl->pll2.pll_reset2 = 0;
+               break;
+
+       default:
+               break;
+       }
+
+       return 0;
+}
+
+int sysctl_pll_disable(sysctl_pll_t pll)
+{
+       if (pll >= SYSCTL_PLL_MAX)
+               return -1;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+               /* Bypass PLL */
+               sysctl->pll0.pll_bypass0 = 1;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll0.pll_pwrd0 = 0;
+               break;
+
+       case SYSCTL_PLL1:
+               /* Bypass PLL */
+               sysctl->pll1.pll_bypass1 = 1;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll1.pll_pwrd1 = 0;
+               break;
+
+       case SYSCTL_PLL2:
+               /* Bypass PLL */
+               sysctl->pll2.pll_bypass2 = 1;
+               /*
+                * Power on the PLL, negtive from PWRDN
+                * 0 is power off
+                * 1 is power on
+                */
+               sysctl->pll2.pll_pwrd2 = 0;
+               break;
+
+       default:
+               break;
+       }
+
+       return 0;
+}
+
+u32 sysctl_pll_get_freq(sysctl_pll_t pll)
+{
+       u32 freq_in = 0;
+       u32 nr = 0, nf = 0, od = 0;
+       u8 select = 0;
+
+       if (pll >= SYSCTL_PLL_MAX)
+               return 0;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+               freq_in = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               nr      = sysctl->pll0.clkr0 + 1;
+               nf      = sysctl->pll0.clkf0 + 1;
+               od      = sysctl->pll0.clkod0 + 1;
+               break;
+
+       case SYSCTL_PLL1:
+               freq_in = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               nr      = sysctl->pll1.clkr1 + 1;
+               nf      = sysctl->pll1.clkf1 + 1;
+               od      = sysctl->pll1.clkod1 + 1;
+               break;
+
+       case SYSCTL_PLL2:
+               /*
+                * Get input freq accroding select register
+                */
+               select = sysctl->pll2.pll_ckin_sel2;
+               if (select < sizeof(get_source_pll2))
+                       freq_in = sysctl_clock_source_get_freq(get_source_pll2[select]);
+               else
+                       return 0;
+
+               nr      = sysctl->pll2.clkr2 + 1;
+               nf      = sysctl->pll2.clkf2 + 1;
+               od      = sysctl->pll2.clkod2 + 1;
+               break;
+
+       default:
+               break;
+       }
+
+       /*
+        * Get final PLL output freq
+        * FOUT = FIN / NR * NF / OD
+        */
+       return (double)freq_in / (double)nr * (double)nf / (double)od;
+}
+
+static u32 sysctl_pll_source_set_freq(sysctl_pll_t pll,
+                                     sysctl_clock_source_t source, u32 freq)
+{
+
+       const double vco_min = 3.5e+08;
+       const double vco_max = 1.75e+09;
+       const double ref_min = 1.36719e+07;
+       const double ref_max = 1.75e+09;
+       const int nr_min     = 1;
+       const int nr_max     = 16;
+       const int nf_min     = 1;
+       const int nf_max     = 64;
+       const int no_min     = 1;
+       const int no_max     = 16;
+       const int nb_min     = 1;
+       const int nb_max     = 64;
+       const int max_vco    = 1;
+       const int ref_rng    = 1;
+       int nr     = 0;
+       int nrx    = 0;
+       int nf     = 0;
+       int nfi    = 0;
+       int no     = 0;
+       int noe    = 0;
+       int not    = 0;
+       int nor    = 0;
+       int nore   = 0;
+       int nb     = 0;
+       int first  = 0;
+       int firstx = 0;
+       int found  = 0;
+       long long nfx = 0;
+       double fin = 0, fout = 0, fvco = 0;
+       double val = 0, nval = 0, err = 0, merr = 0, terr = 0;
+       int x_nrx = 0, x_no = 0, x_nb = 0;
+       long long x_nfx = 0;
+       double x_fvco = 0, x_err = 0;
+       sysctl_pll0_t pll0;
+       sysctl_pll1_t pll1;
+       sysctl_pll2_t pll2;
+       u32 freq_in = 0;
+
+       if (pll >= SYSCTL_PLL_MAX)
+               return 0;
+
+       if (source >= SYSCTL_SOURCE_MAX)
+               return 0;
+
+       switch (pll) {
+       case SYSCTL_PLL0:
+       case SYSCTL_PLL1:
+               /*
+                * Check input clock source
+                */
+               if (source != SYSCTL_SOURCE_IN0)
+                       return 0;
+               freq_in = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               /*
+                * Check input clock freq
+                */
+               if (freq_in == 0)
+                       return 0;
+               break;
+
+       case SYSCTL_PLL2:
+               /*
+                * Check input clock source
+                */
+               if (source < sizeof(get_select_pll2))
+                       freq_in = sysctl_clock_source_get_freq(source);
+               /*
+                * Check input clock freq
+                */
+               if (freq_in == 0)
+                       return 0;
+               break;
+
+       default:
+               return 0;
+       }
+
+       /*
+        * Begin calculate PLL registers' value
+        */
+       fin   = freq_in;
+       fout  = freq;
+       val   = fout / fin;
+       terr  = 0.5 / ((double)(nf_max / 2));
+       first = firstx = 1;
+       if (terr != -2) {
+               first = 0;
+               if (terr == 0)
+                       terr = 1e-16;
+               merr = fabs(terr);
+       }
+       found = 0;
+       for (nfi = val; nfi < nf_max; ++nfi) {
+               nr = rint(((double)nfi) / val);
+               if (nr == 0)
+                       continue;
+               if ((ref_rng) && (nr < nr_min))
+                       continue;
+               if (fin / ((double)nr) > ref_max)
+                       continue;
+               nrx = nr;
+               nf = nfx = nfi;
+               nval = ((double)nfx) / ((double)nr);
+               if (nf == 0)
+                       nf = 1;
+               err = 1 - nval / val;
+
+               if ((first) || (fabs(err) < merr * (1 + 1e-6)) || (fabs(err) < 1e-16)) {
+                       not = floor(vco_max / fout);
+                       for (no = (not > no_max) ? no_max : not; no > no_min; --no) {
+                               if ((ref_rng) && ((nr / no) < nr_min))
+                                       continue;
+                               if ((nr % no) == 0)
+                                       break;
+                       }
+                       if ((nr % no) != 0)
+                               continue;
+                       nor  = ((not > no_max) ? no_max : not) / no;
+                       nore = nf_max / nf;
+                       if (nor > nore)
+                               nor = nore;
+                       noe  = ceil(vco_min / fout);
+                       if (!max_vco) {
+                               nore = (noe - 1) / no + 1;
+                               nor  = nore;
+                               not  = 0; /* force next if to fail */
+                       }
+                       if ((((no * nor) < (not >> 1)) || ((no * nor) < noe)) && ((no * nor) < (nf_max / nf))) {
+                               no = nf_max / nf;
+                               if (no > no_max)
+                                       no = no_max;
+                               if (no > not)
+                                       no = not;
+                               nfx *= no;
+                               nf *= no;
+                               if ((no > 1) && (!firstx))
+                                       continue;
+                               /* wait for larger nf in later iterations */
+                       } else {
+                               nrx /= no;
+                               nfx *= nor;
+                               nf *= nor;
+                               no *= nor;
+                               if (no > no_max)
+                                       continue;
+                               if ((nor > 1) && (!firstx))
+                                       continue;
+                               /* wait for larger nf in later iterations */
+                       }
+
+                       nb = nfx;
+                       if (nb < nb_min)
+                               nb = nb_min;
+                       if (nb > nb_max)
+                               continue;
+
+                       fvco = fin / ((double)nrx) * ((double)nfx);
+                       if (fvco < vco_min)
+                               continue;
+                       if (fvco > vco_max)
+                               continue;
+                       if (nf < nf_min)
+                               continue;
+                       if ((ref_rng) && (fin / ((double)nrx) < ref_min))
+                               continue;
+                       if ((ref_rng) && (nrx > nr_max))
+                               continue;
+                       if (!(((firstx) && (terr < 0)) || (fabs(err) < merr * (1 - 1e-6)) || ((max_vco) && (no > x_no))))
+                               continue;
+                       if ((!firstx) && (terr >= 0) && (nrx > x_nrx))
+                               continue;
+
+                       found  = 1;
+                       x_no   = no;
+                       x_nrx  = nrx;
+                       x_nfx  = nfx;
+                       x_nb   = nb;
+                       x_fvco = fvco;
+                       x_err  = err;
+                       first  = firstx = 0;
+                       merr   = fabs(err);
+                       if (terr != -1)
+                               continue;
+               }
+       }
+
+       if (!found)
+               return 0;
+
+       nrx  = x_nrx;
+       nfx  = x_nfx;
+       no   = x_no;
+       nb   = x_nb;
+       fvco = x_fvco;
+       err  = x_err;
+       if ((terr != -2) && (fabs(err) >= terr * (1 - 1e-6)))
+               return 0;
+
+       /*
+        * Begin write PLL registers' value,
+        * Using atomic write method.
+        */
+       switch (pll) {
+       case SYSCTL_PLL0:
+               /* Read register from bus */
+               pll0 = sysctl->pll0;
+               /* Set register temporary value */
+               pll0.clkr0  = nrx - 1;
+               pll0.clkf0  = nfx - 1;
+               pll0.clkod0 = no - 1;
+               pll0.bwadj0 = nb - 1;
+               /* Write register back to bus */
+               sysctl->pll0 = pll0;
+               break;
+
+       case SYSCTL_PLL1:
+               /* Read register from bus */
+               pll1 = sysctl->pll1;
+               /* Set register temporary value */
+               pll1.clkr1  = nrx - 1;
+               pll1.clkf1  = nfx - 1;
+               pll1.clkod1 = no - 1;
+               pll1.bwadj1 = nb - 1;
+               /* Write register back to bus */
+               sysctl->pll1 = pll1;
+               break;
+
+       case SYSCTL_PLL2:
+               /* Read register from bus */
+               pll2 = sysctl->pll2;
+               /* Set register temporary value */
+               if (source < sizeof(get_select_pll2))
+                       pll2.pll_ckin_sel2 = get_select_pll2[source];
+
+               pll2.clkr2  = nrx - 1;
+               pll2.clkf2  = nfx - 1;
+               pll2.clkod2 = no - 1;
+               pll2.bwadj2 = nb - 1;
+               /* Write register back to bus */
+               sysctl->pll2 = pll2;
+               break;
+
+       default:
+               return 0;
+       }
+
+       return sysctl_pll_get_freq(pll);
+}
+
+u32 sysctl_clock_get_freq(sysctl_clock_t clock)
+{
+       u32 source = 0;
+       u32 result = 0;
+
+       switch (clock) {
+       /*
+        * The clock IN0
+        */
+       case SYSCTL_CLOCK_IN0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               result = source;
+               break;
+
+       /*
+        * These clock directly under PLL clock domain
+        * They are using gated divider.
+        */
+       case SYSCTL_CLOCK_PLL0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_PLL1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL1);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_PLL2:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL2);
+               result = source;
+               break;
+
+       /*
+        * These clock directly under ACLK clock domain
+        */
+       case SYSCTL_CLOCK_CPU:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_ACLK)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0) /
+                               (2ULL << sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ACLK));
+                       break;
+               default:
+                       break;
+               }
+               result = source;
+               break;
+       case SYSCTL_CLOCK_DMA:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_ACLK)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0) /
+                               (2ULL << sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ACLK));
+                       break;
+               default:
+                       break;
+               }
+               result = source;
+               break;
+       case SYSCTL_CLOCK_FFT:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_ACLK)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0) /
+                               (2ULL << sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ACLK));
+                       break;
+               default:
+                       break;
+               }
+               result = source;
+               break;
+       case SYSCTL_CLOCK_ACLK:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_ACLK)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0) /
+                               (2ULL << sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ACLK));
+                       break;
+               default:
+                       break;
+               }
+               result = source;
+               break;
+       case SYSCTL_CLOCK_HCLK:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_ACLK)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0) /
+                               (2ULL << sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ACLK));
+                       break;
+               default:
+                       break;
+               }
+               result = source;
+               break;
+
+       /*
+        * These clock under ACLK clock domain.
+        * They are using gated divider.
+        */
+       case SYSCTL_CLOCK_SRAM0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SRAM0) + 1);
+               break;
+       case SYSCTL_CLOCK_SRAM1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SRAM1) + 1);
+               break;
+       case SYSCTL_CLOCK_ROM:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_ROM) + 1);
+               break;
+       case SYSCTL_CLOCK_DVP:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_DVP) + 1);
+               break;
+
+       /*
+        * These clock under ACLK clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_APB0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_APB0) + 1);
+               break;
+       case SYSCTL_CLOCK_APB1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_APB1) + 1);
+               break;
+       case SYSCTL_CLOCK_APB2:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_ACLK);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_APB2) + 1);
+               break;
+
+       /*
+        * These clock under AI clock domain.
+        * They are using gated divider.
+        */
+       case SYSCTL_CLOCK_AI:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL1);
+               result = source / (sysctl_clock_get_threshold(SYSCTL_THRESHOLD_AI) + 1);
+               break;
+
+       /*
+        * These clock under I2S clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_I2S0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL2);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2S0) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_I2S1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL2);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2S1) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_I2S2:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL2);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2S2) + 1) * 2);
+               break;
+
+       /*
+        * These clock under WDT clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_WDT0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_WDT0) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_WDT1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_WDT1) + 1) * 2);
+               break;
+
+       /*
+        * These clock under PLL0 clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_SPI0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SPI0) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_SPI1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SPI1) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_SPI2:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SPI2) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_I2C0:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2C0) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_I2C1:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2C1) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_I2C2:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_I2C2) + 1) * 2);
+               break;
+
+       /*
+        * These clock under PLL0_SEL clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_SPI3:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_SPI3)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+                       break;
+               default:
+                       break;
+               }
+
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_SPI3) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_TIMER0:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_TIMER0)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+                       break;
+               default:
+                       break;
+               }
+
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_TIMER0) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_TIMER1:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_TIMER1)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+                       break;
+               default:
+                       break;
+               }
+
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_TIMER1) + 1) * 2);
+               break;
+       case SYSCTL_CLOCK_TIMER2:
+               switch (sysctl_clock_get_clock_select(SYSCTL_CLOCK_SELECT_TIMER2)) {
+               case 0:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+                       break;
+               case 1:
+                       source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_PLL0);
+                       break;
+               default:
+                       break;
+               }
+
+               result = source / ((sysctl_clock_get_threshold(SYSCTL_THRESHOLD_TIMER2) + 1) * 2);
+               break;
+
+       /*
+        * These clock under MISC clock domain.
+        * They are using even divider.
+        */
+
+       /*
+        * These clock under APB0 clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_GPIO:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_UART1:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_UART2:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_UART3:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_FPIOA:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_SHA:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB0);
+               result = source;
+               break;
+
+       /*
+        * These clock under APB1 clock domain.
+        * They are using even divider.
+        */
+       case SYSCTL_CLOCK_AES:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB1);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_OTP:
+               source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB1);
+               result = source;
+               break;
+       case SYSCTL_CLOCK_RTC:
+               source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+               result = source;
+               break;
+
+       /*
+        * These clock under APB2 clock domain.
+        * They are using even divider.
+        */
+       default:
+               break;
+       }
+
+       return result;
+}
+
+int sysctl_dma_select(sysctl_dma_channel_t channel, sysctl_dma_select_t select)
+{
+       sysctl_dma_sel0_t dma_sel0;
+       sysctl_dma_sel1_t dma_sel1;
+
+       /* Read register from bus */
+       dma_sel0 = sysctl->dma_sel0;
+       dma_sel1 = sysctl->dma_sel1;
+       switch (channel) {
+       case SYSCTL_DMA_CHANNEL_0:
+               dma_sel0.dma_sel0 = select;
+               break;
+
+       case SYSCTL_DMA_CHANNEL_1:
+               dma_sel0.dma_sel1 = select;
+               break;
+
+       case SYSCTL_DMA_CHANNEL_2:
+               dma_sel0.dma_sel2 = select;
+               break;
+
+       case SYSCTL_DMA_CHANNEL_3:
+               dma_sel0.dma_sel3 = select;
+               break;
+
+       case SYSCTL_DMA_CHANNEL_4:
+               dma_sel0.dma_sel4 = select;
+               break;
+
+       case SYSCTL_DMA_CHANNEL_5:
+               dma_sel1.dma_sel5 = select;
+               break;
+
+       default:
+               return -1;
+       }
+
+       /* Write register back to bus */
+       sysctl->dma_sel0 = dma_sel0;
+       sysctl->dma_sel1 = dma_sel1;
+
+       return 0;
+}
+
+u32 sysctl_pll_fast_enable_pll(void)
+{
+       sysctl_pll0_t pll0;
+       sysctl_pll1_t pll1;
+       sysctl_pll2_t pll2;
+
+       /* Read register from bus */
+       pll0 = sysctl->pll0;
+       pll1 = sysctl->pll1;
+       pll2 = sysctl->pll2;
+
+       /*
+        * Begin write PLL registers' value,
+        * Using atomic write method.
+        */
+       /* PLL VCO MAX freq: 1.8GHz */
+
+       /* PLL0: 26M reference clk get 793M output clock */
+       pll0.clkr0  = 0;
+       pll0.clkf0  = 60;
+       pll0.clkod0 = 1;
+       pll0.bwadj0 = 60;
+
+       /* PLL1: 26M reference clk get 390M output clock */
+       pll1.clkr1  = 0;
+       pll1.clkf1  = 59;
+       pll1.clkod1 = 3;
+       pll1.bwadj1 = 59;
+
+       /* PLL2: 26M reference clk get 390M output clock */
+       pll2.clkr2  = 0;
+       pll2.clkf2  = 59;
+       pll2.clkod2 = 3;
+       pll2.bwadj2 = 59;
+
+       /* Write register to bus */
+       sysctl->pll0 = pll0;
+       sysctl->pll1 = pll1;
+       sysctl->pll2 = pll2;
+
+       sysctl_pll_enable(SYSCTL_PLL0);
+       sysctl_pll_enable(SYSCTL_PLL1);
+       sysctl_pll_enable(SYSCTL_PLL2);
+
+       while (sysctl_pll_is_lock(SYSCTL_PLL0) == 0)
+               sysctl_pll_clear_slip(SYSCTL_PLL0);
+       while (sysctl_pll_is_lock(SYSCTL_PLL1) == 0)
+               sysctl_pll_clear_slip(SYSCTL_PLL1);
+       while (sysctl_pll_is_lock(SYSCTL_PLL2) == 0)
+               sysctl_pll_clear_slip(SYSCTL_PLL2);
+
+       sysctl_clock_enable(SYSCTL_CLOCK_PLL0);
+       sysctl_clock_enable(SYSCTL_CLOCK_PLL1);
+       sysctl_clock_enable(SYSCTL_CLOCK_PLL2);
+
+       /* Set ACLK to PLL0 */
+       sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_PLL0);
+
+       return 0;
+}
+
+u32 sysctl_set_spi0_dvp_data(u8 en)
+{
+       sysctl->misc.spi_dvp_data_enable = en;
+       return 0;
+}
+
+void sysctl_set_power_mode(sysctl_power_bank_t power_bank, sysctl_io_power_mode_t io_power_mode)
+{
+       if(io_power_mode)
+               *((u32 *)(&sysctl->power_sel)) |= (1 << power_bank);
+       else
+               *((u32 *)(&sysctl->power_sel)) &= ~(1 << power_bank);
+}
+
+u32 sysctl_pll_set_freq(sysctl_pll_t pll, u32 pll_freq)
+{
+       u32 result;
+
+       if(pll_freq == 0)
+               return 0;
+
+       volatile sysctl_general_pll_t *v_pll_t;
+       switch(pll) {
+       case SYSCTL_PLL0:
+               v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll0);
+               break;
+       case SYSCTL_PLL1:
+               v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll1);
+               break;
+       case SYSCTL_PLL2:
+               v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll2);
+               break;
+       default:
+               return 0;
+               break;
+       }
+
+       /* 1. Change CPU CLK to XTAL */
+       if (pll == SYSCTL_PLL0)
+               sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_IN0);
+
+       /* 2. Disable PLL output */
+       v_pll_t->pll_out_en = 0;
+
+       /* 3. Turn off PLL */
+       v_pll_t->pll_pwrd = 0;
+
+       /* 4. Set PLL new value */
+       if (pll == SYSCTL_PLL2)
+               result = sysctl_pll_source_set_freq(pll, v_pll_t->pll_ckin_sel, pll_freq);
+       else
+               result = sysctl_pll_source_set_freq(pll, SYSCTL_SOURCE_IN0, pll_freq);
+
+       /* 5. Power on PLL */
+       v_pll_t->pll_pwrd = 1;
+       /* wait >100ns */
+       sysctl_usleep(1);
+
+       /* 6. Reset PLL then Release Reset*/
+       v_pll_t->pll_reset = 0;
+       v_pll_t->pll_reset = 1;
+       /* wait >100ns */
+       sysctl_usleep(1);
+       v_pll_t->pll_reset = 0;
+
+       /* 7. Get lock status, wait PLL stable */
+       while (sysctl_pll_is_lock(pll) == 0)
+               sysctl_pll_clear_slip(pll);
+
+       /* 8. Enable PLL output */
+       v_pll_t->pll_out_en = 1;
+
+       /* 9. Change CPU CLK to PLL */
+       if (pll == SYSCTL_PLL0)
+               sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_PLL0);
+
+       return result;
+}
+
+u32 sysctl_cpu_set_freq(u32 freq)
+{
+       if (freq == 0)
+               return 0;
+
+       return sysctl_pll_set_freq(SYSCTL_PLL0, (sysctl->clk_sel0.aclk_divider_sel + 1) * 2 * freq);
+}
+
+void sysctl_enable_irq(void)
+{
+       set_csr(mie, MIP_MEIP);
+       set_csr(mstatus, MSTATUS_MIE);
+}
+
+void sysctl_disable_irq(void)
+{
+       clear_csr(mie, MIP_MEIP);
+       clear_csr(mstatus, MSTATUS_MIE);
+}
+
+u64 sysctl_get_time_us(void)
+{
+       u64 v_cycle = read_cycle();
+
+       return v_cycle * 1000000 / sysctl_clock_get_freq(SYSCTL_CLOCK_CPU);
+}
+
+void sysctl_usleep(u64 usec)
+{
+    u64 nop_all = usec * sysctl_clock_get_freq(SYSCTL_CLOCK_CPU) / 1000000UL;
+    u64 cycle = read_cycle();
+
+    while (read_cycle() - cycle < nop_all);
+}
diff --git a/plat/kendryte/k210/sysctl.h b/plat/kendryte/k210/sysctl.h
new file mode 100644 (file)
index 0000000..1fba1c5
--- /dev/null
@@ -0,0 +1,945 @@
+/* Copyright 2018 Canaan Inc.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+#ifndef _SYSCTL_H_
+#define _SYSCTL_H_
+
+#include <sbi/sbi_types.h>
+#include "platform.h"
+
+/**
+ * System controller registers
+ *
+ * | Offset    | Name           | Description                         |
+ * |-----------|----------------|-------------------------------------|
+ * | 0x00      | git_id         | Git short commit id                 |
+ * | 0x04      | clk_freq       | System clock base frequency         |
+ * | 0x08      | pll0           | PLL0 controller                     |
+ * | 0x0c      | pll1           | PLL1 controller                     |
+ * | 0x10      | pll2           | PLL2 controller                     |
+ * | 0x14      | resv5          | Reserved                            |
+ * | 0x18      | pll_lock       | PLL lock tester                     |
+ * | 0x1c      | rom_error      | AXI ROM detector                    |
+ * | 0x20      | clk_sel0       | Clock select controller0            |
+ * | 0x24      | clk_sel1       | Clock select controller1            |
+ * | 0x28      | clk_en_cent    | Central clock enable                |
+ * | 0x2c      | clk_en_peri    | Peripheral clock enable             |
+ * | 0x30      | soft_reset     | Soft reset ctrl                     |
+ * | 0x34      | peri_reset     | Peripheral reset controller         |
+ * | 0x38      | clk_th0        | Clock threshold controller 0        |
+ * | 0x3c      | clk_th1        | Clock threshold controller 1        |
+ * | 0x40      | clk_th2        | Clock threshold controller 2        |
+ * | 0x44      | clk_th3        | Clock threshold controller 3        |
+ * | 0x48      | clk_th4        | Clock threshold controller 4        |
+ * | 0x4c      | clk_th5        | Clock threshold controller 5        |
+ * | 0x50      | clk_th6        | Clock threshold controller 6        |
+ * | 0x54      | misc           | Miscellaneous controller            |
+ * | 0x58      | peri           | Peripheral controller               |
+ * | 0x5c      | spi_sleep      | SPI sleep controller                |
+ * | 0x60      | reset_status   | Reset source status                 |
+ * | 0x64      | dma_sel0       | DMA handshake selector              |
+ * | 0x68      | dma_sel1       | DMA handshake selector              |
+ * | 0x6c      | power_sel      | IO Power Mode Select controller     |
+ * | 0x70      | resv28         | Reserved                            |
+ * | 0x74      | resv29         | Reserved                            |
+ * | 0x78      | resv30         | Reserved                            |
+ * | 0x7c      | resv31         | Reserved                            |
+ */
+
+typedef enum _sysctl_pll_t {
+       SYSCTL_PLL0,
+       SYSCTL_PLL1,
+       SYSCTL_PLL2,
+       SYSCTL_PLL_MAX
+} sysctl_pll_t;
+
+typedef enum _sysctl_clock_source_t {
+       SYSCTL_SOURCE_IN0,
+       SYSCTL_SOURCE_PLL0,
+       SYSCTL_SOURCE_PLL1,
+       SYSCTL_SOURCE_PLL2,
+       SYSCTL_SOURCE_ACLK,
+       SYSCTL_SOURCE_MAX
+} sysctl_clock_source_t;
+
+typedef enum _sysctl_dma_channel_t {
+       SYSCTL_DMA_CHANNEL_0,
+       SYSCTL_DMA_CHANNEL_1,
+       SYSCTL_DMA_CHANNEL_2,
+       SYSCTL_DMA_CHANNEL_3,
+       SYSCTL_DMA_CHANNEL_4,
+       SYSCTL_DMA_CHANNEL_5,
+       SYSCTL_DMA_CHANNEL_MAX
+} sysctl_dma_channel_t;
+
+typedef enum _sysctl_dma_select_t {
+       SYSCTL_DMA_SELECT_SSI0_RX_REQ,
+       SYSCTL_DMA_SELECT_SSI0_TX_REQ,
+       SYSCTL_DMA_SELECT_SSI1_RX_REQ,
+       SYSCTL_DMA_SELECT_SSI1_TX_REQ,
+       SYSCTL_DMA_SELECT_SSI2_RX_REQ,
+       SYSCTL_DMA_SELECT_SSI2_TX_REQ,
+       SYSCTL_DMA_SELECT_SSI3_RX_REQ,
+       SYSCTL_DMA_SELECT_SSI3_TX_REQ,
+       SYSCTL_DMA_SELECT_I2C0_RX_REQ,
+       SYSCTL_DMA_SELECT_I2C0_TX_REQ,
+       SYSCTL_DMA_SELECT_I2C1_RX_REQ,
+       SYSCTL_DMA_SELECT_I2C1_TX_REQ,
+       SYSCTL_DMA_SELECT_I2C2_RX_REQ,
+       SYSCTL_DMA_SELECT_I2C2_TX_REQ,
+       SYSCTL_DMA_SELECT_UART1_RX_REQ,
+       SYSCTL_DMA_SELECT_UART1_TX_REQ,
+       SYSCTL_DMA_SELECT_UART2_RX_REQ,
+       SYSCTL_DMA_SELECT_UART2_TX_REQ,
+       SYSCTL_DMA_SELECT_UART3_RX_REQ,
+       SYSCTL_DMA_SELECT_UART3_TX_REQ,
+       SYSCTL_DMA_SELECT_AES_REQ,
+       SYSCTL_DMA_SELECT_SHA_RX_REQ,
+       SYSCTL_DMA_SELECT_AI_RX_REQ,
+       SYSCTL_DMA_SELECT_FFT_RX_REQ,
+       SYSCTL_DMA_SELECT_FFT_TX_REQ,
+       SYSCTL_DMA_SELECT_I2S0_TX_REQ,
+       SYSCTL_DMA_SELECT_I2S0_RX_REQ,
+       SYSCTL_DMA_SELECT_I2S1_TX_REQ,
+       SYSCTL_DMA_SELECT_I2S1_RX_REQ,
+       SYSCTL_DMA_SELECT_I2S2_TX_REQ,
+       SYSCTL_DMA_SELECT_I2S2_RX_REQ,
+       SYSCTL_DMA_SELECT_I2S0_BF_DIR_REQ,
+       SYSCTL_DMA_SELECT_I2S0_BF_VOICE_REQ,
+       SYSCTL_DMA_SELECT_MAX
+} sysctl_dma_select_t;
+
+/**
+ * System controller clock id
+ */
+typedef enum _sysctl_clock_t {
+       SYSCTL_CLOCK_PLL0,
+       SYSCTL_CLOCK_PLL1,
+       SYSCTL_CLOCK_PLL2,
+       SYSCTL_CLOCK_CPU,
+       SYSCTL_CLOCK_SRAM0,
+       SYSCTL_CLOCK_SRAM1,
+       SYSCTL_CLOCK_APB0,
+       SYSCTL_CLOCK_APB1,
+       SYSCTL_CLOCK_APB2,
+       SYSCTL_CLOCK_ROM,
+       SYSCTL_CLOCK_DMA,
+       SYSCTL_CLOCK_AI,
+       SYSCTL_CLOCK_DVP,
+       SYSCTL_CLOCK_FFT,
+       SYSCTL_CLOCK_GPIO,
+       SYSCTL_CLOCK_SPI0,
+       SYSCTL_CLOCK_SPI1,
+       SYSCTL_CLOCK_SPI2,
+       SYSCTL_CLOCK_SPI3,
+       SYSCTL_CLOCK_I2S0,
+       SYSCTL_CLOCK_I2S1,
+       SYSCTL_CLOCK_I2S2,
+       SYSCTL_CLOCK_I2C0,
+       SYSCTL_CLOCK_I2C1,
+       SYSCTL_CLOCK_I2C2,
+       SYSCTL_CLOCK_UART1,
+       SYSCTL_CLOCK_UART2,
+       SYSCTL_CLOCK_UART3,
+       SYSCTL_CLOCK_AES,
+       SYSCTL_CLOCK_FPIOA,
+       SYSCTL_CLOCK_TIMER0,
+       SYSCTL_CLOCK_TIMER1,
+       SYSCTL_CLOCK_TIMER2,
+       SYSCTL_CLOCK_WDT0,
+       SYSCTL_CLOCK_WDT1,
+       SYSCTL_CLOCK_SHA,
+       SYSCTL_CLOCK_OTP,
+       SYSCTL_CLOCK_RTC,
+       SYSCTL_CLOCK_ACLK = 40,
+       SYSCTL_CLOCK_HCLK,
+       SYSCTL_CLOCK_IN0,
+       SYSCTL_CLOCK_MAX
+} sysctl_clock_t;
+
+/**
+ * System controller clock select id
+ */
+typedef enum _sysctl_clock_select_t {
+       SYSCTL_CLOCK_SELECT_PLL0_BYPASS,
+       SYSCTL_CLOCK_SELECT_PLL1_BYPASS,
+       SYSCTL_CLOCK_SELECT_PLL2_BYPASS,
+       SYSCTL_CLOCK_SELECT_PLL2,
+       SYSCTL_CLOCK_SELECT_ACLK,
+       SYSCTL_CLOCK_SELECT_SPI3,
+       SYSCTL_CLOCK_SELECT_TIMER0,
+       SYSCTL_CLOCK_SELECT_TIMER1,
+       SYSCTL_CLOCK_SELECT_TIMER2,
+       SYSCTL_CLOCK_SELECT_SPI3_SAMPLE,
+       SYSCTL_CLOCK_SELECT_MAX = 11
+} sysctl_clock_select_t;
+
+/**
+ * System controller clock threshold id
+ */
+typedef enum _sysctl_threshold_t {
+       SYSCTL_THRESHOLD_ACLK,
+       SYSCTL_THRESHOLD_APB0,
+       SYSCTL_THRESHOLD_APB1,
+       SYSCTL_THRESHOLD_APB2,
+       SYSCTL_THRESHOLD_SRAM0,
+       SYSCTL_THRESHOLD_SRAM1,
+       SYSCTL_THRESHOLD_AI,
+       SYSCTL_THRESHOLD_DVP,
+       SYSCTL_THRESHOLD_ROM,
+       SYSCTL_THRESHOLD_SPI0,
+       SYSCTL_THRESHOLD_SPI1,
+       SYSCTL_THRESHOLD_SPI2,
+       SYSCTL_THRESHOLD_SPI3,
+       SYSCTL_THRESHOLD_TIMER0,
+       SYSCTL_THRESHOLD_TIMER1,
+       SYSCTL_THRESHOLD_TIMER2,
+       SYSCTL_THRESHOLD_I2S0,
+       SYSCTL_THRESHOLD_I2S1,
+       SYSCTL_THRESHOLD_I2S2,
+       SYSCTL_THRESHOLD_I2S0_M,
+       SYSCTL_THRESHOLD_I2S1_M,
+       SYSCTL_THRESHOLD_I2S2_M,
+       SYSCTL_THRESHOLD_I2C0,
+       SYSCTL_THRESHOLD_I2C1,
+       SYSCTL_THRESHOLD_I2C2,
+       SYSCTL_THRESHOLD_WDT0,
+       SYSCTL_THRESHOLD_WDT1,
+       SYSCTL_THRESHOLD_MAX = 28
+} sysctl_threshold_t;
+
+/**
+ * System controller reset control id
+ */
+typedef enum _sysctl_reset_t {
+       SYSCTL_RESET_SOC,
+       SYSCTL_RESET_ROM,
+       SYSCTL_RESET_DMA,
+       SYSCTL_RESET_AI,
+       SYSCTL_RESET_DVP,
+       SYSCTL_RESET_FFT,
+       SYSCTL_RESET_GPIO,
+       SYSCTL_RESET_SPI0,
+       SYSCTL_RESET_SPI1,
+       SYSCTL_RESET_SPI2,
+       SYSCTL_RESET_SPI3,
+       SYSCTL_RESET_I2S0,
+       SYSCTL_RESET_I2S1,
+       SYSCTL_RESET_I2S2,
+       SYSCTL_RESET_I2C0,
+       SYSCTL_RESET_I2C1,
+       SYSCTL_RESET_I2C2,
+       SYSCTL_RESET_UART1,
+       SYSCTL_RESET_UART2,
+       SYSCTL_RESET_UART3,
+       SYSCTL_RESET_AES,
+       SYSCTL_RESET_FPIOA,
+       SYSCTL_RESET_TIMER0,
+       SYSCTL_RESET_TIMER1,
+       SYSCTL_RESET_TIMER2,
+       SYSCTL_RESET_WDT0,
+       SYSCTL_RESET_WDT1,
+       SYSCTL_RESET_SHA,
+       SYSCTL_RESET_RTC,
+       SYSCTL_RESET_MAX = 31
+} sysctl_reset_t;
+
+typedef enum _sysctl_power_bank {
+       SYSCTL_POWER_BANK0,
+       SYSCTL_POWER_BANK1,
+       SYSCTL_POWER_BANK2,
+       SYSCTL_POWER_BANK3,
+       SYSCTL_POWER_BANK4,
+       SYSCTL_POWER_BANK5,
+       SYSCTL_POWER_BANK6,
+       SYSCTL_POWER_BANK7,
+       SYSCTL_POWER_BANK_MAX,
+} sysctl_power_bank_t;
+
+/**
+ * System controller reset control id
+ */
+typedef enum _sysctl_io_power_mode {
+       SYSCTL_POWER_V33,
+       SYSCTL_POWER_V18
+} sysctl_io_power_mode_t;
+
+/**
+ * Git short commit id
+ * No. 0 Register (0x00)
+ */
+typedef struct _sysctl_git_id {
+       u32 git_id : 32;
+} __attribute__((packed, aligned(4))) sysctl_git_id_t;
+
+/**
+ * System clock base frequency
+ * No. 1 Register (0x04)
+ */
+typedef struct _sysctl_clk_freq {
+       u32 clk_freq : 32;
+} __attribute__((packed, aligned(4))) sysctl_clk_freq_t;
+
+/**
+ * PLL0 controller
+ * No. 2 Register (0x08)
+ */
+typedef struct _sysctl_pll0 {
+       u32 clkr0 : 4;
+       u32 clkf0 : 6;
+       u32 clkod0 : 4;
+       u32 bwadj0 : 6;
+       u32 pll_reset0 : 1;
+       u32 pll_pwrd0 : 1;
+       u32 pll_intfb0 : 1;
+       u32 pll_bypass0 : 1;
+       u32 pll_test0 : 1;
+       u32 pll_out_en0 : 1;
+       u32 pll_test_en : 1;
+       u32 reserved : 5;
+} __attribute__((packed, aligned(4))) sysctl_pll0_t;
+
+/**
+ * PLL1 controller
+ * No. 3 Register (0x0c)
+ */
+typedef struct _sysctl_pll1 {
+       u32 clkr1 : 4;
+       u32 clkf1 : 6;
+       u32 clkod1 : 4;
+       u32 bwadj1 : 6;
+       u32 pll_reset1 : 1;
+       u32 pll_pwrd1 : 1;
+       u32 pll_intfb1 : 1;
+       u32 pll_bypass1 : 1;
+       u32 pll_test1 : 1;
+       u32 pll_out_en1 : 1;
+       u32 reserved : 6;
+} __attribute__((packed, aligned(4))) sysctl_pll1_t;
+
+/**
+ * PLL2 controller
+ * No. 4 Register (0x10)
+ */
+typedef struct _sysctl_pll2 {
+       u32 clkr2 : 4;
+       u32 clkf2 : 6;
+       u32 clkod2 : 4;
+       u32 bwadj2 : 6;
+       u32 pll_reset2 : 1;
+       u32 pll_pwrd2 : 1;
+       u32 pll_intfb2 : 1;
+       u32 pll_bypass2 : 1;
+       u32 pll_test2 : 1;
+       u32 pll_out_en2 : 1;
+       u32 pll_ckin_sel2 : 2;
+       u32 reserved : 4;
+} __attribute__((packed, aligned(4))) sysctl_pll2_t;
+
+/**
+ * PLL lock tester
+ * No. 6 Register (0x18)
+ */
+typedef struct _sysctl_pll_lock {
+       u32 pll_lock0 : 2;
+       u32 pll_slip_clear0 : 1;
+       u32 test_clk_out0 : 1;
+       u32 reserved0 : 4;
+       u32 pll_lock1 : 2;
+       u32 pll_slip_clear1 : 1;
+       u32 test_clk_out1 : 1;
+       u32 reserved1 : 4;
+       u32 pll_lock2 : 2;
+       u32 pll_slip_clear2 : 1;
+       u32 test_clk_out2 : 1;
+       u32 reserved2 : 12;
+} __attribute__((packed, aligned(4))) sysctl_pll_lock_t;
+
+/**
+ * AXI ROM detector
+ * No. 7 Register (0x1c)
+ */
+typedef struct _sysctl_rom_error {
+       u32 rom_mul_error : 1;
+       u32 rom_one_error : 1;
+       u32 reserved : 30;
+} __attribute__((packed, aligned(4))) sysctl_rom_error_t;
+
+/**
+ * Clock select controller0
+ * No. 8 Register (0x20)
+ */
+typedef struct _sysctl_clk_sel0 {
+       u32 aclk_sel : 1;
+       u32 aclk_divider_sel : 2;
+       u32 apb0_clk_sel : 3;
+       u32 apb1_clk_sel : 3;
+       u32 apb2_clk_sel : 3;
+       u32 spi3_clk_sel : 1;
+       u32 timer0_clk_sel : 1;
+       u32 timer1_clk_sel : 1;
+       u32 timer2_clk_sel : 1;
+       u32 reserved : 16;
+} __attribute__((packed, aligned(4))) sysctl_clk_sel0_t;
+
+/**
+ * Clock select controller1
+ * No. 9 Register (0x24)
+ */
+typedef struct _sysctl_clk_sel1 {
+       u32 spi3_sample_clk_sel : 1;
+       u32 reserved0 : 30;
+       u32 reserved1 : 1;
+} __attribute__((packed, aligned(4))) sysctl_clk_sel1_t;
+
+/**
+ * Central clock enable
+ * No. 10 Register (0x28)
+ */
+typedef struct _sysctl_clk_en_cent {
+       u32 cpu_clk_en : 1;
+       u32 sram0_clk_en : 1;
+       u32 sram1_clk_en : 1;
+       u32 apb0_clk_en : 1;
+       u32 apb1_clk_en : 1;
+       u32 apb2_clk_en : 1;
+       u32 reserved : 26;
+} __attribute__((packed, aligned(4))) sysctl_clk_en_cent_t;
+
+/**
+ * Peripheral clock enable
+ * No. 11 Register (0x2c)
+ */
+typedef struct _sysctl_clk_en_peri {
+       u32 rom_clk_en : 1;
+       u32 dma_clk_en : 1;
+       u32 ai_clk_en : 1;
+       u32 dvp_clk_en : 1;
+       u32 fft_clk_en : 1;
+       u32 gpio_clk_en : 1;
+       u32 spi0_clk_en : 1;
+       u32 spi1_clk_en : 1;
+       u32 spi2_clk_en : 1;
+       u32 spi3_clk_en : 1;
+       u32 i2s0_clk_en : 1;
+       u32 i2s1_clk_en : 1;
+       u32 i2s2_clk_en : 1;
+       u32 i2c0_clk_en : 1;
+       u32 i2c1_clk_en : 1;
+       u32 i2c2_clk_en : 1;
+       u32 uart1_clk_en : 1;
+       u32 uart2_clk_en : 1;
+       u32 uart3_clk_en : 1;
+       u32 aes_clk_en : 1;
+       u32 fpioa_clk_en : 1;
+       u32 timer0_clk_en : 1;
+       u32 timer1_clk_en : 1;
+       u32 timer2_clk_en : 1;
+       u32 wdt0_clk_en : 1;
+       u32 wdt1_clk_en : 1;
+       u32 sha_clk_en : 1;
+       u32 otp_clk_en : 1;
+       u32 reserved : 1;
+       u32 rtc_clk_en : 1;
+       u32 reserved0 : 2;
+} __attribute__((packed, aligned(4))) sysctl_clk_en_peri_t;
+
+/**
+ * Soft reset ctrl
+ * No. 12 Register (0x30)
+ */
+typedef struct _sysctl_soft_reset {
+       u32 soft_reset : 1;
+       u32 reserved : 31;
+} __attribute__((packed, aligned(4))) sysctl_soft_reset_t;
+
+/**
+ * Peripheral reset controller
+ * No. 13 Register (0x34)
+ */
+typedef struct _sysctl_peri_reset {
+       u32 rom_reset : 1;
+       u32 dma_reset : 1;
+       u32 ai_reset : 1;
+       u32 dvp_reset : 1;
+       u32 fft_reset : 1;
+       u32 gpio_reset : 1;
+       u32 spi0_reset : 1;
+       u32 spi1_reset : 1;
+       u32 spi2_reset : 1;
+       u32 spi3_reset : 1;
+       u32 i2s0_reset : 1;
+       u32 i2s1_reset : 1;
+       u32 i2s2_reset : 1;
+       u32 i2c0_reset : 1;
+       u32 i2c1_reset : 1;
+       u32 i2c2_reset : 1;
+       u32 uart1_reset : 1;
+       u32 uart2_reset : 1;
+       u32 uart3_reset : 1;
+       u32 aes_reset : 1;
+       u32 fpioa_reset : 1;
+       u32 timer0_reset : 1;
+       u32 timer1_reset : 1;
+       u32 timer2_reset : 1;
+       u32 wdt0_reset : 1;
+       u32 wdt1_reset : 1;
+       u32 sha_reset : 1;
+       u32 reserved : 2;
+       u32 rtc_reset : 1;
+       u32 reserved0 : 2;
+} __attribute__((packed, aligned(4))) sysctl_peri_reset_t;
+
+/**
+ * Clock threshold controller 0
+ * No. 14 Register (0x38)
+ */
+typedef struct _sysctl_clk_th0 {
+       u32 sram0_gclk_threshold : 4;
+       u32 sram1_gclk_threshold : 4;
+       u32 ai_gclk_threshold : 4;
+       u32 dvp_gclk_threshold : 4;
+       u32 rom_gclk_threshold : 4;
+       u32 reserved : 12;
+} __attribute__((packed, aligned(4))) sysctl_clk_th0_t;
+
+/**
+ * Clock threshold controller 1
+ * No. 15 Register (0x3c)
+ */
+typedef struct _sysctl_clk_th1 {
+       u32 spi0_clk_threshold : 8;
+       u32 spi1_clk_threshold : 8;
+       u32 spi2_clk_threshold : 8;
+       u32 spi3_clk_threshold : 8;
+} __attribute__((packed, aligned(4))) sysctl_clk_th1_t;
+
+/**
+ * Clock threshold controller 2
+ * No. 16 Register (0x40)
+ */
+typedef struct _sysctl_clk_th2 {
+       u32 timer0_clk_threshold : 8;
+       u32 timer1_clk_threshold : 8;
+       u32 timer2_clk_threshold : 8;
+       u32 reserved : 8;
+} __attribute__((packed, aligned(4))) sysctl_clk_th2_t;
+
+/**
+ * Clock threshold controller 3
+ * No. 17 Register (0x44)
+ */
+typedef struct _sysctl_clk_th3 {
+       u32 i2s0_clk_threshold : 16;
+       u32 i2s1_clk_threshold : 16;
+} __attribute__((packed, aligned(4))) sysctl_clk_th3_t;
+
+/**
+ * Clock threshold controller 4
+ * No. 18 Register (0x48)
+ */
+typedef struct _sysctl_clk_th4 {
+       u32 i2s2_clk_threshold : 16;
+       u32 i2s0_mclk_threshold : 8;
+       u32 i2s1_mclk_threshold : 8;
+} __attribute__((packed, aligned(4))) sysctl_clk_th4_t;
+
+/**
+ * Clock threshold controller 5
+ * No. 19 Register (0x4c)
+ */
+typedef struct _sysctl_clk_th5 {
+       u32 i2s2_mclk_threshold : 8;
+       u32 i2c0_clk_threshold : 8;
+       u32 i2c1_clk_threshold : 8;
+       u32 i2c2_clk_threshold : 8;
+} __attribute__((packed, aligned(4))) sysctl_clk_th5_t;
+
+/**
+ * Clock threshold controller 6
+ * No. 20 Register (0x50)
+ */
+typedef struct _sysctl_clk_th6 {
+       u32 wdt0_clk_threshold : 8;
+       u32 wdt1_clk_threshold : 8;
+       u32 reserved0 : 8;
+       u32 reserved1 : 8;
+} __attribute__((packed, aligned(4))) sysctl_clk_th6_t;
+
+/**
+ * Miscellaneous controller
+ * No. 21 Register (0x54)
+ */
+typedef struct _sysctl_misc {
+       u32 debug_sel : 6;
+       u32 reserved0 : 4;
+       u32 spi_dvp_data_enable: 1;
+       u32 reserved1 : 21;
+} __attribute__((packed, aligned(4))) sysctl_misc_t;
+
+/**
+ * Peripheral controller
+ * No. 22 Register (0x58)
+ */
+typedef struct _sysctl_peri {
+       u32 timer0_pause : 1;
+       u32 timer1_pause : 1;
+       u32 timer2_pause : 1;
+       u32 timer3_pause : 1;
+       u32 timer4_pause : 1;
+       u32 timer5_pause : 1;
+       u32 timer6_pause : 1;
+       u32 timer7_pause : 1;
+       u32 timer8_pause : 1;
+       u32 timer9_pause : 1;
+       u32 timer10_pause : 1;
+       u32 timer11_pause : 1;
+       u32 spi0_xip_en : 1;
+       u32 spi1_xip_en : 1;
+       u32 spi2_xip_en : 1;
+       u32 spi3_xip_en : 1;
+       u32 spi0_clk_bypass : 1;
+       u32 spi1_clk_bypass : 1;
+       u32 spi2_clk_bypass : 1;
+       u32 i2s0_clk_bypass : 1;
+       u32 i2s1_clk_bypass : 1;
+       u32 i2s2_clk_bypass : 1;
+       u32 jtag_clk_bypass : 1;
+       u32 dvp_clk_bypass : 1;
+       u32 debug_clk_bypass : 1;
+       u32 reserved0 : 1;
+       u32 reserved1 : 6;
+} __attribute__((packed, aligned(4))) sysctl_peri_t;
+
+/**
+ * SPI sleep controller
+ * No. 23 Register (0x5c)
+ */
+typedef struct _sysctl_spi_sleep {
+       u32 ssi0_sleep : 1;
+       u32 ssi1_sleep : 1;
+       u32 ssi2_sleep : 1;
+       u32 ssi3_sleep : 1;
+       u32 reserved : 28;
+} __attribute__((packed, aligned(4))) sysctl_spi_sleep_t;
+
+/**
+ * Reset source status
+ * No. 24 Register (0x60)
+ */
+typedef struct _sysctl_reset_status {
+       u32 reset_sts_clr : 1;
+       u32 pin_reset_sts : 1;
+       u32 wdt0_reset_sts : 1;
+       u32 wdt1_reset_sts : 1;
+       u32 soft_reset_sts : 1;
+       u32 reserved : 27;
+} __attribute__((packed, aligned(4))) sysctl_reset_status_t;
+
+/**
+ * DMA handshake selector
+ * No. 25 Register (0x64)
+ */
+typedef struct _sysctl_dma_sel0 {
+       u32 dma_sel0 : 6;
+       u32 dma_sel1 : 6;
+       u32 dma_sel2 : 6;
+       u32 dma_sel3 : 6;
+       u32 dma_sel4 : 6;
+       u32 reserved : 2;
+} __attribute__((packed, aligned(4))) sysctl_dma_sel0_t;
+
+/**
+ * DMA handshake selector
+ * No. 26 Register (0x68)
+ */
+typedef struct _sysctl_dma_sel1 {
+       u32 dma_sel5 : 6;
+       u32 reserved : 26;
+} __attribute__((packed, aligned(4))) sysctl_dma_sel1_t;
+
+/**
+ * IO Power Mode Select controller
+ * No. 27 Register (0x6c)
+ */
+typedef struct _sysctl_power_sel {
+       u32 power_mode_sel0 : 1;
+       u32 power_mode_sel1 : 1;
+       u32 power_mode_sel2 : 1;
+       u32 power_mode_sel3 : 1;
+       u32 power_mode_sel4 : 1;
+       u32 power_mode_sel5 : 1;
+       u32 power_mode_sel6 : 1;
+       u32 power_mode_sel7 : 1;
+       u32 reserved : 24;
+} __attribute__((packed, aligned(4))) sysctl_power_sel_t;
+
+/**
+ * System controller object
+ *
+ * The System controller is a peripheral device mapped in the
+ * internal memory map, discoverable in the Configuration String.
+ * It is responsible for low-level configuration of all system
+ * related peripheral device. It contain PLL controller, clock
+ * controller, reset controller, DMA handshake controller, SPI
+ * controller, timer controller, WDT controller and sleep
+ * controller.
+ */
+typedef struct _sysctl {
+       /* No. 0 (0x00): Git short commit id */
+       sysctl_git_id_t git_id;
+       /* No. 1 (0x04): System clock base frequency */
+       sysctl_clk_freq_t clk_freq;
+       /* No. 2 (0x08): PLL0 controller */
+       sysctl_pll0_t pll0;
+       /* No. 3 (0x0c): PLL1 controller */
+       sysctl_pll1_t pll1;
+       /* No. 4 (0x10): PLL2 controller */
+       sysctl_pll2_t pll2;
+       /* No. 5 (0x14): Reserved */
+       u32 resv5;
+       /* No. 6 (0x18): PLL lock tester */
+       sysctl_pll_lock_t pll_lock;
+       /* No. 7 (0x1c): AXI ROM detector */
+       sysctl_rom_error_t rom_error;
+       /* No. 8 (0x20): Clock select controller0 */
+       sysctl_clk_sel0_t clk_sel0;
+       /* No. 9 (0x24): Clock select controller1 */
+       sysctl_clk_sel1_t clk_sel1;
+       /* No. 10 (0x28): Central clock enable */
+       sysctl_clk_en_cent_t clk_en_cent;
+       /* No. 11 (0x2c): Peripheral clock enable */
+       sysctl_clk_en_peri_t clk_en_peri;
+       /* No. 12 (0x30): Soft reset ctrl */
+       sysctl_soft_reset_t soft_reset;
+       /* No. 13 (0x34): Peripheral reset controller */
+       sysctl_peri_reset_t peri_reset;
+       /* No. 14 (0x38): Clock threshold controller 0 */
+       sysctl_clk_th0_t clk_th0;
+       /* No. 15 (0x3c): Clock threshold controller 1 */
+       sysctl_clk_th1_t clk_th1;
+       /* No. 16 (0x40): Clock threshold controller 2 */
+       sysctl_clk_th2_t clk_th2;
+       /* No. 17 (0x44): Clock threshold controller 3 */
+       sysctl_clk_th3_t clk_th3;
+       /* No. 18 (0x48): Clock threshold controller 4 */
+       sysctl_clk_th4_t clk_th4;
+       /* No. 19 (0x4c): Clock threshold controller 5 */
+       sysctl_clk_th5_t clk_th5;
+       /* No. 20 (0x50): Clock threshold controller 6 */
+       sysctl_clk_th6_t clk_th6;
+       /* No. 21 (0x54): Miscellaneous controller */
+       sysctl_misc_t misc;
+       /* No. 22 (0x58): Peripheral controller */
+       sysctl_peri_t peri;
+       /* No. 23 (0x5c): SPI sleep controller */
+       sysctl_spi_sleep_t spi_sleep;
+       /* No. 24 (0x60): Reset source status */
+       sysctl_reset_status_t reset_status;
+       /* No. 25 (0x64): DMA handshake selector */
+       sysctl_dma_sel0_t dma_sel0;
+       /* No. 26 (0x68): DMA handshake selector */
+       sysctl_dma_sel1_t dma_sel1;
+       /* No. 27 (0x6c): IO Power Mode Select controller */
+       sysctl_power_sel_t power_sel;
+       /* No. 28 (0x70): Reserved */
+       u32 resv28;
+       /* No. 29 (0x74): Reserved */
+       u32 resv29;
+       /* No. 30 (0x78): Reserved */
+       u32 resv30;
+       /* No. 31 (0x7c): Reserved */
+       u32 resv31;
+} __attribute__((packed, aligned(4))) sysctl_t;
+
+/**
+ * Abstruct PLL struct
+ */
+typedef struct _sysctl_general_pll {
+       u32 clkr : 4;
+       u32 clkf : 6;
+       u32 clkod : 4;
+       u32 bwadj : 6;
+       u32 pll_reset : 1;
+       u32 pll_pwrd : 1;
+       u32 pll_intfb : 1;
+       u32 pll_bypass : 1;
+       u32 pll_test : 1;
+       u32 pll_out_en : 1;
+       u32 pll_ckin_sel : 2;
+       u32 reserved : 4;
+} __attribute__((packed, aligned(4))) sysctl_general_pll_t;
+
+/**
+ * System controller object instanse
+ */
+extern volatile sysctl_t *const sysctl;
+
+/**
+ * Enable clock for peripheral
+ * @param[in]   clock       The clock to be enable
+ * @return      result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_clock_enable(sysctl_clock_t clock);
+
+/**
+ * Enable clock for peripheral
+ * @param[in]   clock       The clock to be disable
+ * @return      result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_clock_disable(sysctl_clock_t clock);
+
+/**
+ * Sysctl clock set threshold
+ * @param[in]   which           Which threshold to set
+ * @param[in]   threshold       The threshold value
+ * @return      result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_clock_set_threshold(sysctl_threshold_t which, int threshold);
+
+/**
+ * Sysctl clock get threshold
+ * @param[in]   which       Which threshold to get
+ * @return      The threshold value
+ *     - Other  Value of threshold
+ *     - -1     Fail
+ */
+int sysctl_clock_get_threshold(sysctl_threshold_t which);
+
+/**
+ * Sysctl clock set clock select
+ * @param[in]   which       Which clock select to set
+ * @param[in]   select      The clock select value
+ * @return      result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_clock_set_clock_select(sysctl_clock_select_t which, int select);
+
+/**
+ * Sysctl clock get clock select
+ * @param[in]   which  Which clock select to get
+ * @return      The clock select value
+ *     - Other  Value of clock select
+ *     - -1     Fail
+ */
+int sysctl_clock_get_clock_select(sysctl_clock_select_t which);
+
+/**
+ * Get PLL frequency
+ * @param[in]   pll     The PLL id
+ * @return      The frequency of PLL
+ */
+u32 sysctl_pll_get_freq(sysctl_pll_t pll);
+
+/**
+ * Get base clock frequency by clock id
+ * @param[in]   clock       The clock id
+ * @return      The clock frequency
+ */
+u32 sysctl_clock_get_freq(sysctl_clock_t clock);
+
+/**
+ * Reset device by reset controller
+ * @param[in]   reset       The reset signal
+ */
+void sysctl_reset(sysctl_reset_t reset);
+
+/**
+ * Enable the PLL and power on with reset
+ * @param[in]   pll     The pll id
+ * @return      Result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_pll_enable(sysctl_pll_t pll);
+
+/**
+ * Disable the PLL and power off
+ * @param[in]   pll     The pll id
+ * @return      Result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_pll_disable(sysctl_pll_t pll);
+
+/**
+ * Select DMA channel handshake peripheral signal
+ * @param[in]   channel     The DMA channel
+ * @param[in]   select      The peripheral select
+ * @return      Result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+int sysctl_dma_select(sysctl_dma_channel_t channel, sysctl_dma_select_t select);
+
+/**
+ * Set SPI0_D0-D7 DVP_D0-D7 as spi and dvp data pin
+ * @param[in]   en     Enable or not
+ * @return      Result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+u32 sysctl_set_spi0_dvp_data(u8 en);
+
+/**
+ * Set io power mode
+ * @param[in]   power_bank          IO power bank
+ * @param[in]   io_power_mode       Set power mode 3.3v or 1.8
+ * @return      Result
+ *     - 0      Success
+ *     - Other  Fail
+ */
+void sysctl_set_power_mode(sysctl_power_bank_t power_bank, sysctl_io_power_mode_t io_power_mode);
+
+/**
+ * Set frequency of CPU
+ * @param[in]   freq       The desired frequency in Hz
+ * @return      The actual frequency of CPU after set
+ */
+u32 sysctl_cpu_set_freq(u32 freq);
+
+/**
+ * Init PLL freqency
+ * @param[in]   pll            The PLL id
+ * @param[in]   pll_freq       The desired frequency in Hz
+
+ */
+u32 sysctl_pll_set_freq(sysctl_pll_t pll, u32 pll_freq);
+
+/**
+ * Enable interrupt
+ */
+void sysctl_enable_irq(void);
+
+/**
+ * Disable interrupt
+ */
+void sysctl_disable_irq(void);
+
+/**
+ * Get the time start up to now
+ * @return      The time of microsecond
+ */
+u64 sysctl_get_time_us(void);
+
+void sysctl_usleep(u64 usec);
+
+#endif /* _SYSCTL_H_ */
diff --git a/plat/kendryte/k210/uarths.c b/plat/kendryte/k210/uarths.c
new file mode 100644 (file)
index 0000000..1d07ad0
--- /dev/null
@@ -0,0 +1,56 @@
+/* Copyright 2018 Canaan Inc.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "sysctl.h"
+#include "uarths.h"
+
+static volatile struct uarths *const uarths =
+       (volatile struct uarths *)UARTHS_BASE_ADDR;
+
+void uarths_init(u32 baud_rate, enum uarths_stopbit stopbit)
+{
+       u32 freq = sysctl_clock_get_freq(SYSCTL_CLOCK_CPU);
+       u16 div = freq / baud_rate - 1;
+
+       /* Set UART registers */
+       uarths->div.div = div;
+       uarths->txctrl.nstop = stopbit;
+       uarths->txctrl.txen = 1;
+       uarths->rxctrl.rxen = 1;
+       uarths->txctrl.txcnt = 0;
+       uarths->rxctrl.rxcnt = 0;
+       uarths->ip.txwm = 0;
+       uarths->ip.rxwm = 0;
+       uarths->ie.txwm = 0;
+       uarths->ie.rxwm = 0;
+}
+
+void uarths_putc(char c)
+{
+       while (uarths->txdata.full);
+
+       uarths->txdata.data = (u8)c;
+}
+
+char uarths_getc(void)
+{
+       struct uarths_rxdata recv = uarths->rxdata;
+
+       if (recv.empty)
+               return '\0';
+
+       return recv.data;
+}
+
diff --git a/plat/kendryte/k210/uarths.h b/plat/kendryte/k210/uarths.h
new file mode 100644 (file)
index 0000000..ab539cd
--- /dev/null
@@ -0,0 +1,170 @@
+/* Copyright 2018 Canaan Inc.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+/*
+ * Universal Asynchronous Receiver/Transmitter (UART)
+ * The UART peripheral supports the following features:
+ *
+ * - 8-N-1 and 8-N-2 formats: 8 data bits, no parity bit, 1 start
+ *   bit, 1 or 2 stop bits
+ *
+ * - 8-entry transmit and receive FIFO buffers with programmable
+ *   watermark interrupts
+ *
+ * - 16× Rx oversampling with 2/3 majority voting per bit
+ *
+ * The UART peripheral does not support hardware flow control or
+ * other modem control signals, or synchronous serial data
+ * tranfesrs.
+ *
+ * UART RAM Layout
+ * | Address   | Name     | Description                     |
+ * |-----------|----------|---------------------------------|
+ * | 0x000     | txdata   | Transmit data register          |
+ * | 0x004     | rxdata   | Receive data register           |
+ * | 0x008     | txctrl   | Transmit control register       |
+ * | 0x00C     | rxctrl   | Receive control register        |
+ * | 0x010     | ie       | UART interrupt enable           |
+ * | 0x014     | ip       | UART Interrupt pending          |
+ * | 0x018     | div      | Baud rate divisor               |
+ */
+
+#ifndef _UARTHS_H_
+#define _UARTHS_H_
+
+#include <sbi/sbi_types.h>
+#include "platform.h"
+
+/* Register address offsets */
+#define UARTHS_REG_TXFIFO      0x00
+#define UARTHS_REG_RXFIFO      0x04
+#define UARTHS_REG_TXCTRL      0x08
+#define UARTHS_REG_RXCTRL      0x0c
+#define UARTHS_REG_IE          0x10
+#define UARTHS_REG_IP          0x14
+#define UARTHS_REG_DIV         0x18
+
+/* TXCTRL register */
+#define UARTHS_TXEN            0x01
+#define UARTHS_TXWM(x)         (((x) & 0xffff) << 16)
+
+/* RXCTRL register */
+#define UARTHS_RXEN            0x01
+#define UARTHS_RXWM(x)         (((x) & 0xffff) << 16)
+
+/* IP register */
+#define UARTHS_IP_TXWM         0x01
+#define UARTHS_IP_RXWM         0x02
+
+struct uarths_txdata {
+       /* Bits [7:0] is data */
+       u32 data : 8;
+       /* Bits [30:8] is 0 */
+       u32 zero : 23;
+       /* Bit 31 is full status */
+       u32 full : 1;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_rxdata {
+       /* Bits [7:0] is data */
+       u32 data : 8;
+       /* Bits [30:8] is 0 */
+       u32 zero : 23;
+       /* Bit 31 is empty status */
+       u32 empty : 1;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_txctrl {
+       /* Bit 0 is txen, controls whether the Tx channel is active. */
+       u32 txen : 1;
+       /* Bit 1 is nstop, 0 for one stop bit and 1 for two stop bits */
+       u32 nstop : 1;
+       /* Bits [15:2] is reserved */
+       u32 resv0 : 14;
+       /* Bits [18:16] is threshold of interrupt triggers */
+       u32 txcnt : 3;
+       /* Bits [31:19] is reserved */
+       u32 resv1 : 13;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_rxctrl {
+       /* Bit 0 is txen, controls whether the Tx channel is active. */
+       u32 rxen : 1;
+       /* Bits [15:1] is reserved */
+       u32 resv0 : 15;
+       /* Bits [18:16] is threshold of interrupt triggers */
+       u32 rxcnt : 3;
+       /* Bits [31:19] is reserved */
+       u32 resv1 : 13;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_ip {
+       /* Bit 0 is txwm, raised less than txcnt */
+       u32 txwm : 1;
+       /* Bit 1 is txwm, raised greater than rxcnt */
+       u32 rxwm : 1;
+       /* Bits [31:2] is 0 */
+       u32 zero : 30;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_ie {
+       /* Bit 0 is txwm, raised less than txcnt */
+       u32 txwm : 1;
+       /* Bit 1 is txwm, raised greater than rxcnt */
+       u32 rxwm : 1;
+       /* Bits [31:2] is 0 */
+       u32 zero : 30;
+} __attribute__((packed, aligned(4)));
+
+struct uarths_div {
+       /* Bits [31:2] is baud rate divisor register */
+       u32 div : 16;
+       /* Bits [31:16] is 0 */
+       u32 zero : 16;
+} __attribute__((packed, aligned(4)));
+
+struct uarths {
+       /* Address offset 0x00 */
+       struct uarths_txdata txdata;
+       /* Address offset 0x04 */
+       struct uarths_rxdata rxdata;
+       /* Address offset 0x08 */
+       struct uarths_txctrl txctrl;
+       /* Address offset 0x0c */
+       struct uarths_rxctrl rxctrl;
+       /* Address offset 0x10 */
+       struct uarths_ie ie;
+       /* Address offset 0x14 */
+       struct uarths_ip ip;
+       /* Address offset 0x18 */
+       struct uarths_div div;
+} __attribute__((packed, aligned(4)));
+
+enum uarths_interrupt_mode {
+       UARTHS_SEND = 1,
+       UARTHS_RECEIVE = 2,
+       UARTHS_SEND_RECEIVE = 3,
+};
+
+enum uarths_stopbit {
+       UARTHS_STOP_1,
+       UARTHS_STOP_2
+};
+
+void uarths_init(u32 baud_rate, enum uarths_stopbit stopbit);
+void uarths_putc(char c);
+char uarths_getc(void);
+
+#endif /* _UARTHS_H_ */