Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/arch Add basic Zynq-7000 PS clock subsystem driver.
details: https://anonhg.NetBSD.org/src/rev/3cafc5a25123
branches: trunk
changeset: 372006:3cafc5a25123
user: jmcneill <jmcneill%NetBSD.org@localhost>
date: Tue Oct 25 22:27:49 2022 +0000
description:
Add basic Zynq-7000 PS clock subsystem driver.
PR# kern/57068
diffstat:
sys/arch/arm/xilinx/files.zynq | 7 +-
sys/arch/arm/xilinx/zynq7000_clkc.c | 367 ++++++++++++++++++++++++++++++++++++
sys/arch/evbarm/conf/GENERIC | 3 +-
3 files changed, 375 insertions(+), 2 deletions(-)
diffs (truncated from 410 to 300 lines):
diff -r 12997fc2e35d -r 3cafc5a25123 sys/arch/arm/xilinx/files.zynq
--- a/sys/arch/arm/xilinx/files.zynq Tue Oct 25 19:33:00 2022 +0000
+++ b/sys/arch/arm/xilinx/files.zynq Tue Oct 25 22:27:49 2022 +0000
@@ -1,4 +1,4 @@
-# $NetBSD: files.zynq,v 1.1 2019/06/11 13:01:48 skrll Exp $
+# $NetBSD: files.zynq,v 1.2 2022/10/25 22:27:49 jmcneill Exp $
#
# Configuration info for Xilinx Zynq-7000 SoC
#
@@ -15,6 +15,11 @@
#attach zynqslcr at fdt
#file arch/arm/xilinx/zynq_slcr.c zynqslcr needs-flag
+# PS clock subsystem
+device zynqclk
+attach zynqclk at fdt with zynq7000_clkc
+file arch/arm/xilinx/zynq7000_clkc.c zynq7000_clkc
+
# UART
device zynquart
attach zynquart at fdt
diff -r 12997fc2e35d -r 3cafc5a25123 sys/arch/arm/xilinx/zynq7000_clkc.c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/arch/arm/xilinx/zynq7000_clkc.c Tue Oct 25 22:27:49 2022 +0000
@@ -0,0 +1,367 @@
+/* $NetBSD: zynq7000_clkc.c,v 1.1 2022/10/25 22:27:49 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2022 Jared McNeill <jmcneill%invisible.ca@localhost>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. 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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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 <sys/cdefs.h>
+
+__KERNEL_RCSID(0, "$NetBSD: zynq7000_clkc.c,v 1.1 2022/10/25 22:27:49 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/device.h>
+#include <sys/intr.h>
+#include <sys/systm.h>
+#include <sys/time.h>
+#include <sys/kmem.h>
+
+#include <dev/clk/clk_backend.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#define ARM_PLL_CTRL 0x000
+#define DDR_PLL_CTRL 0x004
+#define IO_PLL_CTRL 0x008
+#define PLL_FDIV __BITS(18,12)
+#define ARM_CLK_CTRL 0x020
+#define ARM_CLK_CTRL_DIVISOR __BITS(13,8)
+#define ARM_CLK_CTRL_CPU_1XCLKACT __BIT(27)
+#define ARM_CLK_CTRL_CPU_2XCLKACT __BIT(26)
+#define ARM_CLK_CTRL_CPU_3OR2XCLKACT __BIT(25)
+#define ARM_CLK_CTRL_CPU_6OR4XCLKACT __BIT(24)
+#define APER_CLK_CTRL 0x02c
+#define UART1_CPU_1XCLKACT __BIT(21)
+#define UART0_CPU_1XCLKACT __BIT(20)
+#define UART_CLK_CTRL 0x054
+#define UART_CLK_CTRL_DIVISOR __BITS(13,8)
+#define UART_CLK_CTRL_SRCSEL __BITS(5,4)
+#define UART_CLK_CTRL_CLKACT1 __BIT(1)
+#define UART_CLK_CTRL_CLKACT0 __BIT(0)
+#define CLK_621_TRUE 0x0C4
+#define CLK_621_TRUE_EN __BIT(0)
+
+enum xynq7000_clkid {
+ clkid_armpll,
+ clkid_ddrpll,
+ clkid_iopll,
+ clkid_cpu_6or4x,
+ clkid_cpu_3or2x,
+ clkid_cpu_2x,
+ clkid_cpu_1x,
+ clkid_ddr2x,
+ clkid_ddr3x,
+ clkid_dci,
+ clkid_lqspi,
+ clkid_smc,
+ clkid_pcap,
+ clkid_gem0,
+ clkid_gem1,
+ clkid_fclk0,
+ clkid_fclk1,
+ clkid_fclk2,
+ clkid_fclk3,
+ clkid_can0,
+ clkid_can1,
+ clkid_sdio0,
+ clkid_sdio1,
+ clkid_uart0,
+ clkid_uart1,
+ clkid_spi0,
+ clkid_spi1,
+ clkid_dma,
+ clkid_usb0_aper,
+ clkid_usb1_aper,
+ clkid_gem0_aper,
+ clkid_gem1_aper,
+ clkid_sdio0_aper,
+ clkid_sdio1_aper,
+ clkid_spi0_aper,
+ clkid_spi1_aper,
+ clkid_can0_aper,
+ clkid_can1_aper,
+ clkid_i2c0_aper,
+ clkid_i2c1_aper,
+ clkid_uart0_aper,
+ clkid_uart1_aper,
+ clkid_gpio_aper,
+ clkid_lqspi_aper,
+ clkid_smc_aper,
+ clkid_swdt,
+ clkid_dbg_trc,
+ clkid_dbg_apb,
+ num_clkid
+};
+CTASSERT(clkid_dbg_apb == 47);
+
+static int zynq7000_clkc_match(device_t, cfdata_t, void *);
+static void zynq7000_clkc_attach(device_t, device_t, void *);
+
+static const struct device_compatible_entry compat_data[] = {
+ { .compat = "xlnx,ps7-clkc" },
+ DEVICE_COMPAT_EOL
+};
+
+struct zynq7000_clkc_softc {
+ device_t sc_dev;
+ struct clk_domain sc_clkdom;
+ struct clk sc_clk[num_clkid];
+
+ u_int sc_ps_clk_frequency;
+
+ bus_space_tag_t sc_bst;
+ bus_space_handle_t sc_bsh;
+};
+
+CFATTACH_DECL_NEW(zynq7000_clkc, sizeof(struct zynq7000_clkc_softc),
+ zynq7000_clkc_match, zynq7000_clkc_attach, NULL, NULL);
+
+static struct clk *
+zynq7000_clkc_clk_get(void *priv, const char *name)
+{
+ struct zynq7000_clkc_softc * const sc = priv;
+ u_int clkid;
+
+ for (clkid = 0; clkid < num_clkid; clkid++) {
+ if (strcmp(name, sc->sc_clk[clkid].name) == 0) {
+ return &sc->sc_clk[clkid];
+ }
+ }
+
+ return NULL;
+}
+
+static void
+zynq7000_clkc_clk_put(void *priv, struct clk *clk)
+{
+}
+
+static u_int
+zynq7000_clkc_get_rate_pll(struct zynq7000_clkc_softc *sc,
+ bus_addr_t reg)
+{
+ uint32_t val;
+
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh, reg);
+
+ return sc->sc_ps_clk_frequency * __SHIFTOUT(val, PLL_FDIV);
+}
+
+static u_int
+zynq7000_clkc_clk_get_rate(void *priv, struct clk *clk)
+{
+ struct zynq7000_clkc_softc * const sc = priv;
+ uint32_t val;
+ u_int prate, sel;
+
+ if (clk == &sc->sc_clk[clkid_armpll]) {
+ return zynq7000_clkc_get_rate_pll(sc, ARM_PLL_CTRL);
+ } else if (clk == &sc->sc_clk[clkid_iopll]) {
+ return zynq7000_clkc_get_rate_pll(sc, IO_PLL_CTRL);
+ } else if (clk == &sc->sc_clk[clkid_cpu_6or4x]) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_cpu_1x]);
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
+ CLK_621_TRUE);
+ return (val & CLK_621_TRUE_EN) != 0 ?
+ prate * 6 : prate * 4;
+ } else if (clk == &sc->sc_clk[clkid_cpu_3or2x]) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_cpu_1x]);
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
+ CLK_621_TRUE);
+ return (val & CLK_621_TRUE_EN) != 0 ?
+ prate * 3 : prate * 2;
+ } else if (clk == &sc->sc_clk[clkid_cpu_2x]) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_cpu_1x]);
+ return prate * 2;
+ } else if (clk == &sc->sc_clk[clkid_cpu_1x]) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_armpll]);
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
+ ARM_CLK_CTRL);
+ return prate / __SHIFTOUT(val, ARM_CLK_CTRL_DIVISOR);
+ } else if (clk == &sc->sc_clk[clkid_uart0] ||
+ clk == &sc->sc_clk[clkid_uart1]) {
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
+ UART_CLK_CTRL);
+ sel = __SHIFTOUT(val, UART_CLK_CTRL_SRCSEL);
+ if (sel == 2) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_armpll]);
+ } else if (sel == 3) {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_ddrpll]);
+ } else {
+ prate = zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_iopll]);
+ }
+ return prate / __SHIFTOUT(val, UART_CLK_CTRL_DIVISOR);
+ } else if (clk == &sc->sc_clk[clkid_uart0_aper] ||
+ clk == &sc->sc_clk[clkid_uart1_aper]) {
+ return zynq7000_clkc_clk_get_rate(sc,
+ &sc->sc_clk[clkid_cpu_1x]);
+ } else {
+ /* Not implemented. */
+ return 0;
+ }
+}
+
+static int
+zynq7000_clkc_clk_enable(void *priv, struct clk *clk)
+{
+ struct zynq7000_clkc_softc * const sc = priv;
+ uint32_t val, mask;
+ bus_addr_t reg;
+
+ if (clk == &sc->sc_clk[clkid_cpu_1x]) {
+ reg = ARM_CLK_CTRL;
+ mask = ARM_CLK_CTRL_CPU_1XCLKACT;
+ } else if (clk == &sc->sc_clk[clkid_cpu_2x]) {
+ reg = ARM_CLK_CTRL;
+ mask = ARM_CLK_CTRL_CPU_2XCLKACT;
+ } else if (clk == &sc->sc_clk[clkid_cpu_3or2x]) {
+ reg = ARM_CLK_CTRL;
+ mask = ARM_CLK_CTRL_CPU_3OR2XCLKACT;
+ } else if (clk == &sc->sc_clk[clkid_cpu_6or4x]) {
+ reg = ARM_CLK_CTRL;
+ mask = ARM_CLK_CTRL_CPU_6OR4XCLKACT;
+ } else if (clk == &sc->sc_clk[clkid_uart0]) {
+ reg = UART_CLK_CTRL;
+ mask = UART_CLK_CTRL_CLKACT0;
+ } else if (clk == &sc->sc_clk[clkid_uart1]) {
+ reg = UART_CLK_CTRL;
+ mask = UART_CLK_CTRL_CLKACT1;
+ } else if (clk == &sc->sc_clk[clkid_uart0_aper]) {
+ reg = APER_CLK_CTRL;
+ mask = UART0_CPU_1XCLKACT;
+ } else if (clk == &sc->sc_clk[clkid_uart1_aper]) {
+ reg = APER_CLK_CTRL;
+ mask = UART1_CPU_1XCLKACT;
+ } else {
+ return ENXIO;
+ }
+
+ val = bus_space_read_4(sc->sc_bst, sc->sc_bsh, reg);
+ bus_space_write_4(sc->sc_bst, sc->sc_bsh, reg, val | mask);
+
+ return 0;
+}
+
+static int
+zynq7000_clkc_clk_disable(void *priv, struct clk *clk)
Home |
Main Index |
Thread Index |
Old Index