S7D: PXP Bringup Bootloader BL30 code portinig [1/3]
PD#SWPL-143969
Problem:
S7D PXP Bringup Bootloader BL30.
Solution:
Code porting from s7 and ucode.
Verify:
Test in S7D PXP.
Change-Id: I4b4238f47693e4fb77cfeb7c0e430306f93d048f
Signed-off-by: bangzheng.liu <bangzheng.liu@amlogic.com>
diff --git a/s7d/wakeup.h b/s7d/wakeup.h
new file mode 100644
index 0000000..5b680af
--- /dev/null
+++ b/s7d/wakeup.h
@@ -0,0 +1,66 @@
+/*
+ * Copyright (c) 2021-2022 Amlogic, Inc. All rights reserved.
+ *
+ * SPDX-License-Identifier: MIT
+ */
+
+#ifndef __WAKEUP_H__
+#define __WAKEUP_H__
+
+#define TIMER_CLK_IDX 3// 0:cts_sys_clk 1:1us 2:10us 3:100us
+#define WAKEUP_TIMER_CNT 1000 //Delay : WAKEUP_TIMER_CNT * TIMER_CLK_IDX
+
+/* Calculate the actual value, unit ms */
+#ifndef TIMER_CLK_IDX
+#error "Not define TIMER_CLK_IDX macro..\n"
+#else
+ #if !((TIMER_CLK_IDX >= 0) && (TIMER_CLK_IDX <= 3))
+ #error "Set invalid value for TIMER"
+ #else
+ #if (TIMER_CLK_IDX == 0)
+ #error "Not support!"
+ #elif (TIMER_CLK_IDX == 1)
+ #define SYSTEM_DELAY_VAL (WAKEUP_TIMER_CNT / 1000)
+ #elif (TIMER_CLK_IDX == 2)
+ #define SYSTEM_DELAY_VAL (WAKEUP_TIMER_CNT / 1000 * 10)
+ #elif (TIMER_CLK_IDX == 3)
+ #define SYSTEM_DELAY_VAL (WAKEUP_TIMER_CNT / 1000 * 100)
+ #endif
+ #endif //!((TIMER_CLK_IDX >= 0) && (TIMER_CLK_IDX <=3))
+#endif // TIMER_CLK_IDX
+
+/*use timerB to wakeup AP FSM*/
+static inline void wakeup_ap(void)
+{
+ uint32_t value;
+ //uint32_t time_out = 20;
+
+ /*set alarm timer*/
+ REG32(FSM_TRIGER_SRC) = WAKEUP_TIMER_CNT; /*1ms*/
+
+ value = REG32(FSM_TRIGER_CTRL);
+ value &= ~((1 << 7) | (0x3) | (1 << 6));
+ value |= ((1 << 7) | (0 << 6) | (TIMER_CLK_IDX));
+ REG32(FSM_TRIGER_CTRL) = value;
+ vTaskDelay(pdMS_TO_TICKS(SYSTEM_DELAY_VAL) + 1);
+}
+
+static inline void clear_wakeup_trigger(void)
+{
+ REG32(FSM_TRIGER_SRC) = 0;
+ REG32(FSM_TRIGER_CTRL) = 0;
+}
+
+static inline void watchdog_reset_system(void)
+{
+ int i = 0;
+
+ printf("enter %s\n", __func__);
+ while (1) {
+ REG32(RESETCTRL_WATCHDOG_CTRL0) = 1 << 27 | 0 << 18;
+ /* Device GCC for waiting some cycles */
+ for (i = 0; i < 100; i++)
+ REG32(RESETCTRL_WATCHDOG_CTRL0);
+ }
+}
+#endif