[U-Boot] [U-Boot, V2, PATCH 2/3] mips: add initial support for qca956x referenced board
Daniel Schwierzeck
daniel.schwierzeck at gmail.com
Wed Mar 6 13:11:11 UTC 2019
Am 05.03.19 um 08:04 schrieb rosysong at rosinson.com:
> From: Rosy Song <rosysong at rosinson.com>
>
> Signed-off-by: Rosy Song <rosysong at rosinson.com>
> ---
as requested in the last review, please provide a proper commit message.
You also need to provide a changelog if you submit an updated series.
Maybe you should read this:
https://www.denx.de/wiki/U-Boot/Patches
> arch/mips/dts/Makefile | 1 +
> arch/mips/dts/ap152.dts | 48 ++
> arch/mips/dts/qca956x.dtsi | 87 ++++
> arch/mips/mach-ath79/Kconfig | 14 +
> arch/mips/mach-ath79/Makefile | 1 +
> .../mach-ath79/include/mach/ar71xx_regs.h | 73 +++
> arch/mips/mach-ath79/include/mach/ath79.h | 3 +
> arch/mips/mach-ath79/qca956x/Makefile | 5 +
> arch/mips/mach-ath79/qca956x/clk.c | 419 ++++++++++++++++++
> arch/mips/mach-ath79/qca956x/cpu.c | 9 +
> arch/mips/mach-ath79/qca956x/ddr.c | 308 +++++++++++++
> .../mips/mach-ath79/qca956x/qca956x-ddr-tap.S | 193 ++++++++
> arch/mips/mach-ath79/reset.c | 271 +++++++++++
> board/qca/ap152/Kconfig | 15 +
> board/qca/ap152/MAINTAINERS | 6 +
> board/qca/ap152/Makefile | 3 +
> board/qca/ap152/ap152.c | 81 ++++
> configs/ap152_defconfig | 49 ++
> include/configs/ap152.h | 54 +++
> 19 files changed, 1640 insertions(+)
> create mode 100644 arch/mips/dts/ap152.dts
> create mode 100644 arch/mips/dts/qca956x.dtsi
> create mode 100644 arch/mips/mach-ath79/qca956x/Makefile
> create mode 100644 arch/mips/mach-ath79/qca956x/clk.c
> create mode 100644 arch/mips/mach-ath79/qca956x/cpu.c
> create mode 100644 arch/mips/mach-ath79/qca956x/ddr.c
> create mode 100644 arch/mips/mach-ath79/qca956x/qca956x-ddr-tap.S
> create mode 100644 board/qca/ap152/Kconfig
> create mode 100644 board/qca/ap152/MAINTAINERS
> create mode 100644 board/qca/ap152/Makefile
> create mode 100644 board/qca/ap152/ap152.c
> create mode 100644 configs/ap152_defconfig
> create mode 100644 include/configs/ap152.h
>
> diff --git a/arch/mips/dts/Makefile b/arch/mips/dts/Makefile
> index b94b582837..621c35f0ef 100644
> --- a/arch/mips/dts/Makefile
> +++ b/arch/mips/dts/Makefile
> @@ -2,6 +2,7 @@
>
> dtb-$(CONFIG_TARGET_AP121) += ap121.dtb
> dtb-$(CONFIG_TARGET_AP143) += ap143.dtb
> +dtb-$(CONFIG_TARGET_AP152) += ap152.dtb
> dtb-$(CONFIG_TARGET_BOSTON) += img,boston.dtb
> dtb-$(CONFIG_TARGET_MALTA) += mti,malta.dtb
> dtb-$(CONFIG_TARGET_PIC32MZDASK) += pic32mzda_sk.dtb
> diff --git a/arch/mips/dts/ap152.dts b/arch/mips/dts/ap152.dts
> new file mode 100644
> index 0000000000..1722290c73
> --- /dev/null
> +++ b/arch/mips/dts/ap152.dts
> @@ -0,0 +1,48 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2018 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +/dts-v1/;
> +#include "qca956x.dtsi"
> +
> +/ {
> + model = "AP152 Reference Board";
> + compatible = "qca,ap152", "qca,qca956x";
> +
> + aliases {
> + spi0 = &spi0;
> + serial0 = &uart0;
> + };
> +
> + chosen {
> + stdout-path = "serial0:115200n8";
> + };
> +};
> +
> +&gmac0 {
> + phy-mode = "sgmii";
> + status = "okay";
> +};
> +
> +&xtal {
> + clock-frequency = <25000000>;
> +};
> +
> +&uart0 {
> + clock-frequency = <25000000>;
> + status = "okay";
> +};
> +
> +&spi0 {
> + spi-max-frequency = <25000000>;
> + status = "okay";
> + spi-flash at 0 {
> + #address-cells = <1>;
> + #size-cells = <1>;
> + compatible = "spi-flash";
> + memory-map = <0x9f000000 0x01000000>;
> + spi-max-frequency = <25000000>;
> + reg = <0>;
> + };
> +};
> diff --git a/arch/mips/dts/qca956x.dtsi b/arch/mips/dts/qca956x.dtsi
> new file mode 100644
> index 0000000000..6cb360b3f8
> --- /dev/null
> +++ b/arch/mips/dts/qca956x.dtsi
> @@ -0,0 +1,87 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2018 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +#include "skeleton.dtsi"
> +
> +/ {
> + compatible = "qca,qca956x";
> +
> + #address-cells = <1>;
> + #size-cells = <1>;
> +
> + cpus {
> + #address-cells = <1>;
> + #size-cells = <0>;
> +
> + cpu at 0 {
> + device_type = "cpu";
> + compatible = "mips,mips74Kc";
> + reg = <0>;
> + };
> + };
> +
> + clocks {
> + #address-cells = <1>;
> + #size-cells = <1>;
> + ranges;
> +
> + xtal: xtal {
> + #clock-cells = <0>;
> + compatible = "fixed-clock";
> + clock-output-names = "xtal";
> + };
> + };
> +
> + ahb {
> + compatible = "simple-bus";
> + ranges;
> +
> + #address-cells = <1>;
> + #size-cells = <1>;
> +
> + apb {
> + compatible = "simple-bus";
> + ranges;
> +
> + #address-cells = <1>;
> + #size-cells = <1>;
> +
> + uart0: uart at 18020000 {
> + compatible = "ns16550";
> + reg = <0x18020000 0x20>;
> + reg-shift = <2>;
> +
> + status = "disabled";
> + };
> +
> + gmac0: eth at 0x19000000 {
> + compatible = "qca,ag956x-mac";
> + reg = <0x19000000 0x200>;
> + phy = <&phy0>;
> + phy-mode = "sgmii";
> +
> + status = "disabled";
> +
> + mdio {
> + #address-cells = <1>;
> + #size-cells = <0>;
> + phy0: ethernet-phy at 0 {
> + reg = <0>;
> + };
> + };
> + };
> + };
> +
> + spi0: spi at 1f000000 {
> + compatible = "qca,ar7100-spi";
> + reg = <0x1f000000 0x10>;
> +
> + status = "disabled";
> +
> + #address-cells = <1>;
> + #size-cells = <0>;
> + };
> + };
> +};
> diff --git a/arch/mips/mach-ath79/Kconfig b/arch/mips/mach-ath79/Kconfig
> index bc86f591df..bdb23b5765 100644
> --- a/arch/mips/mach-ath79/Kconfig
> +++ b/arch/mips/mach-ath79/Kconfig
> @@ -33,6 +33,15 @@ config SOC_QCA953X
> help
> This supports QCA/Atheros qca953x family SOCs.
>
> +config SOC_QCA956X
> + bool
> + select MIPS_TUNE_74KC
> + select SUPPORTS_BIG_ENDIAN
> + select SUPPORTS_CPU_MIPS32_R1
> + select SUPPORTS_CPU_MIPS32_R2
> + help
> + This supports QCA/Atheros qca956x family SOCs.
> +
> choice
> prompt "Board select"
>
> @@ -44,6 +53,10 @@ config TARGET_AP143
> bool "AP143 Reference Board"
> select SOC_QCA953X
>
> +config TARGET_AP152
> + bool "AP152 Reference Board"
> + select SOC_QCA956X
> +
> config BOARD_TPLINK_WDR4300
> bool "TP-Link WDR4300 Board"
> select SOC_AR934X
> @@ -52,6 +65,7 @@ endchoice
>
> source "board/qca/ap121/Kconfig"
> source "board/qca/ap143/Kconfig"
> +source "board/qca/ap152/Kconfig"
> source "board/tplink/wdr4300/Kconfig"
>
> endmenu
> diff --git a/arch/mips/mach-ath79/Makefile b/arch/mips/mach-ath79/Makefile
> index 7aa40c65d3..fbd40c02be 100644
> --- a/arch/mips/mach-ath79/Makefile
> +++ b/arch/mips/mach-ath79/Makefile
> @@ -7,3 +7,4 @@ obj-y += dram.o
> obj-$(CONFIG_SOC_AR933X) += ar933x/
> obj-$(CONFIG_SOC_AR934X) += ar934x/
> obj-$(CONFIG_SOC_QCA953X) += qca953x/
> +obj-$(CONFIG_SOC_QCA956X) += qca956x/
> diff --git a/arch/mips/mach-ath79/include/mach/ar71xx_regs.h b/arch/mips/mach-ath79/include/mach/ar71xx_regs.h
> index 5d371bb582..7cd16b8d81 100644
> --- a/arch/mips/mach-ath79/include/mach/ar71xx_regs.h
> +++ b/arch/mips/mach-ath79/include/mach/ar71xx_regs.h
> @@ -194,6 +194,9 @@
> #define QCA956X_WMAC_BASE \
> (AR71XX_APB_BASE + 0x00100000)
> #define QCA956X_WMAC_SIZE 0x20000
> +#define QCA956X_RTC_BASE \
> + (AR71XX_APB_BASE + 0x00107000)
> +#define QCA956X_RTC_SIZE 0x1000
> #define QCA956X_EHCI0_BASE 0x1b000000
> #define QCA956X_EHCI1_BASE 0x1b400000
> #define QCA956X_EHCI_SIZE 0x200
> @@ -201,6 +204,10 @@
> (AR71XX_APB_BASE + 0x00070000)
> #define QCA956X_GMAC_SIZE 0x64
>
> +#define QCA956X_SRIF_BASE \
> + (AR71XX_APB_BASE + 0x00116000)
> +#define QCA956X_SRIF_SIZE 0x1000
> +
> /*
> * DDR_CTRL block
> */
> @@ -278,6 +285,18 @@
> #define QCA953X_DDR_REG_CTL_CONF 0x108
> #define QCA953X_DDR_REG_CONFIG3 0x15c
>
> +#define QCA956X_DDR_REG_TAP_CTRL2 0x24
> +#define QCA956X_DDR_REG_TAP_CTRL3 0x28
> +#define QCA956X_DDR_REG_DDR2_CONFIG 0xb8
> +#define QCA956X_DDR_REG_DDR2_EMR2 0xbc
> +#define QCA956X_DDR_REG_DDR2_EMR3 0xc0
> +#define QCA956X_DDR_REG_BURST 0xc4
> +#define QCA956X_DDR_REG_BURST2 0xc8
> +#define QCA956X_DDR_REG_TIMEOUT_MAX 0xcc
> +#define QCA956X_DDR_REG_FSM_WAIT_CTRL 0xe4
> +#define QCA956X_DDR_REG_CTL_CONF 0x108
> +#define QCA956X_DDR_REG_DDR3_CONFIG 0x15c
> +
> /*
> * PLL block
> */
> @@ -519,6 +538,13 @@
> #define QCA956X_PLL_DDR_CONFIG_REG 0x08
> #define QCA956X_PLL_DDR_CONFIG1_REG 0x0c
> #define QCA956X_PLL_CLK_CTRL_REG 0x10
> +#define QCA956X_PLL_SWITCH_CLK_CTRL_REG 0x28
> +#define QCA956X_PLL_ETH_XMII_CTRL_REG 0x30
> +#define QCA956X_PLL_DDR_DIT_FRAC_REG 0x38
> +#define QCA956X_PLL_DDR_DIT2_FRAC_REG 0x3c
> +#define QCA956X_PLL_CPU_DIT_FRAC_REG 0x40
> +#define QCA956X_PLL_CPU_DIT2_FRAC_REG 0x44
> +#define QCA956X_PLL_ETH_SGMII_SERDES_REG 0x4c
>
> #define QCA956X_PLL_CPU_CONFIG_REFDIV_SHIFT 12
> #define QCA956X_PLL_CPU_CONFIG_REFDIV_MASK 0x1f
> @@ -756,6 +782,17 @@
> #define QCA955X_RESET_MBOX BIT(1)
> #define QCA955X_RESET_I2S BIT(0)
>
> +#define QCA956X_RESET_EXTERNAL BIT(28)
> +#define QCA956X_RESET_FULL_CHIP BIT(24)
> +#define QCA956X_RESET_GE1_MDIO BIT(23) /* Reserved in datasheet */
> +#define QCA956X_RESET_GE0_MDIO BIT(22)
> +#define QCA956X_RESET_GE1_MAC BIT(13) /* Reserved in datasheet */
> +#define QCA956X_RESET_SGMII_ASSERT BIT(12)
> +#define QCA956X_RESET_GE0_MAC BIT(9)
> +#define QCA956X_RESET_SGMII BIT(8)
> +#define QCA956X_RESET_SGMII_ANALOG BIT(2)
> +#define QCA956X_RESET_SWITCH BIT(0)
> +
> #define AR933X_BOOTSTRAP_MDIO_GPIO_EN BIT(18)
> #define AR933X_BOOTSTRAP_DDR2 BIT(13)
> #define AR933X_BOOTSTRAP_EEPBUSY BIT(4)
> @@ -1099,8 +1136,12 @@
> #define QCA953X_GPIO_IN_MUX_UART0_SIN 9
> #define QCA953X_GPIO_IN_MUX_SPI_DATA_IN 8
>
> +#define QCA956X_GPIO(x) BIT(x)
> +#define QCA956X_GPIO_MUX_MASK(x) (0xff << (x))
> #define QCA956X_GPIO_OUT_MUX_GE0_MDO 32
> #define QCA956X_GPIO_OUT_MUX_GE0_MDC 33
> +#define QCA956X_GPIO_IN_MUX_UART0_SIN 0x12
> +#define QCA956X_GPIO_OUT_MUX_UART0_SOUT 0x16
>
> #define AR71XX_GPIO_COUNT 16
> #define AR7240_GPIO_COUNT 18
> @@ -1179,6 +1220,25 @@
> #define QCA953X_SRIF_DPLL2_OUTDIV_SHIFT 13
> #define QCA953X_SRIF_DPLL2_OUTDIV_MASK 0x7
>
> +#define QCA956X_SRIF_BB_DPLL1_REG 0x180
> +#define QCA956X_SRIF_BB_DPLL2_REG 0x184
> +#define QCA956X_SRIF_BB_DPLL3_REG 0x188
> +
> +#define QCA956X_SRIF_CPU_DPLL1_REG 0xf00
> +#define QCA956X_SRIF_CPU_DPLL2_REG 0xf04
> +#define QCA956X_SRIF_CPU_DPLL3_REG 0xf08
> +
> +#define QCA956X_SRIF_DDR_DPLL1_REG 0xec0
> +#define QCA956X_SRIF_DDR_DPLL2_REG 0xec4
> +#define QCA956X_SRIF_DDR_DPLL3_REG 0xec8
> +
> +#define QCA956X_SRIF_PCIE_DPLL1_REG 0xc80
> +#define QCA956X_SRIF_PCIE_DPLL2_REG 0xc84
> +#define QCA956X_SRIF_PCIE_DPLL3_REG 0xc88
> +
> +#define QCA956X_SRIF_PMU1_REG 0xcc0
> +#define QCA956X_SRIF_PMU2_REG 0xcc4
> +
> /*
> * MII_CTRL block
> */
> @@ -1261,4 +1321,17 @@
> #define QCA955X_ETH_CFG_RGMII_EN BIT(0)
> #define QCA955X_ETH_CFG_GE0_SGMII BIT(6)
>
> +/*
> + * QCA956X GMAC Interface
> + */
> +
> +#define QCA956X_GMAC_REG_ETH_CFG 0x00
> +#define QCA956X_GMAC_REG_SGMII_RESET 0x14
> +#define QCA956X_GMAC_REG_SGMII_SERDES 0x18
> +#define QCA956X_GMAC_REG_MR_AN_CTRL 0x1c
> +#define QCA956X_GMAC_REG_SGMII_CONFIG 0x34
> +#define QCA956X_GMAC_REG_SGMII_DEBUG 0x58
> +
> +#define QCA956X_ETH_CFG_GE0_SGMII BIT(6)
> +
> #endif /* __ASM_AR71XX_H */
> diff --git a/arch/mips/mach-ath79/include/mach/ath79.h b/arch/mips/mach-ath79/include/mach/ath79.h
> index 5de7a43f79..0fde5079b1 100644
> --- a/arch/mips/mach-ath79/include/mach/ath79.h
> +++ b/arch/mips/mach-ath79/include/mach/ath79.h
> @@ -2,6 +2,7 @@
> /*
> * Atheros AR71XX/AR724X/AR913X common definitions
> *
> + * Copyright (C) 2018-2019 Rosy Song <rosysong at rosinson.com>
> * Copyright (C) 2015-2016 Wills Wang <wills.wang at live.com>
> * Copyright (C) 2008-2011 Gabor Juhos <juhosg at openwrt.org>
> * Copyright (C) 2008 Imre Kaloz <kaloz at openwrt.org>
> @@ -146,4 +147,6 @@ int ath79_usb_reset(void);
> void ar934x_pll_init(const u16 cpu_mhz, const u16 ddr_mhz, const u16 ahb_mhz);
> void ar934x_ddr_init(const u16 cpu_mhz, const u16 ddr_mhz, const u16 ahb_mhz);
>
> +void qca956x_pll_init(void);
> +void qca956x_ddr_init(void);
> #endif /* __ASM_MACH_ATH79_H */
> diff --git a/arch/mips/mach-ath79/qca956x/Makefile b/arch/mips/mach-ath79/qca956x/Makefile
> new file mode 100644
> index 0000000000..3f5fc0363f
> --- /dev/null
> +++ b/arch/mips/mach-ath79/qca956x/Makefile
> @@ -0,0 +1,5 @@
> +# SPDX-License-Identifier: GPL-2.0+
> +
> +obj-y += cpu.o
> +obj-y += clk.o
> +obj-y += ddr.o qca956x-ddr-tap.o
> diff --git a/arch/mips/mach-ath79/qca956x/clk.c b/arch/mips/mach-ath79/qca956x/clk.c
> new file mode 100644
> index 0000000000..ca956d1291
> --- /dev/null
> +++ b/arch/mips/mach-ath79/qca956x/clk.c
> @@ -0,0 +1,419 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2019 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +#include <common.h>
> +#include <asm/io.h>
> +#include <asm/addrspace.h>
> +#include <asm/types.h>
> +#include <mach/ar71xx_regs.h>
> +#include <mach/ath79.h>
> +#include <wait_bit.h>
> +
> +#define PLL_SRIF_DPLL2_KI_LSB 29
> +#define PLL_SRIF_DPLL2_KI_MASK 0x60000000
> +#define PLL_SRIF_DPLL2_KI_SET(x) \
> + (((x) << PLL_SRIF_DPLL2_KI_LSB) & PLL_SRIF_DPLL2_KI_MASK)
> +#define PLL_SRIF_DPLL2_KD_LSB 25
> +#define PLL_SRIF_DPLL2_KD_MASK 0x1e000000
> +#define PLL_SRIF_DPLL2_KD_SET(x) \
> + (((x) << PLL_SRIF_DPLL2_KD_LSB) & PLL_SRIF_DPLL2_KD_MASK)
> +#define PLL_SRIF_DPLL2_PLL_PWD_LSB 22
> +#define PLL_SRIF_DPLL2_PLL_PWD_MASK 0x00400000
> +#define PLL_SRIF_DPLL2_PLL_PWD_SET(x) \
> + (((x) << PLL_SRIF_DPLL2_PLL_PWD_LSB) & PLL_SRIF_DPLL2_PLL_PWD_MASK)
> +#define PLL_SRIF_DPLL2_OUTDIV_LSB 19
> +#define PLL_SRIF_DPLL2_OUTDIV_MASK 0x00380000
> +#define PLL_SRIF_DPLL2_OUTDIV_SET(x) \
> + (((x) << PLL_SRIF_DPLL2_OUTDIV_LSB) & PLL_SRIF_DPLL2_OUTDIV_MASK)
> +#define PLL_SRIF_DPLL2_PHASE_SHIFT_LSB 12
> +#define PLL_SRIF_DPLL2_PHASE_SHIFT_MASK 0x0007f000
> +#define PLL_SRIF_DPLL2_PHASE_SHIFT_SET(x) \
> + (((x) << PLL_SRIF_DPLL2_PHASE_SHIFT_LSB) & PLL_SRIF_DPLL2_PHASE_SHIFT_MASK)
> +#define CPU_PLL_CONFIG_PLLPWD_LSB 30
> +#define CPU_PLL_CONFIG_PLLPWD_MASK 0x40000000
> +#define CPU_PLL_CONFIG_PLLPWD_SET(x) \
> + (((x) << CPU_PLL_CONFIG_PLLPWD_LSB) & CPU_PLL_CONFIG_PLLPWD_MASK)
> +#define CPU_PLL_CONFIG_OUTDIV_LSB 19
> +#define CPU_PLL_CONFIG_OUTDIV_MASK 0x00380000
> +#define CPU_PLL_CONFIG_OUTDIV_SET(x) \
> + (((x) << CPU_PLL_CONFIG_OUTDIV_LSB) & CPU_PLL_CONFIG_OUTDIV_MASK)
> +#define CPU_PLL_CONFIG_RANGE_LSB 17
> +#define CPU_PLL_CONFIG_RANGE_MASK 0x00060000
> +#define CPU_PLL_CONFIG_RANGE_SET(x) \
> + (((x) << CPU_PLL_CONFIG_RANGE_LSB) & CPU_PLL_CONFIG_RANGE_MASK)
> +#define CPU_PLL_CONFIG_REFDIV_LSB 12
> +#define CPU_PLL_CONFIG_REFDIV_MASK 0x0001f000
> +#define CPU_PLL_CONFIG_REFDIV_SET(x) \
> + (((x) << CPU_PLL_CONFIG_REFDIV_LSB) & CPU_PLL_CONFIG_REFDIV_MASK)
> +#define CPU_PLL_CONFIG1_NINT_LSB 18
> +#define CPU_PLL_CONFIG1_NINT_MASK 0x07fc0000
> +#define CPU_PLL_CONFIG1_NINT_SET(x) \
> + (((x) << CPU_PLL_CONFIG1_NINT_LSB) & CPU_PLL_CONFIG1_NINT_MASK)
> +#define CPU_PLL_DITHER1_DITHER_EN_LSB 31
> +#define CPU_PLL_DITHER1_DITHER_EN_MASK 0x80000000
> +#define CPU_PLL_DITHER1_DITHER_EN_SET(x) \
> + (((x) << CPU_PLL_DITHER1_DITHER_EN_LSB) & CPU_PLL_DITHER1_DITHER_EN_MASK)
> +#define CPU_PLL_DITHER1_UPDATE_COUNT_LSB 24
> +#define CPU_PLL_DITHER1_UPDATE_COUNT_MASK 0x3f000000
> +#define CPU_PLL_DITHER1_UPDATE_COUNT_SET(x) \
> + (((x) << CPU_PLL_DITHER1_UPDATE_COUNT_LSB) & CPU_PLL_DITHER1_UPDATE_COUNT_MASK)
> +#define CPU_PLL_DITHER1_NFRAC_STEP_LSB 18
> +#define CPU_PLL_DITHER1_NFRAC_STEP_MASK 0x00fc0000
> +#define CPU_PLL_DITHER1_NFRAC_STEP_SET(x) \
> + (((x) << CPU_PLL_DITHER1_NFRAC_STEP_LSB) & CPU_PLL_DITHER1_NFRAC_STEP_MASK)
> +#define CPU_PLL_DITHER1_NFRAC_MIN_LSB 0
> +#define CPU_PLL_DITHER1_NFRAC_MIN_MASK 0x0003ffff
> +#define CPU_PLL_DITHER1_NFRAC_MIN_SET(x) \
> + (((x) << CPU_PLL_DITHER1_NFRAC_MIN_LSB) & CPU_PLL_DITHER1_NFRAC_MIN_MASK)
> +#define CPU_PLL_DITHER2_NFRAC_MAX_LSB 0
> +#define CPU_PLL_DITHER2_NFRAC_MAX_MASK 0x0003ffff
> +#define CPU_PLL_DITHER2_NFRAC_MAX_SET(x) \
> + (((x) << CPU_PLL_DITHER2_NFRAC_MAX_LSB) & CPU_PLL_DITHER2_NFRAC_MAX_MASK)
> +#define DDR_PLL_CONFIG_PLLPWD_LSB 30
> +#define DDR_PLL_CONFIG_PLLPWD_MASK 0x40000000
> +#define DDR_PLL_CONFIG_PLLPWD_SET(x) \
> + (((x) << DDR_PLL_CONFIG_PLLPWD_LSB) & DDR_PLL_CONFIG_PLLPWD_MASK)
> +#define DDR_PLL_CONFIG_OUTDIV_LSB 23
> +#define DDR_PLL_CONFIG_OUTDIV_MASK 0x03800000
> +#define DDR_PLL_CONFIG_OUTDIV_SET(x) \
> + (((x) << DDR_PLL_CONFIG_OUTDIV_LSB) & DDR_PLL_CONFIG_OUTDIV_MASK)
> +#define DDR_PLL_CONFIG_RANGE_LSB 21
> +#define DDR_PLL_CONFIG_RANGE_MASK 0x00600000
> +#define DDR_PLL_CONFIG_RANGE_SET(x) \
> + (((x) << DDR_PLL_CONFIG_RANGE_LSB) & DDR_PLL_CONFIG_RANGE_MASK)
> +#define DDR_PLL_CONFIG_REFDIV_LSB 16
> +#define DDR_PLL_CONFIG_REFDIV_MASK 0x001f0000
> +#define DDR_PLL_CONFIG_REFDIV_SET(x) \
> + (((x) << DDR_PLL_CONFIG_REFDIV_LSB) & DDR_PLL_CONFIG_REFDIV_MASK)
> +#define DDR_PLL_CONFIG1_NINT_LSB 18
> +#define DDR_PLL_CONFIG1_NINT_MASK 0x07fc0000
> +#define DDR_PLL_CONFIG1_NINT_SET(x) \
> + (((x) << DDR_PLL_CONFIG1_NINT_LSB) & DDR_PLL_CONFIG1_NINT_MASK)
> +#define DDR_PLL_DITHER1_DITHER_EN_LSB 31
> +#define DDR_PLL_DITHER1_DITHER_EN_MASK 0x80000000
> +#define DDR_PLL_DITHER1_DITHER_EN_SET(x) \
> + (((x) << DDR_PLL_DITHER1_DITHER_EN_LSB) & DDR_PLL_DITHER1_DITHER_EN_MASK)
> +#define DDR_PLL_DITHER1_UPDATE_COUNT_LSB 27
> +#define DDR_PLL_DITHER1_UPDATE_COUNT_MASK 0x78000000
> +#define DDR_PLL_DITHER1_UPDATE_COUNT_SET(x) \
> + (((x) << DDR_PLL_DITHER1_UPDATE_COUNT_LSB) & DDR_PLL_DITHER1_UPDATE_COUNT_MASK)
> +#define DDR_PLL_DITHER1_NFRAC_STEP_LSB 20
> +#define DDR_PLL_DITHER1_NFRAC_STEP_MASK 0x07f00000
> +#define DDR_PLL_DITHER1_NFRAC_STEP_SET(x) \
> + (((x) << DDR_PLL_DITHER1_NFRAC_STEP_LSB) & DDR_PLL_DITHER1_NFRAC_STEP_MASK)
> +#define DDR_PLL_DITHER1_NFRAC_MIN_LSB 0
> +#define DDR_PLL_DITHER1_NFRAC_MIN_MASK 0x0003ffff
> +#define DDR_PLL_DITHER1_NFRAC_MIN_SET(x) \
> + (((x) << DDR_PLL_DITHER1_NFRAC_MIN_LSB) & DDR_PLL_DITHER1_NFRAC_MIN_MASK)
> +#define DDR_PLL_DITHER2_NFRAC_MAX_LSB 0
> +#define DDR_PLL_DITHER2_NFRAC_MAX_MASK 0x0003ffff
> +#define DDR_PLL_DITHER2_NFRAC_MAX_SET(x) \
> + (((x) << DDR_PLL_DITHER2_NFRAC_MAX_LSB) & DDR_PLL_DITHER2_NFRAC_MAX_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_LSB 24
> +#define CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_MASK 0x01000000
> +#define CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_LSB) & CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_LSB 21
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_MASK 0x00200000
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_LSB) & CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_LSB 20
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_MASK 0x00100000
> +#define CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_LSB) & CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_LSB 15
> +#define CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_MASK 0x000f8000
> +#define CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_LSB) & CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_LSB 10
> +#define CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_MASK 0x00007c00
> +#define CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_LSB) & CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_LSB 5
> +#define CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_MASK 0x000003e0
> +#define CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_LSB) & CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_LSB 4
> +#define CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_MASK 0x00000010
> +#define CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_LSB) & CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_LSB 3
> +#define CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_MASK 0x00000008
> +#define CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_LSB) & CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_MASK)
> +#define CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_LSB 2
> +#define CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_MASK 0x00000004
> +#define CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_SET(x) \
> + (((x) << CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_LSB) & CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_MASK)
> +
> +#define CPU_PLL_CONFIG1_NINT_VAL CPU_PLL_CONFIG1_NINT_SET(0x1f)
> +#define CPU_PLL_CONFIG_REF_DIV_VAL CPU_PLL_CONFIG_REFDIV_SET(0x1)
> +#define CPU_PLL_CONFIG_RANGE_VAL CPU_PLL_CONFIG_RANGE_SET(0)
> +#define CPU_PLL_CONFIG_OUT_DIV_VAL1 CPU_PLL_CONFIG_OUTDIV_SET(0)
> +#define CPU_PLL_CONFIG_OUT_DIV_VAL2 CPU_PLL_CONFIG_OUTDIV_SET(0)
> +#define CPU_PLL_DITHER1_VAL CPU_PLL_DITHER1_DITHER_EN_SET(0) | \
> + CPU_PLL_DITHER1_NFRAC_MIN_SET(0) | \
> + CPU_PLL_DITHER1_NFRAC_STEP_SET(0) | \
> + CPU_PLL_DITHER1_UPDATE_COUNT_SET(0x0)
> +#define CPU_PLL_DITHER2_VAL CPU_PLL_DITHER2_NFRAC_MAX_SET(0x0)
> +#define DDR_PLL_CONFIG1_NINT_VAL DDR_PLL_CONFIG1_NINT_SET(0x1a)
> +#define DDR_PLL_CONFIG_REF_DIV_VAL DDR_PLL_CONFIG_REFDIV_SET(0x1)
> +#define DDR_PLL_CONFIG_RANGE_VAL DDR_PLL_CONFIG_RANGE_SET(0)
> +#define DDR_PLL_CONFIG_OUT_DIV_VAL1 DDR_PLL_CONFIG_OUTDIV_SET(0)
> +#define DDR_PLL_CONFIG_OUT_DIV_VAL2 DDR_PLL_CONFIG_OUTDIV_SET(0)
> +#define DDR_PLL_DITHER1_VAL DDR_PLL_DITHER1_DITHER_EN_SET(0) | \
> + DDR_PLL_DITHER1_NFRAC_MIN_SET(0) | \
> + DDR_PLL_DITHER1_NFRAC_STEP_SET(0) | \
> + DDR_PLL_DITHER1_UPDATE_COUNT_SET(0x0)
> +#define DDR_PLL_DITHER2_VAL DDR_PLL_DITHER2_NFRAC_MAX_SET(0x0)
> +#define AHB_CLK_FROM_DDR CPU_DDR_CLOCK_CONTROL_AHBCLK_FROM_DDRPLL_SET(0)
> +#define CPU_AND_DDR_CLK_FROM_DDR \
> + CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_DDRPLL_SET(0)
> +#define CPU_AND_DDR_CLK_FROM_CPU \
> + CPU_DDR_CLOCK_CONTROL_CPU_DDR_CLK_FROM_CPUPLL_SET(0)
> +#define CPU_DDR_CLOCK_CONTROL_AHB_DIV_VAL \
> + CPU_DDR_CLOCK_CONTROL_AHB_POST_DIV_SET(0x2)
> +#define CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV \
> + CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV_SET(0)
> +#define CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV \
> + CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV_SET(0)
> +
> +static inline void set_val(u32 _reg, u32 _mask, u32 _val)
> +{
> + void __iomem *pll_regs = map_physmem(AR71XX_PLL_BASE,
> + AR71XX_PLL_SIZE, MAP_NOCACHE);
> + writel((readl(pll_regs + _reg) & (~(_mask))) | _val, pll_regs + _reg);
> +}
> +
> +#define cpu_pll_set(_mask, _val) \
> + set_val(QCA956X_PLL_CPU_CONFIG_REG, _mask, _val)
> +
> +#define ddr_pll_set(_mask, _val) \
> + set_val(QCA956X_PLL_DDR_CONFIG_REG, _mask, _val)
> +
> +#define cpu_ddr_control_set(_mask, _val) \
> + set_val(QCA956X_PLL_CLK_CTRL_REG, _mask, _val)
> +
> +DECLARE_GLOBAL_DATA_PTR;
> +
> +static u32 qca956x_get_xtal(void)
> +{
> + u32 val;
> +
> + val = ath79_get_bootstrap();
> + if (val & QCA956X_BOOTSTRAP_REF_CLK_40)
> + return 40000000;
> + else
> + return 25000000;
> +}
> +
> +int get_serial_clock(void)
> +{
> + return qca956x_get_xtal();
> +}
> +
> +void qca956x_pll_init(void)
> +{
> + void __iomem *srif_regs = map_physmem(QCA956X_SRIF_BASE,
> + QCA956X_SRIF_SIZE, MAP_NOCACHE);
> + void __iomem *pll_regs = map_physmem(AR71XX_PLL_BASE,
> + AR71XX_PLL_SIZE, MAP_NOCACHE);
> +
> + /* 8.16.2 Baseband DPLL2 */
> + writel(PLL_SRIF_DPLL2_KI_SET(2) | PLL_SRIF_DPLL2_KD_SET(0xa) |
> + PLL_SRIF_DPLL2_PLL_PWD_SET(1) | PLL_SRIF_DPLL2_OUTDIV_SET(1) |
> + PLL_SRIF_DPLL2_PHASE_SHIFT_SET(6), srif_regs + QCA956X_SRIF_BB_DPLL2_REG);
> +
> + /* 8.16.2 PCIE DPLL2 */
> + writel(PLL_SRIF_DPLL2_KI_SET(2) | PLL_SRIF_DPLL2_KD_SET(0xa) |
> + PLL_SRIF_DPLL2_PLL_PWD_SET(1) | PLL_SRIF_DPLL2_OUTDIV_SET(3) |
> + PLL_SRIF_DPLL2_PHASE_SHIFT_SET(6), srif_regs + QCA956X_SRIF_PCIE_DPLL2_REG);
> +
> + /* 8.16.2 DDR DPLL2 */
> + writel(PLL_SRIF_DPLL2_KI_SET(2) | PLL_SRIF_DPLL2_KD_SET(0xa) |
> + PLL_SRIF_DPLL2_PLL_PWD_SET(1) | PLL_SRIF_DPLL2_PHASE_SHIFT_SET(6),
> + srif_regs + QCA956X_SRIF_DDR_DPLL2_REG);
> +
> + /* 8.16.2 CPU DPLL2 */
> + writel(PLL_SRIF_DPLL2_KI_SET(1) | PLL_SRIF_DPLL2_KD_SET(7) |
> + PLL_SRIF_DPLL2_PLL_PWD_SET(1) | PLL_SRIF_DPLL2_PHASE_SHIFT_SET(6),
> + srif_regs + QCA956X_SRIF_CPU_DPLL2_REG);
> +
> + /* pll_bypass_set */
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_SET(1));
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_SET(1));
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_SET(1));
> +
> + /* init_cpu_pll */
> + cpu_pll_set(CPU_PLL_CONFIG_PLLPWD_MASK, CPU_PLL_CONFIG_PLLPWD_SET(1));
> + cpu_pll_set(CPU_PLL_CONFIG_REFDIV_MASK, CPU_PLL_CONFIG_REF_DIV_VAL);
> + cpu_pll_set(CPU_PLL_CONFIG_RANGE_MASK, CPU_PLL_CONFIG_RANGE_VAL);
> + cpu_pll_set(CPU_PLL_CONFIG_OUTDIV_MASK, CPU_PLL_CONFIG_OUT_DIV_VAL1);
> + set_val(QCA956X_PLL_CPU_CONFIG1_REG, CPU_PLL_CONFIG1_NINT_MASK, \
> + CPU_PLL_CONFIG1_NINT_VAL);
> +
> + /* init_ddr_pll */
> + ddr_pll_set(DDR_PLL_CONFIG_PLLPWD_MASK, DDR_PLL_CONFIG_PLLPWD_SET(1));
> + ddr_pll_set(DDR_PLL_CONFIG_REFDIV_MASK, DDR_PLL_CONFIG_REF_DIV_VAL);
> + ddr_pll_set(DDR_PLL_CONFIG_RANGE_MASK, DDR_PLL_CONFIG_RANGE_VAL);
> + ddr_pll_set(DDR_PLL_CONFIG_OUTDIV_MASK, DDR_PLL_CONFIG_OUT_DIV_VAL1);
> + set_val(QCA956X_PLL_DDR_CONFIG1_REG, DDR_PLL_CONFIG1_NINT_MASK,
> + DDR_PLL_CONFIG1_NINT_VAL);
> +
> + /* init_ahb_pll */
> + writel(CPU_DDR_CLOCK_CONTROL_AHB_DIV_VAL | AHB_CLK_FROM_DDR |
> + CPU_AND_DDR_CLK_FROM_DDR | CPU_AND_DDR_CLK_FROM_CPU |
> + CPU_DDR_CLOCK_CONTROL_DDR_POST_DIV | CPU_DDR_CLOCK_CONTROL_CPU_POST_DIV |
> + CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_SET(1) |
> + CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_SET(1) |
> + CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_SET(1), pll_regs + QCA956X_PLL_CLK_CTRL_REG);
> +
> + /* ddr_pll_dither_unset */
> + writel(DDR_PLL_DITHER1_VAL, pll_regs + QCA956X_PLL_DDR_DIT_FRAC_REG);
> + writel(DDR_PLL_DITHER2_VAL, pll_regs + QCA956X_PLL_DDR_DIT2_FRAC_REG);
> +
> + /* cpu_pll_dither_unset */
> + writel(CPU_PLL_DITHER1_VAL, pll_regs + QCA956X_PLL_CPU_DIT_FRAC_REG);
> + writel(CPU_PLL_DITHER2_VAL, pll_regs + QCA956X_PLL_CPU_DIT2_FRAC_REG);
> +
> + /* pll_pwd_unset */
> + cpu_pll_set(CPU_PLL_CONFIG_PLLPWD_MASK, CPU_PLL_CONFIG_PLLPWD_SET(0));
> + ddr_pll_set(DDR_PLL_CONFIG_PLLPWD_MASK, DDR_PLL_CONFIG_PLLPWD_SET(0));
> +
> + /* outdiv_unset */
> + cpu_pll_set(CPU_PLL_CONFIG_OUTDIV_MASK, CPU_PLL_CONFIG_OUT_DIV_VAL2);
> + ddr_pll_set(DDR_PLL_CONFIG_OUTDIV_MASK, DDR_PLL_CONFIG_OUT_DIV_VAL2);
> +
> + /* pll_bypass_unset */
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_CPU_PLL_BYPASS_SET(0));
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_DDR_PLL_BYPASS_SET(0));
> + cpu_ddr_control_set(CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_MASK,
> + CPU_DDR_CLOCK_CONTROL_AHB_PLL_BYPASS_SET(0));
> +
> + while (readl(pll_regs + QCA956X_PLL_CPU_CONFIG_REG) & 0x8000000)
> + /* NOP */;
> +
> + while (readl(pll_regs + QCA956X_PLL_DDR_CONFIG_REG) & 0x8000000)
> + /* NOP */;
> +}
> +
> +int get_clocks(void)
> +{
> + void __iomem *regs;
> + u32 ref_rate, cpu_rate, ddr_rate, ahb_rate;
> + u32 out_div, ref_div, postdiv, nint, hfrac, lfrac, clk_ctrl;
> + u32 pll, cpu_pll, ddr_pll, misc;
> +
> + /*
> + * QCA956x timer init workaround has to be applied right before setting
> + * up the clock. Else, there will be no jiffies
> + */
> + regs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
> + MAP_NOCACHE);
> + misc = readl(regs + AR71XX_RESET_REG_MISC_INT_ENABLE);
> + misc |= MISC_INT_MIPS_SI_TIMERINT_MASK;
> + writel(misc, regs + AR71XX_RESET_REG_MISC_INT_ENABLE);
> +
> + regs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
> + MAP_NOCACHE);
> + pll = readl(regs + QCA956X_PLL_CPU_CONFIG_REG);
> + out_div = (pll >> QCA956X_PLL_CPU_CONFIG_OUTDIV_SHIFT) &
> + QCA956X_PLL_CPU_CONFIG_OUTDIV_MASK;
> + ref_div = (pll >> QCA956X_PLL_CPU_CONFIG_REFDIV_SHIFT) &
> + QCA956X_PLL_CPU_CONFIG_REFDIV_MASK;
> +
> + pll = readl(regs + QCA956X_PLL_CPU_CONFIG1_REG);
> + nint = (pll >> QCA956X_PLL_CPU_CONFIG1_NINT_SHIFT) &
> + QCA956X_PLL_CPU_CONFIG1_NINT_MASK;
> + hfrac = (pll >> QCA956X_PLL_CPU_CONFIG1_NFRAC_H_SHIFT) &
> + QCA956X_PLL_CPU_CONFIG1_NFRAC_H_MASK;
> + lfrac = (pll >> QCA956X_PLL_CPU_CONFIG1_NFRAC_L_SHIFT) &
> + QCA956X_PLL_CPU_CONFIG1_NFRAC_L_MASK;
> +
> + ref_rate = qca956x_get_xtal();
> +
> + cpu_pll = nint * ref_rate / ref_div;
> + cpu_pll += (lfrac * ref_rate) / ((ref_div * 25) << 13);
> + cpu_pll += (hfrac >> 13) * ref_rate / ref_div;
> + cpu_pll /= (1 << out_div);
> +
> + pll = readl(regs + QCA956X_PLL_DDR_CONFIG_REG);
> + out_div = (pll >> QCA956X_PLL_DDR_CONFIG_OUTDIV_SHIFT) &
> + QCA956X_PLL_DDR_CONFIG_OUTDIV_MASK;
> + ref_div = (pll >> QCA956X_PLL_DDR_CONFIG_REFDIV_SHIFT) &
> + QCA956X_PLL_DDR_CONFIG_REFDIV_MASK;
> + pll = readl(regs + QCA956X_PLL_DDR_CONFIG1_REG);
> + nint = (pll >> QCA956X_PLL_DDR_CONFIG1_NINT_SHIFT) &
> + QCA956X_PLL_DDR_CONFIG1_NINT_MASK;
> + hfrac = (pll >> QCA956X_PLL_DDR_CONFIG1_NFRAC_H_SHIFT) &
> + QCA956X_PLL_DDR_CONFIG1_NFRAC_H_MASK;
> + lfrac = (pll >> QCA956X_PLL_DDR_CONFIG1_NFRAC_L_SHIFT) &
> + QCA956X_PLL_DDR_CONFIG1_NFRAC_L_MASK;
> +
> + ddr_pll = nint * ref_rate / ref_div;
> + ddr_pll += (lfrac * ref_rate) / ((ref_div * 25) << 13);
> + ddr_pll += (hfrac >> 13) * ref_rate / ref_div;
> + ddr_pll /= (1 << out_div);
> +
> + clk_ctrl = readl(regs + QCA956X_PLL_CLK_CTRL_REG);
> +
> + postdiv = (clk_ctrl >> QCA956X_PLL_CLK_CTRL_CPU_POST_DIV_SHIFT) &
> + QCA956X_PLL_CLK_CTRL_CPU_POST_DIV_MASK;
> +
> + if (clk_ctrl & QCA956X_PLL_CLK_CTRL_CPU_PLL_BYPASS)
> + cpu_rate = ref_rate;
> + else if (clk_ctrl & QCA956X_PLL_CLK_CTRL_CPU_DDRCLK_FROM_CPUPLL)
> + cpu_rate = ddr_pll / (postdiv + 1);
> + else
> + cpu_rate = cpu_pll / (postdiv + 1);
> +
> + postdiv = (clk_ctrl >> QCA956X_PLL_CLK_CTRL_DDR_POST_DIV_SHIFT) &
> + QCA956X_PLL_CLK_CTRL_DDR_POST_DIV_MASK;
> +
> + if (clk_ctrl & QCA956X_PLL_CLK_CTRL_DDR_PLL_BYPASS)
> + ddr_rate = ref_rate;
> + else if (clk_ctrl & QCA956X_PLL_CLK_CTRL_CPU_DDRCLK_FROM_DDRPLL)
> + ddr_rate = cpu_pll / (postdiv + 1);
> + else
> + ddr_rate = ddr_pll / (postdiv + 1);
> +
> + postdiv = (clk_ctrl >> QCA956X_PLL_CLK_CTRL_AHB_POST_DIV_SHIFT) &
> + QCA956X_PLL_CLK_CTRL_AHB_POST_DIV_MASK;
> +
> + if (clk_ctrl & QCA956X_PLL_CLK_CTRL_AHB_PLL_BYPASS)
> + ahb_rate = ref_rate;
> + else if (clk_ctrl & QCA956X_PLL_CLK_CTRL_AHBCLK_FROM_DDRPLL)
> + ahb_rate = ddr_pll / (postdiv + 1);
> + else
> + ahb_rate = cpu_pll / (postdiv + 1);
> +
> + gd->cpu_clk = cpu_rate;
> + gd->mem_clk = ddr_rate;
> + gd->bus_clk = ahb_rate;
> +
> + debug("cpu_clk=%u, ddr_clk=%u, bus_clk=%u\n",
> + cpu_rate, ddr_rate, ahb_rate);
> +
> + return 0;
> +}
> +
> +ulong get_bus_freq(ulong dummy)
> +{
> + if (!gd->bus_clk)
> + get_clocks();
> + return gd->bus_clk;
> +}
> +
> +ulong get_ddr_freq(ulong dummy)
> +{
> + if (!gd->mem_clk)
> + get_clocks();
> + return gd->mem_clk;
> +}
> diff --git a/arch/mips/mach-ath79/qca956x/cpu.c b/arch/mips/mach-ath79/qca956x/cpu.c
> new file mode 100644
> index 0000000000..08a8c84e72
> --- /dev/null
> +++ b/arch/mips/mach-ath79/qca956x/cpu.c
> @@ -0,0 +1,9 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2019 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +#include <common.h>
> +
> +/* The lowlevel_init() is not needed on QCA956X */
> +void lowlevel_init(void) {}
> diff --git a/arch/mips/mach-ath79/qca956x/ddr.c b/arch/mips/mach-ath79/qca956x/ddr.c
> new file mode 100644
> index 0000000000..fb2230430c
> --- /dev/null
> +++ b/arch/mips/mach-ath79/qca956x/ddr.c
> @@ -0,0 +1,308 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2019 Rosy Song <rosysong at rosinson.com>
> + *
> + * Based on QSDK
> + */
> +
> +#include <common.h>
> +#include <asm/io.h>
> +#include <asm/addrspace.h>
> +#include <asm/types.h>
> +#include <mach/ar71xx_regs.h>
> +#include <mach/ath79.h>
> +
> +#define DDR_FSM_WAIT_CTRL_VAL 0xa12
> +#define DDR_CTL_CONFIG_SRAM_TSEL_LSB 30
> +#define DDR_CTL_CONFIG_SRAM_TSEL_MASK 0xc0000000
> +#define DDR_CTL_CONFIG_SRAM_TSEL_SET(x) \
> + (((x) << DDR_CTL_CONFIG_SRAM_TSEL_LSB) & DDR_CTL_CONFIG_SRAM_TSEL_MASK)
> +#define DDR_CTL_CONFIG_GE0_SRAM_SYNC_LSB 20
> +#define DDR_CTL_CONFIG_GE0_SRAM_SYNC_MASK 0x00100000
> +#define DDR_CTL_CONFIG_GE0_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_GE0_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_GE0_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_GE1_SRAM_SYNC_LSB 19
> +#define DDR_CTL_CONFIG_GE1_SRAM_SYNC_MASK 0x00080000
> +#define DDR_CTL_CONFIG_GE1_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_GE1_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_GE1_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_USB_SRAM_SYNC_LSB 18
> +#define DDR_CTL_CONFIG_USB_SRAM_SYNC_MASK 0x00040000
> +#define DDR_CTL_CONFIG_USB_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_USB_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_USB_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_PCIE_SRAM_SYNC_LSB 17
> +#define DDR_CTL_CONFIG_PCIE_SRAM_SYNC_MASK 0x00020000
> +#define DDR_CTL_CONFIG_PCIE_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_PCIE_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_PCIE_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_WMAC_SRAM_SYNC_LSB 16
> +#define DDR_CTL_CONFIG_WMAC_SRAM_SYNC_MASK 0x00010000
> +#define DDR_CTL_CONFIG_WMAC_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_WMAC_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_WMAC_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_LSB 15
> +#define DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_MASK 0x00008000
> +#define DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_LSB 14
> +#define DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_MASK 0x00004000
> +#define DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_LSB) & DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_MASK)
> +#define DDR_CTL_CONFIG_PAD_DDR2_SEL_LSB 6
> +#define DDR_CTL_CONFIG_PAD_DDR2_SEL_MASK 0x00000040
> +#define DDR_CTL_CONFIG_PAD_DDR2_SEL_SET(x) \
> + (((x) << DDR_CTL_CONFIG_PAD_DDR2_SEL_LSB) & DDR_CTL_CONFIG_PAD_DDR2_SEL_MASK)
> +#define DDR_CTL_CONFIG_CPU_DDR_SYNC_LSB 2
> +#define DDR_CTL_CONFIG_CPU_DDR_SYNC_MASK 0x00000004
> +#define DDR_CTL_CONFIG_CPU_DDR_SYNC_SET(x) \
> + (((x) << DDR_CTL_CONFIG_CPU_DDR_SYNC_LSB) & DDR_CTL_CONFIG_CPU_DDR_SYNC_MASK)
> +#define DDR_CTL_CONFIG_HALF_WIDTH_LSB 1
> +#define DDR_CTL_CONFIG_HALF_WIDTH_MASK 0x00000002
> +#define DDR_CTL_CONFIG_HALF_WIDTH_SET(x) \
> + (((x) << DDR_CTL_CONFIG_HALF_WIDTH_LSB) & DDR_CTL_CONFIG_HALF_WIDTH_MASK)
> +#define DDR_CONFIG_CAS_LATENCY_MSB_LSB 31
> +#define DDR_CONFIG_CAS_LATENCY_MSB_MASK 0x80000000
> +#define DDR_CONFIG_CAS_LATENCY_MSB_SET(x) \
> + (((x) << DDR_CONFIG_CAS_LATENCY_MSB_LSB) & DDR_CONFIG_CAS_LATENCY_MSB_MASK)
> +#define DDR_CONFIG_OPEN_PAGE_LSB 30
> +#define DDR_CONFIG_OPEN_PAGE_MASK 0x40000000
> +#define DDR_CONFIG_OPEN_PAGE_SET(x) \
> + (((x) << DDR_CONFIG_OPEN_PAGE_LSB) & DDR_CONFIG_OPEN_PAGE_MASK)
> +#define DDR_CONFIG_CAS_LATENCY_LSB 27
> +#define DDR_CONFIG_CAS_LATENCY_MASK 0x38000000
> +#define DDR_CONFIG_CAS_LATENCY_SET(x) \
> + (((x) << DDR_CONFIG_CAS_LATENCY_LSB) & DDR_CONFIG_CAS_LATENCY_MASK)
> +#define DDR_CONFIG_TMRD_LSB 23
> +#define DDR_CONFIG_TMRD_MASK 0x07800000
> +#define DDR_CONFIG_TMRD_SET(x) \
> + (((x) << DDR_CONFIG_TMRD_LSB) & DDR_CONFIG_TMRD_MASK)
> +#define DDR_CONFIG_TRFC_LSB 17
> +#define DDR_CONFIG_TRFC_MASK 0x007e0000
> +#define DDR_CONFIG_TRFC_SET(x) \
> + (((x) << DDR_CONFIG_TRFC_LSB) & DDR_CONFIG_TRFC_MASK)
> +#define DDR_CONFIG_TRRD_LSB 13
> +#define DDR_CONFIG_TRRD_MASK 0x0001e000
> +#define DDR_CONFIG_TRRD_SET(x) \
> + (((x) << DDR_CONFIG_TRRD_LSB) & DDR_CONFIG_TRRD_MASK)
> +#define DDR_CONFIG_TRP_LSB 9
> +#define DDR_CONFIG_TRP_MASK 0x00001e00
> +#define DDR_CONFIG_TRP_SET(x) \
> + (((x) << DDR_CONFIG_TRP_LSB) & DDR_CONFIG_TRP_MASK)
> +#define DDR_CONFIG_TRCD_LSB 5
> +#define DDR_CONFIG_TRCD_MASK 0x000001e0
> +#define DDR_CONFIG_TRCD_SET(x) \
> + (((x) << DDR_CONFIG_TRCD_LSB) & DDR_CONFIG_TRCD_MASK)
> +#define DDR_CONFIG_TRAS_LSB 0
> +#define DDR_CONFIG_TRAS_MASK 0x0000001f
> +#define DDR_CONFIG_TRAS_SET(x) \
> + (((x) << DDR_CONFIG_TRAS_LSB) & DDR_CONFIG_TRAS_MASK)
> +#define DDR_CONFIG2_HALF_WIDTH_LOW_LSB 31
> +#define DDR_CONFIG2_HALF_WIDTH_LOW_MASK 0x80000000
> +#define DDR_CONFIG2_HALF_WIDTH_LOW_SET(x) \
> + (((x) << DDR_CONFIG2_HALF_WIDTH_LOW_LSB) & DDR_CONFIG2_HALF_WIDTH_LOW_MASK)
> +#define DDR_CONFIG2_SWAP_A26_A27_LSB 30
> +#define DDR_CONFIG2_SWAP_A26_A27_MASK 0x40000000
> +#define DDR_CONFIG2_SWAP_A26_A27_SET(x) \
> + (((x) << DDR_CONFIG2_SWAP_A26_A27_LSB) & DDR_CONFIG2_SWAP_A26_A27_MASK)
> +#define DDR_CONFIG2_GATE_OPEN_LATENCY_LSB 26
> +#define DDR_CONFIG2_GATE_OPEN_LATENCY_MASK 0x3c000000
> +#define DDR_CONFIG2_GATE_OPEN_LATENCY_SET(x) \
> + (((x) << DDR_CONFIG2_GATE_OPEN_LATENCY_LSB) & DDR_CONFIG2_GATE_OPEN_LATENCY_MASK)
> +#define DDR_CONFIG2_TWTR_LSB 21
> +#define DDR_CONFIG2_TWTR_MASK 0x03e00000
> +#define DDR_CONFIG2_TWTR_SET(x) \
> + (((x) << DDR_CONFIG2_TWTR_LSB) & DDR_CONFIG2_TWTR_MASK)
> +#define DDR_CONFIG2_TRTP_LSB 17
> +#define DDR_CONFIG2_TRTP_MASK 0x001e0000
> +#define DDR_CONFIG2_TRTP_SET(x) \
> + (((x) << DDR_CONFIG2_TRTP_LSB) & DDR_CONFIG2_TRTP_MASK)
> +#define DDR_CONFIG2_TRTW_LSB 12
> +#define DDR_CONFIG2_TRTW_MASK 0x0001f000
> +#define DDR_CONFIG2_TRTW_SET(x) \
> + (((x) << DDR_CONFIG2_TRTW_LSB) & DDR_CONFIG2_TRTW_MASK)
> +#define DDR_CONFIG2_TWR_LSB 8
> +#define DDR_CONFIG2_TWR_MASK 0x00000f00
> +#define DDR_CONFIG2_TWR_SET(x) \
> + (((x) << DDR_CONFIG2_TWR_LSB) & DDR_CONFIG2_TWR_MASK)
> +#define DDR_CONFIG2_CKE_LSB 7
> +#define DDR_CONFIG2_CKE_MASK 0x00000080
> +#define DDR_CONFIG2_CKE_SET(x) \
> + (((x) << DDR_CONFIG2_CKE_LSB) & DDR_CONFIG2_CKE_MASK)
> +#define DDR_CONFIG2_CNTL_OE_EN_LSB 5
> +#define DDR_CONFIG2_CNTL_OE_EN_MASK 0x00000020
> +#define DDR_CONFIG2_CNTL_OE_EN_SET(x) \
> + (((x) << DDR_CONFIG2_CNTL_OE_EN_LSB) & DDR_CONFIG2_CNTL_OE_EN_MASK)
> +#define DDR_CONFIG2_BURST_LENGTH_LSB 0
> +#define DDR_CONFIG2_BURST_LENGTH_MASK 0x0000000f
> +#define DDR_CONFIG2_BURST_LENGTH_SET(x) \
> + (((x) << DDR_CONFIG2_BURST_LENGTH_LSB) & DDR_CONFIG2_BURST_LENGTH_MASK)
> +#define RST_BOOTSTRAP_ADDRESS 0x180600b0
> +#define PMU2_SWREGMSB_LSB 22
> +#define PMU2_SWREGMSB_MASK 0xffc00000
> +#define PMU2_SWREGMSB_SET(x) \
> + (((x) << PMU2_SWREGMSB_LSB) & PMU2_SWREGMSB_MASK)
> +#define PMU2_PGM_LSB 21
> +#define PMU2_PGM_MASK 0x00200000
> +#define PMU2_PGM_SET(x) \
> + (((x) << PMU2_PGM_LSB) & PMU2_PGM_MASK)
> +
> +#define CPU_DDR_SYNC_MODE DDR_CTL_CONFIG_CPU_DDR_SYNC_SET(0)
> +
> +/*
> +* DDR2 DDR1
> +* 0x40c3 25MHz 0x4186 25Mhz
> +* 0x4138 40MHz 0x4270 40Mhz
> +*/
> +#define CFG_DDR2_REFRESH_VAL 0x40c3
> +#define CFG_DDR2_CONFIG_VAL DDR_CONFIG_CAS_LATENCY_MSB_SET(0x1) | \
> + DDR_CONFIG_OPEN_PAGE_SET(0x1) | DDR_CONFIG_CAS_LATENCY_SET(0x4) | \
> + DDR_CONFIG_TMRD_SET(0x6) | DDR_CONFIG_TRFC_SET(0x16) | \
> + DDR_CONFIG_TRRD_SET(0x7) | DDR_CONFIG_TRP_SET(0xb) | \
> + DDR_CONFIG_TRCD_SET(0xb) | DDR_CONFIG_TRAS_SET(0)
> +#define CFG_DDR2_CONFIG2_VAL DDR_CONFIG2_HALF_WIDTH_LOW_SET(0x1) | \
> + DDR_CONFIG2_SWAP_A26_A27_SET(0x0) | DDR_CONFIG2_GATE_OPEN_LATENCY_SET(0xa) | \
> + DDR_CONFIG2_TWTR_SET(0x16) | DDR_CONFIG2_TRTP_SET(0xa) | \
> + DDR_CONFIG2_TRTW_SET(0xe) | DDR_CONFIG2_TWR_SET(0x2) | \
> + DDR_CONFIG2_CKE_SET(0x1) | DDR_CONFIG2_CNTL_OE_EN_SET(0x1) | \
> + DDR_CONFIG2_BURST_LENGTH_SET(0x8)
> +
> +#define CFG_DDR2_CONFIG3_VAL 0x0000000e
> +#define CFG_DDR2_EXT_MODE_VAL1 0x782
> +#define CFG_DDR2_EXT_MODE_VAL2 0x402
> +#define CFG_DDR2_MODE_VAL_INIT 0xb53
> +#define CFG_DDR2_MODE_VAL 0xa53
> +#define CFG_DDR2_TAP_VAL 0x10
> +#define CFG_DDR2_EN_TWL_VAL 0x00001e91
> +#define CFG_DDR2_RD_DATA_THIS_CYCLE_VAL_16 0xffff
> +
> +#define CFG_DDR_CTL_CONFIG DDR_CTL_CONFIG_SRAM_TSEL_SET(0x1) | \
> + DDR_CTL_CONFIG_GE0_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_GE1_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_USB_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_PCIE_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_WMAC_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_MISC_SRC1_SRAM_SYNC_SET(0x1) | \
> + DDR_CTL_CONFIG_MISC_SRC2_SRAM_SYNC_SET(0x1)
> +
> +DECLARE_GLOBAL_DATA_PTR;
> +
> +void qca956x_ddr_init(void)
> +{
> + u32 ddr_config, ddr_config2, ddr_config3, mod_val, \
> + mod_val_init, cycle_val, tap_val, ctl_config;
> + void __iomem *ddr_regs = map_physmem(AR71XX_DDR_CTRL_BASE, AR71XX_DDR_CTRL_SIZE,
> + MAP_NOCACHE);
> + void __iomem *srif_regs = map_physmem(QCA956X_SRIF_BASE, QCA956X_SRIF_SIZE,
> + MAP_NOCACHE);
> +
> + ddr_config = CFG_DDR2_CONFIG_VAL;
> + ddr_config2 = CFG_DDR2_CONFIG2_VAL;
> + ddr_config3 = CFG_DDR2_CONFIG3_VAL;
> + mod_val_init = CFG_DDR2_MODE_VAL_INIT;
> + mod_val = CFG_DDR2_MODE_VAL;
> + tap_val = CFG_DDR2_TAP_VAL;
> + cycle_val = CFG_DDR2_RD_DATA_THIS_CYCLE_VAL_16;
> + ctl_config = CFG_DDR_CTL_CONFIG | DDR_CTL_CONFIG_PAD_DDR2_SEL_SET(0x1) |
> + DDR_CTL_CONFIG_HALF_WIDTH_SET(0x1) | CPU_DDR_SYNC_MODE;
> +
> + writel(0x10, ddr_regs + AR71XX_DDR_REG_CONTROL);
> + udelay(10);
> +
> + writel(0x20, ddr_regs + AR71XX_DDR_REG_CONTROL);
> + udelay(10);
> +
> + writel(ctl_config, ddr_regs + QCA956X_DDR_REG_CTL_CONF);
> + udelay(10);
> +
> + writel(cycle_val, ddr_regs + AR71XX_DDR_REG_RD_CYCLE);
> + udelay(100);
> +
> + writel(0x74444444, ddr_regs + QCA956X_DDR_REG_BURST);
> + udelay(100);
> +
> + writel(0x44444444, ddr_regs + QCA956X_DDR_REG_BURST2);
> + udelay(100);
> +
> + writel(DDR_FSM_WAIT_CTRL_VAL, ddr_regs + QCA956X_DDR_REG_FSM_WAIT_CTRL);
> + udelay(100);
> +
> + writel(0xfffff, ddr_regs + QCA956X_DDR_REG_TIMEOUT_MAX);
> + udelay(100);
> +
> + writel(ddr_config, ddr_regs + AR71XX_DDR_REG_CONFIG);
> + udelay(100);
> +
> + writel(ddr_config2, ddr_regs + AR71XX_DDR_REG_CONFIG2);
> + udelay(100);
> +
> + writel(ddr_config3, ddr_regs + QCA956X_DDR_REG_DDR3_CONFIG);
> + udelay(100);
> +
> + writel(CFG_DDR2_EN_TWL_VAL, ddr_regs + QCA956X_DDR_REG_DDR2_CONFIG);
> + udelay(100);
> +
> + writel(ddr_config2 | 0x80, ddr_regs + AR71XX_DDR_REG_CONFIG2); /* CKE Enable */
> + udelay(100);
> +
> + writel(0x8, ddr_regs + AR71XX_DDR_REG_CONTROL); /* Precharge */
> + udelay(10);
> +
> + writel(0, ddr_regs + QCA956X_DDR_REG_DDR2_EMR2);
> + writel(0x10, ddr_regs + AR71XX_DDR_REG_CONTROL); /* EMR2 */
> + udelay(10);
> +
> + writel(0, ddr_regs + QCA956X_DDR_REG_DDR2_EMR3);
> + writel(0x20, ddr_regs + AR71XX_DDR_REG_CONTROL); /* EMR3 */
> + udelay(10);
> +
> + /* EMR DLL enable, Reduced Driver Impedance control, Differential DQS disabled */
> + writel(CFG_DDR2_EXT_MODE_VAL2, ddr_regs + AR71XX_DDR_REG_EMR);
> + udelay(100);
> +
> + writel(0x2, ddr_regs + AR71XX_DDR_REG_CONTROL); /* EMR write */
> + udelay(10);
> +
> + writel(mod_val_init, ddr_regs + AR71XX_DDR_REG_MODE);
> + udelay(1000);
> +
> + writel(0x1, ddr_regs + AR71XX_DDR_REG_CONTROL); /* MR Write */
> + udelay(10);
> +
> + writel(0x8, ddr_regs + AR71XX_DDR_REG_CONTROL); /* Precharge */
> + udelay(10);
> +
> + writel(0x4, ddr_regs + AR71XX_DDR_REG_CONTROL); /* Auto Refresh */
> + udelay(10);
> +
> + writel(0x4, ddr_regs + AR71XX_DDR_REG_CONTROL); /* Auto Refresh */
> + udelay(10);
> +
> + /* Issue MRS to remove DLL out-of-reset */
> + writel(mod_val, ddr_regs + AR71XX_DDR_REG_MODE);
> + udelay(100);
> +
> + writel(0x1, ddr_regs + AR71XX_DDR_REG_CONTROL); /* MR write */
> + udelay(100);
> +
> + writel(CFG_DDR2_EXT_MODE_VAL1, ddr_regs + AR71XX_DDR_REG_EMR);
> + udelay(100);
> +
> + writel(0x2, ddr_regs + AR71XX_DDR_REG_CONTROL); /* EMR write */
> + udelay(100);
> +
> + writel(CFG_DDR2_EXT_MODE_VAL2, ddr_regs + AR71XX_DDR_REG_EMR);
> + udelay(100);
> +
> + writel(0x2, ddr_regs + AR71XX_DDR_REG_CONTROL); /* EMR write */
> + udelay(100);
> +
> + writel(CFG_DDR2_REFRESH_VAL, ddr_regs + AR71XX_DDR_REG_REFRESH);
> + udelay(100);
> +
> + writel(tap_val, ddr_regs + AR71XX_DDR_REG_TAP_CTRL0);
> + writel(tap_val, ddr_regs + AR71XX_DDR_REG_TAP_CTRL1);
> + writel(tap_val, ddr_regs + QCA956X_DDR_REG_TAP_CTRL2);
> + writel(tap_val, ddr_regs + QCA956X_DDR_REG_TAP_CTRL3);
> +
> + writel(0x633c8176, srif_regs + QCA956X_SRIF_PMU1_REG);
> + /* Set DDR2 Voltage to 1.8 volts */
> + writel(PMU2_SWREGMSB_SET(0x40) | PMU2_PGM_SET(0x1),
> + srif_regs + QCA956X_SRIF_PMU2_REG);
> +}
> diff --git a/arch/mips/mach-ath79/qca956x/qca956x-ddr-tap.S b/arch/mips/mach-ath79/qca956x/qca956x-ddr-tap.S
> new file mode 100644
> index 0000000000..315ce6b395
> --- /dev/null
> +++ b/arch/mips/mach-ath79/qca956x/qca956x-ddr-tap.S
> @@ -0,0 +1,193 @@
> +/* SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2019 Rosy Song <rosysong at rosinson.com>
> + *
> + * Based on QSDK
> + */
> +
> +#include <config.h>
> +#include <asm/asm.h>
> +#include <asm/regdef.h>
> +#include <asm/mipsregs.h>
> +#include <asm/addrspace.h>
> +#include <mach/ar71xx_regs.h>
> +
> + .set noreorder
> +
> +LEAF(ddr_tap_tuning)
> + li a0, 0xbd001f00
> + sw zero, 0x0(a0) /* Place where the tap values are saved and used for SWEEP */
> + sw zero, 0x4(a0) /* Place where the number of passing taps are saved. */
> + sw zero, 0x14(a0) /* Place where the last pass tap value is stored */
> + li a1, 0xaa55aa55 /* Indicates that the First pass tap value is not found */
> + sw a1, 0x10(a0) /* Place where the First pass tap value is stored */
> + nop
> +
> + li a0, CKSEG1ADDR(AR71XX_RESET_BASE) /* RESET_BASE_ADDRESS */
> + lw a1, 0x1c(a0) /* Reading the RST_RESET_ADDRESS */
> + li a2, 0x08000000 /* Setting the RST_RESET_RTC_RESET */
> + or a1, a1, a2
> + sw a1, 0x1c(a0)
> +
> + li a3, 0xffffffff
> + xor a2, a2, a3
> + and a1, a1, a2
> + sw a1, 0x1c(a0) /* Taking the RTC out of RESET */
> + nop
> +
> + li a0, CKSEG1ADDR(QCA956X_RTC_BASE) /* RTC_BASE_ADDRESS */
> + li a1, 0x1
> + sw a1, 0x0040(a0) /* RTC_SYNC_RESET_ADDRESS */
> +
> + li a2, 0x2
> +
> +_poll_for_RTC_ON:
> + lw a1, 0x0044(a0) /* RTC_SYNC_STATUS_ADDRESS */
> + and a1, a2, a1
> + bne a1, a2, _poll_for_RTC_ON
> + nop
> +
> +_CHANGE_TAPS:
> + li t0, 0xbd001f00 /* Read the current value of the TAP for programming */
> + lw t1, 0x0(t0)
> + li t2, 0x00000000
> + or t3, t1, t2
> +
> + li t0, 0xb8000000 /* DDR_BASE_ADDRESS */
> + sw t3, 0x1c(t0) /* TAP_CONTROL_0_ADDRESS */
> + sw t3, 0x20(t0) /* TAP_CONTROL_1_ADDRESS */
> + sw t3, 0x24(t0) /* TAP_CONTROL_2_ADDRESS */
> + sw t3, 0x28(t0) /* TAP_CONTROL_3_ADDRESS */
> +
> + li t1, 0x00000010 /* Running the test 8 times */
> + sw t1, 0x0068(t0) /* PERF_COMP_ADDR_1_ADDRESS */
> +
> + li t1, 0xfa5de83f /* 4 Row Address Bits, 4 Column Address Bits, 2 BA bits */
> + sw t1, 0x002c(t0) /* PERF_MASK_ADDR_0_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0070(t0) /* PERF_COMP_AHB_GE0_1_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0040(t0) /* PERF_COMP_AHB_GE1_0_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0078(t0) /* PERF_COMP_AHB_GE1_1_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0034(t0) /* PERF_MASK_AHB_GE0_0_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x006c(t0) /* PERF_MASK_AHB_GE0_1_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x003c(t0) /* PERF_MASK_AHB_GE1_0_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0074(t0) /* PERF_MASK_AHB_GE1_1_ADDRESS */
> +
> + li t1, 0x0000ffff
> + sw t1, 0x0038(t0) /* PERF_COMP_AHB_GE0_0_ADDRESS */
> +
> + li t1, 0x00000001
> + sw t1, 0x011c(t0) /* DDR_BIST_ADDRESS */
> +
> + li t2, 0x1
> +
> +_bist_done_poll:
> + lw t1, 0x0120(t0) /* DDR_BIST_STATUS_ADDRESS */
> + and t1, t1, t2
> + bne t1, t2, _bist_done_poll
> + nop
> +
> + lw t1, 0x0120(t0) /* DDR_BIST_STATUS_ADDRESS */
> + li t4, 0x000001fe
> + and t2, t1, t4
> + srl t2, t2, 0x1 /* no. of Pass Runs */
> +
> + li t5, 0x00000000
> + sw t5, 0x011c(t0) /* DDR_BIST_ADDRESS - Stop the DDR BIST test */
> +
> + li t5, 0x0001fe00
> + and t5, t5, t1
> + bnez t5, _iterate_tap /* This is a redundant compare but nevertheless - Comparing the FAILS */
> + nop
> +
> + lw t1, 0x0068(t0) /* PERF_COMP_ADDR_1_ADDRESS */
> + li t3, 0x000001fe
> + and t3, t3, t1
> + srl t3, t3, 0x1 /* No. of runs in the config register. */
> + bne t3, t2, _iterate_tap
> + nop
> +
> +pass_tap:
> + li t0, 0xbd001f00
> + lw t1, 0x4(t0)
> + addiu t1, t1, 0x1
> + sw t1, 0x4(t0)
> +
> + li t0, 0xbd001f10
> + lw t1, 0x0(t0)
> + li t2, 0xaa55aa55
> + beq t1, t2, _first_pass
> + nop
> +
> + li t0, 0xbd001f00
> + lw t1, 0x0(t0)
> + li t0, 0xbd001f10
> + sw t1, 0x4(t0)
> + nop
> + b _iterate_tap
> + nop
> +
> +_first_pass:
> + li t0, 0xbd001f00
> + lw t1, 0x0(t0)
> + li t0, 0xbd001f10
> + sw t1, 0x0(t0)
> + sw t1, 0x4(t0)
> + nop
> +
> +_iterate_tap:
> + li t0, 0xbd001f00
> + lw t1, 0x0(t0)
> + li t2, 0x3f
> + beq t1, t2, _STOP_TEST
> + nop
> +
> + addiu t1, t1, 0x1
> + sw t1, 0x0(t0)
> + nop
> + b _CHANGE_TAPS
> + nop
> +
> +_STOP_TEST:
> + li t0, 0xbd001f00
> + lw t1, 0x4(t0)
> + bnez t1, _load_center_tap
> + nop
> +
> + li t3, 0x8 /* Default Tap to be used */
> + b _load_tap_into_reg
> + nop
> +
> +_load_center_tap:
> + li t0, 0xbd001f10
> + lw t1, 0x0(t0)
> + lw t2, 0x4(t0)
> + add t3, t1, t2
> + srl t3, t3, 0x1
> + li t4, 0x3f
> + and t3, t3, t4
> +
> +_load_tap_into_reg:
> + li t0, 0xb8000000
> + sw t3, 0x1c(t0) /* TAP_CONTROL_0_ADDRESS */
> + sw t3, 0x20(t0) /* TAP_CONTROL_1_ADDRESS */
> + sw t3, 0x24(t0) /* TAP_CONTROL_2_ADDRESS */
> + sw t3, 0x28(t0) /* TAP_CONTROL_3_ADDRESS */
> +
> + nop
> + jr ra
> + nop
> + END(ddr_tap_tuning)
> diff --git a/arch/mips/mach-ath79/reset.c b/arch/mips/mach-ath79/reset.c
> index 6a94d886f9..0ab3ab6383 100644
> --- a/arch/mips/mach-ath79/reset.c
> +++ b/arch/mips/mach-ath79/reset.c
> @@ -1,6 +1,7 @@
> // SPDX-License-Identifier: GPL-2.0+
> /*
> * Copyright (C) 2015-2016 Wills Wang <wills.wang at live.com>
> + * Copyright (C) 2018-2019 Rosy Song <rosysong at rosinson.com>
> */
>
> #include <common.h>
> @@ -11,6 +12,44 @@
> #include <mach/ath79.h>
> #include <mach/ar71xx_regs.h>
>
> +/* QCA956X ETH_SGMII_SERDES Registers */
> +#define SGMII_SERDES_RES_CALIBRATION_LSB 23
> +#define SGMII_SERDES_RES_CALIBRATION_MASK 0x07800000
> +#define SGMII_SERDES_RES_CALIBRATION_SET(x) \
> + (((x) << SGMII_SERDES_RES_CALIBRATION_LSB) & SGMII_SERDES_RES_CALIBRATION_MASK)
> +#define SGMII_SERDES_CDR_BW_LSB 1
> +#define SGMII_SERDES_CDR_BW_MASK 0x00000006
> +#define SGMII_SERDES_CDR_BW_SET(x) \
> + (((x) << SGMII_SERDES_CDR_BW_LSB) & SGMII_SERDES_CDR_BW_MASK)
> +#define SGMII_SERDES_TX_DR_CTRL_LSB 4
> +#define SGMII_SERDES_TX_DR_CTRL_MASK 0x00000070
> +#define SGMII_SERDES_TX_DR_CTRL_SET(x) \
> + (((x) << SGMII_SERDES_TX_DR_CTRL_LSB) & SGMII_SERDES_TX_DR_CTRL_MASK)
> +#define SGMII_SERDES_PLL_BW_LSB 8
> +#define SGMII_SERDES_PLL_BW_MASK 0x00000100
> +#define SGMII_SERDES_PLL_BW_SET(x) \
> + (((x) << SGMII_SERDES_PLL_BW_LSB) & SGMII_SERDES_PLL_BW_MASK)
> +#define SGMII_SERDES_EN_SIGNAL_DETECT_LSB 16
> +#define SGMII_SERDES_EN_SIGNAL_DETECT_MASK 0x00010000
> +#define SGMII_SERDES_EN_SIGNAL_DETECT_SET(x) \
> + (((x) << SGMII_SERDES_EN_SIGNAL_DETECT_LSB) & SGMII_SERDES_EN_SIGNAL_DETECT_MASK)
> +#define SGMII_SERDES_FIBER_SDO_LSB 17
> +#define SGMII_SERDES_FIBER_SDO_MASK 0x00020000
> +#define SGMII_SERDES_FIBER_SDO_SET(x) \
> + (((x) << SGMII_SERDES_FIBER_SDO_LSB) & SGMII_SERDES_FIBER_SDO_MASK)
> +#define SGMII_SERDES_VCO_REG_LSB 27
> +#define SGMII_SERDES_VCO_REG_MASK 0x78000000
> +#define SGMII_SERDES_VCO_REG_SET(x) \
> + (((x) << SGMII_SERDES_VCO_REG_LSB) & SGMII_SERDES_VCO_REG_MASK)
> +#define SGMII_SERDES_VCO_FAST_LSB 9
> +#define SGMII_SERDES_VCO_FAST_MASK 0x00000200
> +#define SGMII_SERDES_VCO_FAST_GET(x) \
> + (((x) & SGMII_SERDES_VCO_FAST_MASK) >> SGMII_SERDES_VCO_FAST_LSB)
> +#define SGMII_SERDES_VCO_SLOW_LSB 10
> +#define SGMII_SERDES_VCO_SLOW_MASK 0x00000400
> +#define SGMII_SERDES_VCO_SLOW_GET(x) \
> + (((x) & SGMII_SERDES_VCO_SLOW_MASK) >> SGMII_SERDES_VCO_SLOW_LSB)
> +
> void _machine_restart(void)
> {
> void __iomem *base;
> @@ -152,6 +191,236 @@ static int eth_init_qca953x(void)
> return 0;
> }
>
> +static int qca956x_sgmii_cal(void)
> +{
> + int i;
> + u32 reg, rev_sgmii_val;
> + u32 vco_fast, vco_slow;
> + u32 start_val = 0, end_val = 0;
> + void __iomem *gregs = map_physmem(AR71XX_MII_BASE, AR71XX_MII_SIZE,
> + MAP_NOCACHE);
> + void __iomem *pregs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
> + MAP_NOCACHE);
> + void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
> + MAP_NOCACHE);
> + const u32 mask = QCA956X_RESET_SGMII_ASSERT | QCA956X_RESET_SGMII;
> +
> + writel(BIT(2) | BIT(0), pregs + QCA956X_PLL_ETH_SGMII_SERDES_REG);
> +
> + reg = readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> + vco_fast = SGMII_SERDES_VCO_FAST_GET(reg);
> + vco_slow = SGMII_SERDES_VCO_SLOW_GET(reg);
> +
> + /* Set resistor calibration from 0000 to 1111 */
> + for (i = 0; i < 0x10; i++) {
> + reg = (readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES) &
> + ~SGMII_SERDES_RES_CALIBRATION_MASK) |
> + SGMII_SERDES_RES_CALIBRATION_SET(i);
> + writel(reg, gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> +
> + udelay(50);
> +
> + reg = readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> + if (vco_fast != SGMII_SERDES_VCO_FAST_GET(reg) ||
> + vco_slow != SGMII_SERDES_VCO_SLOW_GET(reg)) {
> + if (start_val == 0) {
> + start_val = i;
> + end_val = i;
> + } else {
> + end_val = i;
> + }
> + }
> + vco_fast = SGMII_SERDES_VCO_FAST_GET(reg);
> + vco_slow = SGMII_SERDES_VCO_SLOW_GET(reg);
> + }
> +
> + if (start_val == 0)
> + rev_sgmii_val = 0x7;
> + else
> + rev_sgmii_val = (start_val + end_val) >> 1;
> +
> + writel((readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES) &
> + ~SGMII_SERDES_RES_CALIBRATION_MASK) |
> + SGMII_SERDES_RES_CALIBRATION_SET(rev_sgmii_val),
> + gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> +
> + writel(BIT(2) | BIT(0), pregs + QCA956X_PLL_ETH_SGMII_SERDES_REG);
> +
> + reg = readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> + writel(SGMII_SERDES_CDR_BW_SET(3) | SGMII_SERDES_TX_DR_CTRL_SET(1) |
> + SGMII_SERDES_PLL_BW_SET(1) | SGMII_SERDES_EN_SIGNAL_DETECT_SET(1) |
> + SGMII_SERDES_FIBER_SDO_SET(1) | SGMII_SERDES_VCO_REG_SET(3) | reg,
> + gregs + QCA956X_GMAC_REG_SGMII_SERDES);
> +
> + setbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask);
> + mdelay(1);
> + clrbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask);
> + mdelay(1);
> +
> + while (!(readl(gregs + QCA956X_GMAC_REG_SGMII_SERDES) & BIT(15)))
> + /* NOP */;
> +
> + return 0;
> +}
> +
> +static int qca956x_sgmii_setup(void)
> +{
> + int i;
> + u32 s = 0, reg = 0;
> + u32 _regs[] = {
> + BIT(4), /* HW_RX_125M_N */
> + BIT(2), /* RX_125M_N */
> + BIT(3), /* TX_125M_N */
> + BIT(0), /* RX_CLK_N */
> + BIT(1), /* TX_CLK_N */
> + };
> + void __iomem *gregs = map_physmem(AR71XX_MII_BASE, AR71XX_MII_SIZE,
> + MAP_NOCACHE);
> +
> + /* Force sgmii mode */
> + writel(BIT(6) | BIT(15) | BIT(8), gregs + QCA956X_GMAC_REG_MR_AN_CTRL);
> + udelay(10);
> + writel(0x2 | BIT(5) | (0x2 << 6), gregs + QCA956X_GMAC_REG_SGMII_CONFIG);
> +
> + /* SGMII reset sequence sugguest by qca systems team. */
> + writel(0, gregs + QCA956X_GMAC_REG_SGMII_RESET);
> + for (i = 0; i < ARRAY_SIZE(_regs); i++) {
> + reg |= _regs[i];
> + writel(reg, gregs + QCA956X_GMAC_REG_SGMII_RESET);
> + }
> +
> + writel(readl(gregs + QCA956X_GMAC_REG_MR_AN_CTRL) & ~BIT(15),
> + gregs + QCA956X_GMAC_REG_MR_AN_CTRL);
> +
> + /*
> + * WARNING: Across resets SGMII link status goes to weird state.
> + * if 0xb8070058 (SGMII_DEBUG Register) reads other than 0xf or 0x10
> + * for sure we are in bad state.
> + * Issue a PHY RESET in MR_AN_CONTROL_ADDRESS to keep going.
> + */
> + i = 0;
> + s = (readl(gregs + QCA956X_GMAC_REG_SGMII_DEBUG) & 0xff);
> + while (!(s == 0xf || s == 0x10)) {
> + writel(readl(gregs + QCA956X_GMAC_REG_MR_AN_CTRL) | BIT(15),
> + gregs + QCA956X_GMAC_REG_MR_AN_CTRL);
> + udelay(100);
> + writel(readl(gregs + QCA956X_GMAC_REG_MR_AN_CTRL) & ~BIT(15),
> + gregs + QCA956X_GMAC_REG_MR_AN_CTRL);
> + if (i++ == 10)
> + break;
> + s = (readl(gregs + QCA956X_GMAC_REG_SGMII_DEBUG) & 0xff);
> + }
> +
> + return 0;
> +}
> +
> +static int qca956x_s17_reset(void)
> +{
> + void __iomem *regs = map_physmem(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE,
> + MAP_NOCACHE);
> + void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
> + MAP_NOCACHE);
> + const u32 mask = QCA956X_RESET_SGMII_ASSERT | QCA956X_RESET_SGMII |
> + QCA956X_RESET_EXTERNAL | QCA956X_RESET_SGMII_ANALOG |
> + QCA956X_RESET_SWITCH;
> + /* Bits(Reserved in datasheet) should be set to 1 */
> + const u32 mask_r = QCA956X_RESET_SGMII_ASSERT | QCA956X_RESET_SGMII |
> + QCA956X_RESET_EXTERNAL;
> +
> + setbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask);
> + mdelay(1);
> + clrbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask_r);
> + mdelay(1);
> +
> + /* Reset s17 switch(GPIO11) SYS_RST_L */
> + writel(readl(regs + AR71XX_GPIO_REG_OE) & ~BIT(11),
> + regs + AR71XX_GPIO_REG_OE);
> + udelay(100);
> +
> + writel(readl(regs + AR71XX_GPIO_REG_OUT) & ~BIT(11),
> + regs + AR71XX_GPIO_REG_OUT);
> + udelay(100);
> + writel(readl(regs + AR71XX_GPIO_REG_OUT) | BIT(11),
> + regs + AR71XX_GPIO_REG_OUT);
> +
> + return 0;
> +}
> +
> +static int qca956x_init_mdio(void)
> +{
> + u32 reg;
> + void __iomem *regs = map_physmem(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE,
> + MAP_NOCACHE);
> + void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
> + MAP_NOCACHE);
> + const u32 mask = QCA956X_RESET_GE0_MDIO | QCA956X_RESET_GE0_MAC |
> + QCA956X_RESET_GE1_MDIO | QCA956X_RESET_GE1_MAC;
> +
> + setbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask);
> + mdelay(1);
> + clrbits_be32(rregs + QCA956X_RESET_REG_RESET_MODULE, mask);
> + mdelay(1);
> +
> + /* GPIO4 as MDI */
> + reg = readl(regs + QCA956X_GPIO_REG_IN_ENABLE3);
> + reg &= ~(0xff << 16);
> + reg |= (0x4 << 16);
> + writel(reg, regs + QCA956X_GPIO_REG_IN_ENABLE3);
> +
> + /* GPIO4 as MDO */
> + reg = readl(regs + QCA956X_GPIO_REG_OUT_FUNC1);
> + reg &= ~0xff;
> + reg |= 0x20;
> + writel(reg, regs + QCA956X_GPIO_REG_OUT_FUNC1);
> +
> + /* Init MDC(GPIO3) / MDIO(GPIO4) */
> + reg = readl(regs + AR71XX_GPIO_REG_OE);
> + reg &= ~BIT(4);
> + writel(reg, regs + AR71XX_GPIO_REG_OE);
> + udelay(100);
> +
> + reg = readl(regs + AR71XX_GPIO_REG_OE);
> + reg &= ~BIT(3);
> + writel(reg, regs + AR71XX_GPIO_REG_OE);
> + udelay(100);
> +
> + /* GPIO3 as MDI */
> + reg = readl(regs + QCA956X_GPIO_REG_OUT_FUNC0);
> + reg &= ~(0xff << 24);
> + reg |= (0x21 << 24);
> + writel(reg, regs + QCA956X_GPIO_REG_OUT_FUNC0);
> +
> + return 0;
> +}
> +
> +static int eth_init_qca956x(void)
> +{
> + void __iomem *pregs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
> + MAP_NOCACHE);
> + void __iomem *gregs = map_physmem(AR71XX_MII_BASE, AR71XX_MII_SIZE,
> + MAP_NOCACHE);
> +
> + qca956x_sgmii_cal();
> + qca956x_s17_reset();
> + qca956x_init_mdio();
> +
> + if (ath79_get_bootstrap() & QCA956X_BOOTSTRAP_REF_CLK_40)
> + writel(0x45500, pregs + QCA956X_PLL_SWITCH_CLK_CTRL_REG);
> + else
> + writel(0xc5200, pregs + QCA956X_PLL_SWITCH_CLK_CTRL_REG);
> +
> + qca956x_sgmii_setup();
> +
> + writel((3 << 16) | (3 << 14) | (1 << 0) | (1 << 6),
> + gregs + QCA956X_GMAC_REG_ETH_CFG);
> +
> + writel((1 << 31) | (2 << 28) | (2 << 26) | (1 << 25),
> + pregs + QCA956X_PLL_ETH_XMII_CTRL_REG);
> + mdelay(1);
> +
> + return 0;
> +}
> +
> int ath79_eth_reset(void)
> {
> /*
> @@ -164,6 +433,8 @@ int ath79_eth_reset(void)
> return eth_init_ar934x();
> if (soc_is_qca953x())
> return eth_init_qca953x();
> + if (soc_is_qca956x())
> + return eth_init_qca956x();
>
> return -EINVAL;
> }
> diff --git a/board/qca/ap152/Kconfig b/board/qca/ap152/Kconfig
> new file mode 100644
> index 0000000000..f6ad498e85
> --- /dev/null
> +++ b/board/qca/ap152/Kconfig
> @@ -0,0 +1,15 @@
> +if TARGET_AP152
> +
> +config SYS_VENDOR
> + default "qca"
> +
> +config SYS_BOARD
> + default "ap152"
> +
> +config SYS_CONFIG_NAME
> + default "ap152"
> +
> +config SYS_TEXT_BASE
> + default 0x9f000000
> +
> +endif
> diff --git a/board/qca/ap152/MAINTAINERS b/board/qca/ap152/MAINTAINERS
> new file mode 100644
> index 0000000000..785ec2766d
> --- /dev/null
> +++ b/board/qca/ap152/MAINTAINERS
> @@ -0,0 +1,6 @@
> +AP152 BOARD
> +M: Rosy Song <rosysong at rosinson.com>
> +S: Maintained
> +F: board/qca/ap152/
> +F: include/configs/ap152.h
> +F: configs/ap152_defconfig
> diff --git a/board/qca/ap152/Makefile b/board/qca/ap152/Makefile
> new file mode 100644
> index 0000000000..4270afa129
> --- /dev/null
> +++ b/board/qca/ap152/Makefile
> @@ -0,0 +1,3 @@
> +# SPDX-License-Identifier: GPL-2.0+
> +
> +obj-y = ap152.o
> diff --git a/board/qca/ap152/ap152.c b/board/qca/ap152/ap152.c
> new file mode 100644
> index 0000000000..30cd56563b
> --- /dev/null
> +++ b/board/qca/ap152/ap152.c
> @@ -0,0 +1,81 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright (C) 2018 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +#include <common.h>
> +#include <asm/io.h>
> +#include <asm/addrspace.h>
> +#include <asm/types.h>
> +#include <mach/ar71xx_regs.h>
> +#include <mach/ddr.h>
> +#include <mach/ath79.h>
> +#include <debug_uart.h>
> +
> +#define RST_RESET_RTC_RESET_LSB 27
> +#define RST_RESET_RTC_RESET_MASK 0x08000000
> +#define RST_RESET_RTC_RESET_SET(x) \
> + (((x) << RST_RESET_RTC_RESET_LSB) & RST_RESET_RTC_RESET_MASK)
> +
> +#ifdef CONFIG_DEBUG_UART_BOARD_INIT
> +void board_debug_uart_init(void)
> +{
> + void __iomem *regs;
> + u32 val;
> +
> + regs = map_physmem(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE,
> + MAP_NOCACHE);
> +
> + /* UART : RX18, TX22 done
> + * GPIO18 as input, GPIO22 as output
> + */
> + val = readl(regs + AR71XX_GPIO_REG_OE);
> + val |= QCA956X_GPIO(18);
> + val &= ~QCA956X_GPIO(22);
> + writel(val, regs + AR71XX_GPIO_REG_OE);
> +
> + /*
> + * Enable GPIO22 as UART0_SOUT
> + */
> + val = readl(regs + QCA956X_GPIO_REG_OUT_FUNC5);
> + val &= ~QCA956X_GPIO_MUX_MASK(16);
> + val |= QCA956X_GPIO_OUT_MUX_UART0_SOUT << 16;
> + writel(val, regs + QCA956X_GPIO_REG_OUT_FUNC5);
> +
> + /*
> + * Enable GPIO18 as UART0_SIN
> + */
> + val = readl(regs + QCA956X_GPIO_REG_IN_ENABLE0);
> + val &= ~QCA956X_GPIO_MUX_MASK(8);
> + val |= QCA956X_GPIO_IN_MUX_UART0_SIN << 8;
> + writel(val, regs + QCA956X_GPIO_REG_IN_ENABLE0);
> +
> + /*
> + * Enable GPIO22 output
> + */
> + val = readl(regs + AR71XX_GPIO_REG_OUT);
> + val |= QCA956X_GPIO(22);
> + writel(val, regs + AR71XX_GPIO_REG_OUT);
> +}
> +#endif
> +
> +int board_early_init_f(void)
> +{
> + u32 reg;
> + void __iomem *rst_regs = map_physmem(AR71XX_RESET_BASE,
> + AR71XX_RESET_SIZE, MAP_NOCACHE);
> +
> +#ifndef CONFIG_SKIP_LOWLEVEL_INIT
> + /* CPU:775, DDR:650, AHB:258 */
> + qca956x_pll_init();
> + qca956x_ddr_init();
> +#endif
> +
> + /* Take WMAC out of reset */
> + reg = readl(rst_regs + QCA956X_RESET_REG_RESET_MODULE);
> + reg &= (~RST_RESET_RTC_RESET_SET(1));
> + writel(reg, rst_regs + QCA956X_RESET_REG_RESET_MODULE);
> +
> + ath79_eth_reset();
> + return 0;
> +}
> diff --git a/configs/ap152_defconfig b/configs/ap152_defconfig
> new file mode 100644
> index 0000000000..21cb6eb742
> --- /dev/null
> +++ b/configs/ap152_defconfig
> @@ -0,0 +1,49 @@
> +CONFIG_MIPS=y
> +CONFIG_SYS_TEXT_BASE=0x9F000000
> +CONFIG_SYS_MALLOC_F_LEN=0x800
> +CONFIG_SYS_CACHE_SIZE_AUTO=y
> +CONFIG_DEBUG_UART_BOARD_INIT=y
> +CONFIG_DEBUG_UART_BASE=0xb8020000
> +CONFIG_DEBUG_UART_CLOCK=25000000
> +CONFIG_ARCH_ATH79=y
> +CONFIG_TARGET_AP152=y
> +CONFIG_DEBUG_UART=y
> +CONFIG_BOOTDELAY=3
> +CONFIG_USE_BOOTARGS=y
> +CONFIG_BOOTARGS="console=ttyS0,115200 root=/dev/mtdblock2 rootfstype=squashfs"
> +CONFIG_DISPLAY_CPUINFO=y
> +CONFIG_BOARD_EARLY_INIT_F=y
> +CONFIG_SYS_PROMPT="ap152 # "
> +# CONFIG_CMD_BDI is not set
> +# CONFIG_CMD_CONSOLE is not set
> +# CONFIG_CMD_ELF is not set
> +# CONFIG_CMD_XIMG is not set
> +# CONFIG_CMD_EXPORTENV is not set
> +# CONFIG_CMD_IMPORTENV is not set
> +# CONFIG_CMD_EDITENV is not set
> +# CONFIG_CMD_CRC32 is not set
> +CONFIG_CMD_MEMTEST=y
> +# CONFIG_CMD_FLASH is not set
> +CONFIG_CMD_SF=y
> +CONFIG_CMD_SPI=y
> +CONFIG_CMD_MTDPARTS=y
> +CONFIG_MTDIDS_DEFAULT="nor0=spi-flash.0"
> +CONFIG_MTDPARTS_DEFAULT="mtdparts=spi-flash.0:256k(u-boot),64k(u-boot-env),6336k(rootfs),1472k(uImage),64k(ART)"
> +# CONFIG_ISO_PARTITION is not set
> +CONFIG_DEFAULT_DEVICE_TREE="ap152"
> +CONFIG_ENV_IS_IN_SPI_FLASH=y
> +# CONFIG_NET is not set
> +CONFIG_DM_SPI_FLASH=y
> +CONFIG_SPI_FLASH=y
> +CONFIG_SPI_FLASH_BAR=y
> +CONFIG_SPI_FLASH_WINBOND=y
> +CONFIG_SPI_FLASH_DATAFLASH=y
> +CONFIG_SPI_FLASH_MTD=y
> +CONFIG_PINCTRL=y
> +CONFIG_DM_SERIAL=y
> +CONFIG_DEBUG_UART_SHIFT=2
> +CONFIG_SYS_NS16550=y
> +CONFIG_SPI=y
> +CONFIG_DM_SPI=y
> +CONFIG_ATH79_SPI=y
> +CONFIG_LZMA=y
> diff --git a/include/configs/ap152.h b/include/configs/ap152.h
> new file mode 100644
> index 0000000000..bc88506dff
> --- /dev/null
> +++ b/include/configs/ap152.h
> @@ -0,0 +1,54 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
> +/*
> + * Copyright (C) 2018 Rosy Song <rosysong at rosinson.com>
> + */
> +
> +#ifndef __CONFIG_H
> +#define __CONFIG_H
> +
> +#define CONFIG_SYS_HZ 1000
> +#define CONFIG_SYS_MHZ 375
> +#define CONFIG_SYS_MIPS_TIMER_FREQ (CONFIG_SYS_MHZ * 1000000)
> +
> +#define CONFIG_SYS_MONITOR_BASE CONFIG_SYS_TEXT_BASE
> +
> +#define CONFIG_SYS_MALLOC_LEN 0x40000
> +#define CONFIG_SYS_BOOTPARAMS_LEN 0x20000
> +
> +#define CONFIG_SYS_SDRAM_BASE 0x80000000
> +#define CONFIG_SYS_LOAD_ADDR 0x81000000
> +
> +#define CONFIG_SYS_INIT_RAM_ADDR 0xbd000000
> +#define CONFIG_SYS_INIT_RAM_SIZE 0x2000
> +#define CONFIG_SYS_INIT_SP_ADDR \
> + (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_SIZE - 1)
> +
> +/*
> + * Serial Port
> + */
> +#define CONFIG_SYS_NS16550_CLK 25000000
> +#define CONFIG_SYS_BAUDRATE_TABLE \
> + {9600, 19200, 38400, 57600, 115200}
> +
> +#define CONFIG_BOOTCOMMAND "sf probe;" \
> + "mtdparts default;" \
> + "bootm 0x9f060000"
> +
> +#define CONFIG_EXTRA_ENV_SETTINGS \
> + "ipaddr=192.168.1.1\0" \
> + "serverip=192.168.1.10\0" \
> +
> +#define CONFIG_ENV_SPI_MAX_HZ 25000000
> +#define CONFIG_ENV_OFFSET 0x40000
> +#define CONFIG_ENV_SECT_SIZE 0x10000
> +#define CONFIG_ENV_SIZE 0x10000
> +
> +/* Miscellaneous configurable options */
> +
> +/*
> + * Diagnostics
> + */
> +#define CONFIG_SYS_MEMTEST_START 0x80100000
> +#define CONFIG_SYS_MEMTEST_END 0x83f00000
> +
> +#endif /* __CONFIG_H */
>
--
- Daniel
More information about the U-Boot
mailing list