2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
4 * Copyright (c) 2017 Poul-Henning Kamp <phk@FreeBSD.org>
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
32 #include <sys/param.h>
33 #include <sys/systm.h>
36 #include <sys/kernel.h>
38 #include <sys/malloc.h>
39 #include <sys/module.h>
40 #include <sys/mutex.h>
43 #include <sys/sysctl.h>
45 #include <machine/bus.h>
46 #include <machine/cpu.h>
48 #include <dev/ofw/ofw_bus.h>
49 #include <dev/ofw/ofw_bus_subr.h>
51 #include <arm/broadcom/bcm2835/bcm2835_clkman.h>
53 static struct ofw_compat_data compat_data[] = {
54 {"brcm,bcm2835-cprman", 1},
55 {"broadcom,bcm2835-cprman", 1},
59 struct bcm2835_clkman_softc {
62 struct resource * sc_m_res;
63 bus_space_tag_t sc_m_bst;
64 bus_space_handle_t sc_m_bsh;
67 #define BCM_CLKMAN_WRITE(_sc, _off, _val) \
68 bus_space_write_4(_sc->sc_m_bst, _sc->sc_m_bsh, _off, _val)
69 #define BCM_CLKMAN_READ(_sc, _off) \
70 bus_space_read_4(_sc->sc_m_bst, _sc->sc_m_bsh, _off)
72 #define W_CMCLK(_sc, unit, _val) BCM_CLKMAN_WRITE(_sc, unit, 0x5a000000 | (_val))
73 #define R_CMCLK(_sc, unit) BCM_CLKMAN_READ(_sc, unit)
74 #define W_CMDIV(_sc, unit, _val) BCM_CLKMAN_WRITE(_sc, (unit) + 4, 0x5a000000 | (_val))
75 #define R_CMDIV(_sc, unit) BCM_CLKMAN_READ(_sc, (unit) + 4)
78 bcm2835_clkman_probe(device_t dev)
81 if (!ofw_bus_status_okay(dev))
84 if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0)
87 device_set_desc(dev, "BCM283x Clock Manager");
89 return (BUS_PROBE_DEFAULT);
93 bcm2835_clkman_attach(device_t dev)
95 struct bcm2835_clkman_softc *sc;
98 if (device_get_unit(dev) != 0) {
99 device_printf(dev, "only one clk manager supported\n");
103 sc = device_get_softc(dev);
107 sc->sc_m_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
110 device_printf(dev, "cannot allocate memory window\n");
114 sc->sc_m_bst = rman_get_bustag(sc->sc_m_res);
115 sc->sc_m_bsh = rman_get_bushandle(sc->sc_m_res);
117 return (bus_generic_attach(dev));
121 bcm2835_clkman_set_frequency(device_t dev, uint32_t unit, uint32_t hz)
123 struct bcm2835_clkman_softc *sc;
127 sc = device_get_softc(dev);
129 if (unit != BCM_PWM_CLKSRC) {
130 device_printf(sc->sc_dev,
131 "Unsupported unit 0x%x", unit);
135 W_CMCLK(sc, unit, 6);
136 for (i = 0; i < 10; i++) {
137 u = R_CMCLK(sc, unit);
143 device_printf(sc->sc_dev,
144 "Failed to stop clock for unit 0x%x", unit);
152 device_printf(sc->sc_dev,
153 "Frequency too high for unit 0x%x (max: 125 MHz)",
158 device_printf(sc->sc_dev,
159 "Frequency too low for unit 0x%x (min: 123 kHz)",
164 W_CMDIV(sc, unit, u << 12);
166 W_CMCLK(sc, unit, 0x16);
167 for (i = 0; i < 10; i++) {
168 u = R_CMCLK(sc, unit);
174 device_printf(sc->sc_dev,
175 "Failed to start clock for unit 0x%x", unit);
182 bcm2835_clkman_detach(device_t dev)
184 struct bcm2835_clkman_softc *sc;
186 bus_generic_detach(dev);
188 sc = device_get_softc(dev);
190 bus_release_resource(dev, SYS_RES_MEMORY, 0, sc->sc_m_res);
195 static device_method_t bcm2835_clkman_methods[] = {
196 /* Device interface */
197 DEVMETHOD(device_probe, bcm2835_clkman_probe),
198 DEVMETHOD(device_attach, bcm2835_clkman_attach),
199 DEVMETHOD(device_detach, bcm2835_clkman_detach),
204 static devclass_t bcm2835_clkman_devclass;
205 static driver_t bcm2835_clkman_driver = {
207 bcm2835_clkman_methods,
208 sizeof(struct bcm2835_clkman_softc),
211 DRIVER_MODULE(bcm2835_clkman, simplebus, bcm2835_clkman_driver,
212 bcm2835_clkman_devclass, 0, 0);
213 MODULE_VERSION(bcm2835_clkman, 1);