diff --git a/bsp/ls2kdev/drivers/clk.c b/bsp/ls2kdev/drivers/clk.c new file mode 100644 index 0000000000000000000000000000000000000000..aba08bd87a59255b0d7a01ea2188a10b9f190b91 --- /dev/null +++ b/bsp/ls2kdev/drivers/clk.c @@ -0,0 +1,100 @@ +/* + * Copyright (c) 2006-2018, RT-Thread Development Team + * + * SPDX-License-Identifier: Apache-2.0 + * + * Change Logs: + * Date Author Notes + * 2017-09-06 勤为本 first version + * + * Copyright (c) 2020, duhuanpeng<548708880@qq.com> + * legacy driver APIs from loongson 1C BSP. + */ + +#include +#include "ls2k1000.h" + + +struct loongson_pll { + rt_uint64_t PLL_SYS_0; + rt_uint64_t PLL_SYS_1; + rt_uint64_t PLL_DDR_0; + rt_uint64_t PLL_DDR_1; + rt_uint64_t PLL_DC_0; + rt_uint64_t PLL_DC_1; + rt_uint64_t PLL_PIX0_0; + rt_uint64_t PLL_PIX0_1; + rt_uint64_t PLL_PIX1_0; + rt_uint64_t PLL_PIX1_1; + rt_uint64_t FREQSCALE; +}; + +/* See the Schematic */ +#define SYS_CLKSEL1 1 +#define SYS_CLKSEL0 0 + +/* bit field helpers. */ +#define __M(n) (~(~0<<(n))) +#define __RBF(number, n) ((number)&__M(n)) +#define __BF(number, n, m) __RBF((number>>m), (n-m+1)) +#define BF(number, n, m) (mPLL_SYS_0, 26, 31); + l1_div_loopc = BF(pll->PLL_SYS_0, 32, 41); + l2_div_out_node = BF(pll->PLL_SYS_1, 5, 0); + + node_clock = refclk / l1_div_ref * l1_div_loopc / l2_div_out_node; + return node_clock; +} + +unsigned long clk_get_ddr_rate(void) +{ + unsigned long ddr_clock; + int l1_div_ref; + int l1_div_loopc; + int l2_div_out_ddr; + + l1_div_ref = BF(pll->PLL_DDR_0, 26, 31); + l1_div_loopc = BF(pll->PLL_DDR_0, 32, 41); + l2_div_out_ddr = BF(pll->PLL_DDR_1, 0, 5); + + ddr_clock = refclk / l1_div_ref * l1_div_loopc / l2_div_out_ddr; + return ddr_clock; +} + +unsigned long clk_get_apb_rate(void) +{ + unsigned long apb_clock; + int apb_freqscale; + + apb_freqscale = BF(pll->FREQSCALE, 22, 20); + + /* gmac clock is fixed 125MHz */ + apb_clock = gmac_clock * (apb_freqscale + 1) / 8; + return apb_clock; + +} + +unsigned long clk_get_dc_rate(void) +{ + return -RT_ENOSYS; +} diff --git a/bsp/ls2kdev/drivers/clk.h b/bsp/ls2kdev/drivers/clk.h new file mode 100644 index 0000000000000000000000000000000000000000..3a73da861c53a502f1c6d71e2ac2a8a59d3afa85 --- /dev/null +++ b/bsp/ls2kdev/drivers/clk.h @@ -0,0 +1,23 @@ +/* + * Copyright (c) 2006-2018, RT-Thread Development Team + * + * SPDX-License-Identifier: Apache-2.0 + * + * Change Logs: + * Date Author Notes + * 2017-09-06 勤为本 first version + * + * Copyright (c) 2020, Du Huanpeng <548708880@qq.com> + * base on bsp/ls1cdev/libraries/ls1c_clock.h + */ + +#ifndef __LOONGSON_CLK_H__ +#define __LOONGSON_CLK_H__ + +unsigned long clk_get_pll_rate(void); +unsigned long clk_get_cpu_rate(void); +unsigned long clk_get_ddr_rate(void); +unsigned long clk_get_apb_rate(void); +unsigned long clk_get_dc_rate(void); + +#endif diff --git a/bsp/ls2kdev/drivers/ls2k1000.h b/bsp/ls2kdev/drivers/ls2k1000.h index 471ab80323158039073c95bcfb8c96c750f03a67..90adf4a6ed9f6800bcd8f3298d0a4bf2e61f1948 100644 --- a/bsp/ls2kdev/drivers/ls2k1000.h +++ b/bsp/ls2kdev/drivers/ls2k1000.h @@ -8,6 +8,7 @@ #define UART0_BASE CKSEG1ADDR(UART0_BASE_ADDR + UART0_OFF) #define GPIO_BASE 0xFFFFFFFFBFE10500 +#define PLL_SYS_BASE 0xFFFFFFFFBFE10480 void rt_hw_timer_handler(void); void rt_hw_uart_init(void);