rk3399: dram: use PMU M0 to do ddr frequency scaling
We used dcf do ddr frequency scaling, but we just include a dcf
binary, it hard to maintain later, we have M0 compile flow in ATF,
and M0 can also work for ddr frequency scaling, so let's use it.
Signed-off-by: Lin Huang <hl@rock-chips.com>
Signed-off-by: Xing Zheng <zhengxing@rock-chips.com>
diff --git a/plat/rockchip/rk3399/drivers/m0/Makefile b/plat/rockchip/rk3399/drivers/m0/Makefile
index c9454fe..ec2b3d2 100644
--- a/plat/rockchip/rk3399/drivers/m0/Makefile
+++ b/plat/rockchip/rk3399/drivers/m0/Makefile
@@ -46,11 +46,14 @@
.SUFFIXES:
-INCLUDES += -Iinclude/
+INCLUDES += -Iinclude/ \
+ -I../../include/shared/
# NOTE: Add C source files here
C_SOURCES := src/startup.c \
- src/main.c
+ src/main.c \
+ src/suspend.c \
+ src/dram.c
# Flags definition
CFLAGS := -g
@@ -83,10 +86,11 @@
SOURCES := $(C_SOURCES)
OBJS := $(addprefix $(BUILD)/,$(call SOURCES_TO_OBJS,$(SOURCES)))
-LINKERFILE := src/rk3399m0.ld
+LINKERFILE := $(BUILD)/$(PLAT_M0).ld
MAPFILE := $(BUILD)/$(PLAT_M0).map
ELF := $(BUILD)/$(PLAT_M0).elf
BIN := $(BUILD)/$(PLAT_M0).bin
+LINKERFILE_SRC := src/$(PLAT_M0).ld.S
# Function definition related compilation
define MAKE_C
@@ -118,8 +122,11 @@
$(and $(REMAIN),$(error Unexpected source files present: $(REMAIN)))
endef
-.PHONY: all
-all: $(BIN)
+.DEFAULT_GOAL := $(BIN)
+
+$(LINKERFILE): $(LINKERFILE_SRC)
+ $(CC) $(CFLAGS) $(INCLUDES) -P -E -D__LINKER__ -MMD -MF $@.d -MT $@ -o $@ $<
+-include $(LINKERFILE).d
$(ELF) : $(OBJS) $(LINKERFILE)
@echo " LD $@"
diff --git a/plat/rockchip/rk3399/drivers/m0/include/rk3399_mcu.h b/plat/rockchip/rk3399/drivers/m0/include/rk3399_mcu.h
index d04c06e..7f4f34c 100644
--- a/plat/rockchip/rk3399/drivers/m0/include/rk3399_mcu.h
+++ b/plat/rockchip/rk3399/drivers/m0/include/rk3399_mcu.h
@@ -31,11 +31,29 @@
#ifndef __RK3399_MCU_H__
#define __RK3399_MCU_H__
+typedef unsigned int uint32_t;
+
#define mmio_read_32(c) ({unsigned int __v = \
(*(volatile unsigned int *)(c)); __v; })
#define mmio_write_32(c, v) ((*(volatile unsigned int *)(c)) = (v))
+#define mmio_clrbits_32(addr, clear) \
+ mmio_write_32(addr, (mmio_read_32(addr) & ~(clear)))
+#define mmio_setbits_32(addr, set) \
+ mmio_write_32(addr, (mmio_read_32(addr)) | (set))
+#define mmio_clrsetbits_32(addr, clear, set) \
+ mmio_write_32(addr, (mmio_read_32(addr) & ~(clear)) | (set))
+
+#define MCU_BASE 0x40000000
+#define PMU_BASE (MCU_BASE + 0x07310000)
+#define CRU_BASE_ADDR 0x47760000
+#define GRF_BASE_ADDR 0x47770000
+#define PMU_CRU_BASE_ADDR 0x47750000
+#define VOP_LITE_BASE_ADDR 0x478F0000
+#define VOP_BIG_BASE_ADDR 0x47900000
+#define CIC_BASE_ADDR 0x47620000
+
-#define MCU_BASE 0x40000000
-#define PMU_BASE (MCU_BASE + 0x07310000)
+void handle_suspend(void);
+void handle_dram(void);
#endif /* __RK3399_MCU_H__ */
diff --git a/plat/rockchip/rk3399/drivers/m0/src/dram.c b/plat/rockchip/rk3399/drivers/m0/src/dram.c
new file mode 100644
index 0000000..79452c9
--- /dev/null
+++ b/plat/rockchip/rk3399/drivers/m0/src/dram.c
@@ -0,0 +1,225 @@
+/*
+ * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * Redistributions of source code must retain the above copyright notice, this
+ * list of conditions and the following disclaimer.
+ *
+ * Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ *
+ * Neither the name of ARM nor the names of its contributors may be used
+ * to endorse or promote products derived from this software without specific
+ * prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <m0_param.h>
+#include "rk3399_mcu.h"
+
+/* PMU */
+#define PMU_PWRDN_ST 0x18
+#define PMU_BUS_IDLE_REQ 0x60
+#define PMU_BUS_IDLE_ST 0x64
+#define PMU_NOC_AUTO_ENA 0xd8
+
+/* PMU_BUS_IDLE_REQ */
+#define IDLE_REQ_MSCH1 (1 << 19)
+#define IDLE_REQ_MSCH0 (1 << 18)
+
+/* #define PMU_BUS_IDLE_ST */
+#define IDLE_MSCH1 (1 << 19)
+#define IDLE_MSCH0 (1 << 18)
+
+#define PD_VOP_PWR_STAT (1 << 20)
+
+/* CRU */
+#define CRU_DPLL_CON0 0x40
+#define CRU_DPLL_CON1 0x44
+#define CRU_DPLL_CON2 0x48
+#define CRU_DPLL_CON3 0x4c
+#define CRU_DPLL_CON4 0x50
+#define CRU_DPLL_CON5 0x54
+
+#define CRU_DPLL_CON2 0x48
+#define CRU_DPLL_CON3 0x4c
+#define CRU_CLKGATE10_CON 0x328
+#define CRU_CLKGATE28_CON 0x370
+
+/* CRU_CLKGATE10_CON */
+#define ACLK_VOP0_PRE_SRC_EN (1 << 8)
+#define HCLK_VOP0_PRE_EN (1 << 9)
+#define ACLK_VOP1_PRE_SRC_EN (1 << 10)
+#define HCLK_VOP1_PRE_EN (1 << 11)
+#define DCLK_VOP0_SRC_EN (1 << 12)
+#define DCLK_VOP1_SRC_EN (1 << 13)
+
+/* CRU_CLKGATE28_CON */
+#define HCLK_VOP0_EN (1 << 2)
+#define ACLK_VOP0_EN (1 << 3)
+#define HCLK_VOP1_EN (1 << 6)
+#define ACLK_VOP1_EN (1 << 7)
+
+/* CRU_PLL_CON3 */
+#define PLL_SLOW_MODE 0
+#define PLL_NORMAL_MODE 1
+#define PLL_MODE(n) ((0x3 << (8 + 16)) | ((n) << 8))
+#define PLL_POWER_DOWN(n) ((0x1 << (0 + 16)) | ((n) << 0))
+
+/* PMU CRU */
+#define PMU_CRU_GATEDIS_CON0 0x130
+
+/* VOP */
+#define VOP_SYS_CTRL 0x8
+#define VOP_SYS_CTRL1 0xc
+#define VOP_INTR_CLEAR0 0x284
+#define VOP_INTR_RAW_STATUS0 0x28c
+
+/* VOP_SYS_CTRL */
+#define VOP_STANDBY_EN (1 << 22)
+
+/* VOP_INTR_CLEAR0 */
+#define INT_CLR_DMA_FINISH (1 << 15)
+#define INT_CLR_LINE_FLAG1 (1 << 4)
+#define INT_CLR_LINE_FLAG0 (1 << 3)
+
+/* VOP_INTR_RAW_STATUS0 */
+#define INT_RAW_STATUS_DMA_FINISH (1 << 15)
+#define INT_RAW_STATUS_LINE_FLAG1 (1 << 4)
+#define INT_RAW_STATUS_LINE_FLAG0 (1 << 3)
+
+/* CIC */
+#define CIC_CTRL0 0
+#define CIC_CTRL1 0x4
+#define CIC_STATUS0 0x10
+
+struct ddr_freq_param {
+ uint32_t vop_big_en;
+ uint32_t vop_lit_en;
+ uint32_t dclk0_div;
+ uint32_t dclk1_div;
+};
+
+static struct ddr_freq_param rk3399_ddr_arg;
+
+static void get_vop_status(void)
+{
+ rk3399_ddr_arg.vop_big_en = 0;
+ rk3399_ddr_arg.vop_lit_en = 0;
+
+ if ((mmio_read_32(PMU_BASE + PMU_PWRDN_ST) & PD_VOP_PWR_STAT) == 0) {
+ /* get vop0 status */
+ if ((mmio_read_32(CRU_BASE_ADDR + CRU_CLKGATE10_CON) &
+ (DCLK_VOP0_SRC_EN | ACLK_VOP0_PRE_SRC_EN |
+ HCLK_VOP0_PRE_EN)) == 0)
+ if ((mmio_read_32(CRU_BASE_ADDR + CRU_CLKGATE28_CON) &
+ (HCLK_VOP0_EN | ACLK_VOP0_EN)) == 0)
+ if ((mmio_read_32(VOP_BIG_BASE_ADDR +
+ VOP_SYS_CTRL) &
+ VOP_STANDBY_EN) == 0)
+ rk3399_ddr_arg.vop_big_en = 1;
+
+ /* get vop1 satus */
+ if ((mmio_read_32(CRU_BASE_ADDR + CRU_CLKGATE10_CON) &
+ (DCLK_VOP1_SRC_EN | ACLK_VOP1_PRE_SRC_EN |
+ HCLK_VOP1_PRE_EN)) == 0)
+ if ((mmio_read_32(CRU_BASE_ADDR + CRU_CLKGATE28_CON) &
+ (HCLK_VOP1_EN | ACLK_VOP1_EN)) == 0)
+ if ((mmio_read_32(VOP_LITE_BASE_ADDR +
+ VOP_SYS_CTRL) &
+ VOP_STANDBY_EN) == 0)
+ rk3399_ddr_arg.vop_lit_en = 1;
+ }
+}
+
+static void wait_vop_dma_finish(void)
+{
+ uint32_t vop_adr;
+
+ get_vop_status();
+
+ if (rk3399_ddr_arg.vop_big_en)
+ vop_adr = VOP_BIG_BASE_ADDR;
+ else if (rk3399_ddr_arg.vop_lit_en)
+ vop_adr = VOP_LITE_BASE_ADDR;
+ else
+ return;
+
+ /* clean dma finish irq and wait for it */
+ mmio_write_32(vop_adr + VOP_INTR_CLEAR0,
+ INT_CLR_DMA_FINISH | (INT_CLR_DMA_FINISH << 16));
+
+ while ((mmio_read_32(vop_adr + VOP_INTR_RAW_STATUS0) &
+ INT_RAW_STATUS_DMA_FINISH) == 0)
+ ;
+}
+
+static void idle_port(void)
+{
+ mmio_write_32(PMU_CRU_BASE_ADDR + PMU_CRU_GATEDIS_CON0, 0x3fffffff);
+ mmio_setbits_32(PMU_BASE + PMU_BUS_IDLE_REQ,
+ IDLE_REQ_MSCH0 | IDLE_REQ_MSCH1);
+ while ((mmio_read_32(PMU_BASE + PMU_BUS_IDLE_ST) &
+ (IDLE_MSCH1 | IDLE_MSCH0)) != (IDLE_MSCH1 | IDLE_MSCH0))
+ continue;
+}
+
+static void deidle_port(void)
+{
+ mmio_clrbits_32(PMU_BASE + PMU_BUS_IDLE_REQ,
+ IDLE_REQ_MSCH0 | IDLE_REQ_MSCH1);
+ while (mmio_read_32(PMU_BASE + PMU_BUS_IDLE_ST) &
+ (IDLE_MSCH1 | IDLE_MSCH0))
+ continue;
+}
+
+static void ddr_set_pll(void)
+{
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON3, PLL_MODE(PLL_SLOW_MODE));
+
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON3, PLL_POWER_DOWN(1));
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON0,
+ mmio_read_32(PARAM_ADDR + PARAM_DPLL_CON0));
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON1,
+ mmio_read_32(PARAM_ADDR + PARAM_DPLL_CON1));
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON3, PLL_POWER_DOWN(0));
+
+ while ((mmio_read_32(CRU_BASE_ADDR + CRU_DPLL_CON2) & (1u << 31)) == 0)
+ continue;
+
+ mmio_write_32(CRU_BASE_ADDR + CRU_DPLL_CON3, PLL_MODE(PLL_NORMAL_MODE));
+}
+
+void handle_dram(void)
+{
+ wait_vop_dma_finish();
+ idle_port();
+
+ mmio_write_32(CIC_BASE_ADDR + CIC_CTRL0,
+ (((0x3 << 4) | (1 << 2) | 1) << 16) |
+ (1 << 2) | 1 |
+ mmio_read_32(PARAM_ADDR + PARAM_FREQ_SELECT));
+ while ((mmio_read_32(CIC_BASE_ADDR + CIC_STATUS0) & (1 << 2)) == 0)
+ continue;
+
+ ddr_set_pll();
+ mmio_write_32(CIC_BASE_ADDR + CIC_CTRL0, 0x20002);
+ while ((mmio_read_32(CIC_BASE_ADDR + CIC_STATUS0) & (1 << 0)) == 0)
+ continue;
+
+ deidle_port();
+}
diff --git a/plat/rockchip/rk3399/drivers/m0/src/main.c b/plat/rockchip/rk3399/drivers/m0/src/main.c
index d9cfd10..95659c4 100644
--- a/plat/rockchip/rk3399/drivers/m0/src/main.c
+++ b/plat/rockchip/rk3399/drivers/m0/src/main.c
@@ -28,44 +28,24 @@
* POSSIBILITY OF SUCH DAMAGE.
*/
+#include <m0_param.h>
#include "rk3399_mcu.h"
-#define PMU_PWRMODE_CON 0x20
-#define PMU_POWER_ST 0x78
-
-#define M0_SCR 0xe000ed10 /* System Control Register (SCR) */
-
-#define SCR_SLEEPDEEP_SHIFT (1 << 2)
-
-static void system_wakeup(void)
+__attribute__((noreturn)) void main(void)
{
- unsigned int status_value;
- unsigned int mode_con;
-
- while (1) {
- status_value = mmio_read_32(PMU_BASE + PMU_POWER_ST);
- if (status_value) {
- mode_con = mmio_read_32(PMU_BASE + PMU_PWRMODE_CON);
- mmio_write_32(PMU_BASE + PMU_PWRMODE_CON,
- mode_con & (~0x01));
- return;
- }
+ switch (mmio_read_32(PARAM_ADDR + PARAM_M0_FUNC)) {
+ case M0_FUNC_SUSPEND:
+ handle_suspend();
+ break;
+ case M0_FUNC_DRAM:
+ handle_dram();
+ break;
+ default:
+ break;
}
-}
-int main(void)
-{
- unsigned int reg_src;
-
- system_wakeup();
-
- reg_src = mmio_read_32(M0_SCR);
-
- /* m0 enter deep sleep mode */
- mmio_write_32(M0_SCR, reg_src | SCR_SLEEPDEEP_SHIFT);
+ mmio_write_32(PARAM_ADDR + PARAM_M0_DONE, M0_DONE_FLAG);
for (;;)
- __asm volatile("wfi");
-
- return 0;
+ __asm__ volatile ("wfi");
}
diff --git a/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld b/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld.S
similarity index 93%
rename from plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld
rename to plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld.S
index 0b7b124..cb224f0 100644
--- a/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld
+++ b/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld.S
@@ -28,12 +28,16 @@
* POSSIBILITY OF SUCH DAMAGE.
*/
+#include <m0_param.h>
+
OUTPUT_FORMAT("elf32-littlearm")
SECTIONS {
.m0_bin 0 : {
KEEP(*(.isr_vector))
ASSERT(. == 0xc0, "ISR vector has the wrong size.");
+ ASSERT(. == PARAM_ADDR, "M0 params should go right behind ISR table.");
+ . += PARAM_M0_SIZE;
*(.text*)
*(.rodata*)
*(.data*)
diff --git a/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld b/plat/rockchip/rk3399/drivers/m0/src/suspend.c
similarity index 76%
copy from plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld
copy to plat/rockchip/rk3399/drivers/m0/src/suspend.c
index 0b7b124..e655940 100644
--- a/plat/rockchip/rk3399/drivers/m0/src/rk3399m0.ld
+++ b/plat/rockchip/rk3399/drivers/m0/src/suspend.c
@@ -28,19 +28,27 @@
* POSSIBILITY OF SUCH DAMAGE.
*/
-OUTPUT_FORMAT("elf32-littlearm")
+#include "rk3399_mcu.h"
-SECTIONS {
- .m0_bin 0 : {
- KEEP(*(.isr_vector))
- ASSERT(. == 0xc0, "ISR vector has the wrong size.");
- *(.text*)
- *(.rodata*)
- *(.data*)
- *(.bss*)
- . = ALIGN(8);
- *(.co_stack*)
+#define PMU_PWRMODE_CON 0x20
+#define PMU_POWER_ST 0x78
+
+#define M0_SCR 0xe000ed10 /* System Control Register (SCR) */
+
+#define SCR_SLEEPDEEP_SHIFT (1 << 2)
+
+void handle_suspend(void)
+{
+ unsigned int status_value;
+
+ while (1) {
+ status_value = mmio_read_32(PMU_BASE + PMU_POWER_ST);
+ if (status_value) {
+ mmio_clrbits_32(PMU_BASE + PMU_PWRMODE_CON, 0x01);
+ return;
+ }
}
- /DISCARD/ : { *(.comment) *(.note*) }
+ /* m0 enter deep sleep mode */
+ mmio_setbits_32(M0_SCR, SCR_SLEEPDEEP_SHIFT);
}