jh7110_syscon.c revision 1.1 1 1.1 skrll /* $NetBSD: jh7110_syscon.c,v 1.1 2024/11/11 20:30:08 skrll Exp $ */
2 1.1 skrll
3 1.1 skrll /*-
4 1.1 skrll * Copyright (c) 2024 The NetBSD Foundation, Inc.
5 1.1 skrll * All rights reserved.
6 1.1 skrll *
7 1.1 skrll * This code is derived from software contributed to The NetBSD Foundation
8 1.1 skrll * by Nick Hudson
9 1.1 skrll *
10 1.1 skrll * Redistribution and use in source and binary forms, with or without
11 1.1 skrll * modification, are permitted provided that the following conditions
12 1.1 skrll * are met:
13 1.1 skrll * 1. Redistributions of source code must retain the above copyright
14 1.1 skrll * notice, this list of conditions and the following disclaimer.
15 1.1 skrll * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 skrll * notice, this list of conditions and the following disclaimer in the
17 1.1 skrll * documentation and/or other materials provided with the distribution.
18 1.1 skrll *
19 1.1 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 skrll * POSSIBILITY OF SUCH DAMAGE.
30 1.1 skrll */
31 1.1 skrll
32 1.1 skrll #include <sys/cdefs.h>
33 1.1 skrll __KERNEL_RCSID(0, "$NetBSD: jh7110_syscon.c,v 1.1 2024/11/11 20:30:08 skrll Exp $");
34 1.1 skrll
35 1.1 skrll #include <sys/param.h>
36 1.1 skrll
37 1.1 skrll #include <sys/mutex.h>
38 1.1 skrll
39 1.1 skrll #include <dev/fdt/fdtvar.h>
40 1.1 skrll #include <dev/fdt/syscon.h>
41 1.1 skrll
42 1.1 skrll struct jh7110_syscon_softc {
43 1.1 skrll device_t sc_dev;
44 1.1 skrll bus_space_tag_t sc_bst;
45 1.1 skrll bus_space_handle_t sc_bsh;
46 1.1 skrll int sc_phandle;
47 1.1 skrll
48 1.1 skrll kmutex_t sc_lock;
49 1.1 skrll struct syscon sc_syscon;
50 1.1 skrll };
51 1.1 skrll
52 1.1 skrll #define RD4(sc, reg) \
53 1.1 skrll bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
54 1.1 skrll #define WR4(sc, reg, val) \
55 1.1 skrll bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
56 1.1 skrll
57 1.1 skrll
58 1.1 skrll static void
59 1.1 skrll jh7110_syscon_lock(void *priv)
60 1.1 skrll {
61 1.1 skrll struct jh7110_syscon_softc * const sc = priv;
62 1.1 skrll
63 1.1 skrll mutex_enter(&sc->sc_lock);
64 1.1 skrll }
65 1.1 skrll
66 1.1 skrll static void
67 1.1 skrll jh7110_syscon_unlock(void *priv)
68 1.1 skrll {
69 1.1 skrll struct jh7110_syscon_softc * const sc = priv;
70 1.1 skrll
71 1.1 skrll mutex_exit(&sc->sc_lock);
72 1.1 skrll }
73 1.1 skrll
74 1.1 skrll static uint32_t
75 1.1 skrll jh7110_syscon_read_4(void *priv, bus_size_t reg)
76 1.1 skrll {
77 1.1 skrll struct jh7110_syscon_softc * const sc = priv;
78 1.1 skrll
79 1.1 skrll KASSERT(mutex_owned(&sc->sc_lock));
80 1.1 skrll
81 1.1 skrll return RD4(sc, reg);
82 1.1 skrll }
83 1.1 skrll
84 1.1 skrll static void
85 1.1 skrll jh7110_syscon_write_4(void *priv, bus_size_t reg, uint32_t val)
86 1.1 skrll {
87 1.1 skrll struct jh7110_syscon_softc * const sc = priv;
88 1.1 skrll
89 1.1 skrll KASSERT(mutex_owned(&sc->sc_lock));
90 1.1 skrll
91 1.1 skrll WR4(sc, reg, val);
92 1.1 skrll }
93 1.1 skrll
94 1.1 skrll
95 1.1 skrll /* Compat string(s) */
96 1.1 skrll static const struct device_compatible_entry compat_data[] = {
97 1.1 skrll { .compat = "starfive,jh7110-stg-syscon" },
98 1.1 skrll DEVICE_COMPAT_EOL
99 1.1 skrll };
100 1.1 skrll
101 1.1 skrll static int
102 1.1 skrll jh7110_syscon_match(device_t parent, cfdata_t cf, void *aux)
103 1.1 skrll {
104 1.1 skrll struct fdt_attach_args * const faa = aux;
105 1.1 skrll
106 1.1 skrll return of_compatible_match(faa->faa_phandle, compat_data);
107 1.1 skrll }
108 1.1 skrll
109 1.1 skrll static void
110 1.1 skrll jh7110_syscon_attach(device_t parent, device_t self, void *aux)
111 1.1 skrll {
112 1.1 skrll struct jh7110_syscon_softc *sc = device_private(self);
113 1.1 skrll struct fdt_attach_args * const faa = aux;
114 1.1 skrll const int phandle = faa->faa_phandle;
115 1.1 skrll const bus_space_tag_t bst = faa->faa_bst;
116 1.1 skrll bus_addr_t addr;
117 1.1 skrll bus_size_t size;
118 1.1 skrll int error;
119 1.1 skrll
120 1.1 skrll sc->sc_dev = self;
121 1.1 skrll sc->sc_phandle = phandle;
122 1.1 skrll sc->sc_bst = bst;
123 1.1 skrll
124 1.1 skrll error = fdtbus_get_reg(phandle, 0, &addr, &size);
125 1.1 skrll if (error) {
126 1.1 skrll aprint_error(": couldn't get registers\n");
127 1.1 skrll return;
128 1.1 skrll }
129 1.1 skrll
130 1.1 skrll error = bus_space_map(bst, addr, size, 0, &sc->sc_bsh);
131 1.1 skrll if (error) {
132 1.1 skrll aprint_error(": couldn't map %#" PRIxBUSADDR ": %d", addr,
133 1.1 skrll error);
134 1.1 skrll return;
135 1.1 skrll }
136 1.1 skrll
137 1.1 skrll mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
138 1.1 skrll
139 1.1 skrll aprint_naive("\n");
140 1.1 skrll aprint_normal(": JH7110 STG system controller\n");
141 1.1 skrll
142 1.1 skrll sc->sc_syscon.priv = sc;
143 1.1 skrll sc->sc_syscon.lock = jh7110_syscon_lock;
144 1.1 skrll sc->sc_syscon.unlock = jh7110_syscon_unlock;
145 1.1 skrll sc->sc_syscon.read_4 = jh7110_syscon_read_4;
146 1.1 skrll sc->sc_syscon.write_4 = jh7110_syscon_write_4;
147 1.1 skrll fdtbus_register_syscon(self, phandle, &sc->sc_syscon);
148 1.1 skrll }
149 1.1 skrll
150 1.1 skrll CFATTACH_DECL_NEW(jh7110_syscon, sizeof(struct jh7110_syscon_softc),
151 1.1 skrll jh7110_syscon_match, jh7110_syscon_attach, NULL, NULL);
152