exi.c revision 1.2 1 1.2 jmcneill /* $NetBSD: exi.c,v 1.2 2024/02/10 11:00:15 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2024 Jared McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include <sys/cdefs.h>
30 1.2 jmcneill __KERNEL_RCSID(0, "$NetBSD: exi.c,v 1.2 2024/02/10 11:00:15 jmcneill Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/param.h>
33 1.1 jmcneill #include <sys/bus.h>
34 1.1 jmcneill #include <sys/device.h>
35 1.1 jmcneill #include <sys/systm.h>
36 1.1 jmcneill #include <sys/bitops.h>
37 1.1 jmcneill #include <sys/mutex.h>
38 1.1 jmcneill #include <uvm/uvm_extern.h>
39 1.1 jmcneill
40 1.1 jmcneill #include <machine/wii.h>
41 1.1 jmcneill #include <machine/pio.h>
42 1.1 jmcneill
43 1.1 jmcneill #include "locators.h"
44 1.1 jmcneill #include "mainbus.h"
45 1.1 jmcneill #include "exi.h"
46 1.1 jmcneill
47 1.1 jmcneill #define EXI_NUM_CHAN 3
48 1.1 jmcneill #define EXI_NUM_DEV 3
49 1.1 jmcneill
50 1.1 jmcneill /* This is an arbitrary limit. The real limit is probably much higher. */
51 1.1 jmcneill #define EXI_MAX_DMA 4096
52 1.1 jmcneill
53 1.1 jmcneill #define EXI_CSR(n) (0x00 + (n) * 0x14)
54 1.1 jmcneill #define EXI_CSR_CS __BITS(9,7)
55 1.2 jmcneill #define EXI_CSR_CLK __BITS(6,4)
56 1.1 jmcneill #define EXI_MAR(n) (0x04 + (n) * 0x14)
57 1.1 jmcneill #define EXI_LENGTH(n) (0x08 + (n) * 0x14)
58 1.1 jmcneill #define EXI_CR(n) (0x0c + (n) * 0x14)
59 1.1 jmcneill #define EXI_CR_TLEN __BITS(5,4)
60 1.1 jmcneill #define EXI_CR_RW __BITS(3,2)
61 1.1 jmcneill #define EXI_CR_RW_READ __SHIFTIN(0, EXI_CR_RW)
62 1.1 jmcneill #define EXI_CR_RW_WRITE __SHIFTIN(1, EXI_CR_RW)
63 1.1 jmcneill #define EXI_CR_DMA __BIT(1)
64 1.1 jmcneill #define EXI_CR_TSTART __BIT(0)
65 1.1 jmcneill #define EXI_DATA(n) (0x10 + (n) * 0x14)
66 1.1 jmcneill
67 1.1 jmcneill #define ASSERT_CHAN_VALID(chan) KASSERT((chan) >= 0 && (chan) < EXI_NUM_CHAN)
68 1.1 jmcneill #define ASSERT_DEV_VALID(dev) KASSERT((dev) >= 0 && (dev) < EXI_NUM_DEV)
69 1.1 jmcneill #define ASSERT_LEN_VALID(len) KASSERT((len) == 1 || (len) == 2 || (len) == 4)
70 1.1 jmcneill
71 1.1 jmcneill struct exi_channel {
72 1.1 jmcneill kmutex_t ch_lock;
73 1.1 jmcneill
74 1.1 jmcneill bus_dmamap_t ch_dmamap;
75 1.1 jmcneill
76 1.1 jmcneill device_t ch_child[EXI_NUM_DEV];
77 1.1 jmcneill };
78 1.1 jmcneill
79 1.1 jmcneill struct exi_softc {
80 1.1 jmcneill device_t sc_dev;
81 1.1 jmcneill bus_space_tag_t sc_bst;
82 1.1 jmcneill bus_space_handle_t sc_bsh;
83 1.1 jmcneill bus_dma_tag_t sc_dmat;
84 1.1 jmcneill
85 1.1 jmcneill struct exi_channel sc_chan[EXI_NUM_CHAN];
86 1.1 jmcneill };
87 1.1 jmcneill
88 1.1 jmcneill static struct exi_softc *exi_softc;
89 1.1 jmcneill
90 1.1 jmcneill #define RD4(sc, reg) \
91 1.1 jmcneill bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
92 1.1 jmcneill #define WR4(sc, reg, val) \
93 1.1 jmcneill bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
94 1.1 jmcneill
95 1.1 jmcneill static int exi_match(device_t, cfdata_t, void *);
96 1.1 jmcneill static void exi_attach(device_t, device_t, void *);
97 1.1 jmcneill
98 1.1 jmcneill static int exi_rescan(device_t, const char *, const int *);
99 1.1 jmcneill static int exi_print(void *, const char *);
100 1.1 jmcneill
101 1.1 jmcneill CFATTACH_DECL_NEW(exi, sizeof(struct exi_softc),
102 1.1 jmcneill exi_match, exi_attach, NULL, NULL);
103 1.1 jmcneill
104 1.1 jmcneill static int
105 1.1 jmcneill exi_match(device_t parent, cfdata_t cf, void *aux)
106 1.1 jmcneill {
107 1.1 jmcneill struct mainbus_attach_args *maa = aux;
108 1.1 jmcneill
109 1.1 jmcneill return strcmp(maa->maa_name, "exi") == 0;
110 1.1 jmcneill }
111 1.1 jmcneill
112 1.1 jmcneill static void
113 1.1 jmcneill exi_attach(device_t parent, device_t self, void *aux)
114 1.1 jmcneill {
115 1.1 jmcneill struct mainbus_attach_args * const maa = aux;
116 1.1 jmcneill struct exi_softc * const sc = device_private(self);
117 1.1 jmcneill uint8_t chan;
118 1.1 jmcneill int error;
119 1.1 jmcneill
120 1.1 jmcneill KASSERT(device_unit(self) == 0);
121 1.1 jmcneill
122 1.1 jmcneill aprint_naive("\n");
123 1.1 jmcneill aprint_normal(": External Interface\n");
124 1.1 jmcneill
125 1.1 jmcneill exi_softc = sc;
126 1.1 jmcneill sc->sc_dev = self;
127 1.1 jmcneill sc->sc_bst = maa->maa_bst;
128 1.1 jmcneill if (bus_space_map(sc->sc_bst, maa->maa_addr, EXI_SIZE, 0,
129 1.1 jmcneill &sc->sc_bsh) != 0) {
130 1.1 jmcneill aprint_error_dev(self, "couldn't map registers\n");
131 1.1 jmcneill return;
132 1.1 jmcneill }
133 1.1 jmcneill sc->sc_dmat = maa->maa_dmat;
134 1.1 jmcneill for (chan = 0; chan < EXI_NUM_CHAN; chan++) {
135 1.1 jmcneill mutex_init(&sc->sc_chan[chan].ch_lock, MUTEX_DEFAULT, IPL_VM);
136 1.1 jmcneill error = bus_dmamap_create(exi_softc->sc_dmat, EXI_MAX_DMA, 1,
137 1.1 jmcneill EXI_MAX_DMA, 0, BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW,
138 1.1 jmcneill &sc->sc_chan[chan].ch_dmamap);
139 1.1 jmcneill if (error != 0) {
140 1.1 jmcneill aprint_error_dev(self, "couldn't create dmamap: %d\n",
141 1.1 jmcneill error);
142 1.1 jmcneill return;
143 1.1 jmcneill }
144 1.1 jmcneill }
145 1.1 jmcneill
146 1.1 jmcneill exi_rescan(self, NULL, NULL);
147 1.1 jmcneill }
148 1.1 jmcneill
149 1.1 jmcneill static int
150 1.1 jmcneill exi_rescan(device_t self, const char *ifattr, const int *locs)
151 1.1 jmcneill {
152 1.1 jmcneill struct exi_softc * const sc = device_private(self);
153 1.1 jmcneill uint8_t chan, dev;
154 1.1 jmcneill
155 1.1 jmcneill for (chan = 0; chan < EXI_NUM_CHAN; chan++) {
156 1.1 jmcneill struct exi_channel *ch = &sc->sc_chan[chan];
157 1.1 jmcneill for (dev = 0; dev < EXI_NUM_DEV; dev++) {
158 1.1 jmcneill struct exi_attach_args eaa = {};
159 1.1 jmcneill uint16_t command = 0x0000; /* ID command */
160 1.1 jmcneill uint32_t id = 0;
161 1.1 jmcneill
162 1.1 jmcneill if (ch->ch_child[dev] != NULL) {
163 1.1 jmcneill continue;
164 1.1 jmcneill }
165 1.1 jmcneill
166 1.2 jmcneill exi_select(chan, dev, EXI_FREQ_8MHZ);
167 1.1 jmcneill exi_send_imm(chan, dev, &command, sizeof(command));
168 1.1 jmcneill exi_recv_imm(chan, dev, &id, sizeof(id));
169 1.1 jmcneill exi_unselect(chan);
170 1.1 jmcneill
171 1.1 jmcneill if (id == 0 || id == 0xffffffff) {
172 1.1 jmcneill continue;
173 1.1 jmcneill }
174 1.1 jmcneill
175 1.1 jmcneill eaa.eaa_id = id;
176 1.1 jmcneill eaa.eaa_chan = chan;
177 1.1 jmcneill eaa.eaa_device = dev;
178 1.1 jmcneill
179 1.1 jmcneill ch->ch_child[dev] = config_found(self, &eaa, exi_print,
180 1.1 jmcneill CFARGS(.submatch = config_stdsubmatch,
181 1.1 jmcneill .locators = locs));
182 1.1 jmcneill }
183 1.1 jmcneill }
184 1.1 jmcneill
185 1.1 jmcneill return 0;
186 1.1 jmcneill }
187 1.1 jmcneill
188 1.1 jmcneill static int
189 1.1 jmcneill exi_print(void *aux, const char *pnp)
190 1.1 jmcneill {
191 1.1 jmcneill struct exi_attach_args *eaa = aux;
192 1.1 jmcneill
193 1.1 jmcneill if (pnp != NULL) {
194 1.1 jmcneill aprint_normal("EXI device 0x%08x at %s", eaa->eaa_id, pnp);
195 1.1 jmcneill }
196 1.1 jmcneill
197 1.1 jmcneill aprint_normal(" addr %u-%u", eaa->eaa_chan, eaa->eaa_device);
198 1.1 jmcneill
199 1.1 jmcneill return UNCONF;
200 1.1 jmcneill }
201 1.1 jmcneill
202 1.1 jmcneill void
203 1.2 jmcneill exi_select(uint8_t chan, uint8_t dev, exi_freq_t freq)
204 1.1 jmcneill {
205 1.1 jmcneill struct exi_channel *ch;
206 1.1 jmcneill uint32_t val;
207 1.1 jmcneill
208 1.1 jmcneill ASSERT_CHAN_VALID(chan);
209 1.1 jmcneill ASSERT_DEV_VALID(dev);
210 1.1 jmcneill
211 1.1 jmcneill ch = &exi_softc->sc_chan[chan];
212 1.1 jmcneill mutex_enter(&ch->ch_lock);
213 1.1 jmcneill
214 1.1 jmcneill val = RD4(exi_softc, EXI_CSR(chan));
215 1.1 jmcneill val &= ~EXI_CSR_CS;
216 1.1 jmcneill val |= __SHIFTIN(__BIT(dev), EXI_CSR_CS);
217 1.2 jmcneill val &= ~EXI_CSR_CLK;
218 1.2 jmcneill val |= __SHIFTIN(freq, EXI_CSR_CLK);
219 1.1 jmcneill WR4(exi_softc, EXI_CSR(chan), val);
220 1.1 jmcneill }
221 1.1 jmcneill
222 1.1 jmcneill void
223 1.1 jmcneill exi_unselect(uint8_t chan)
224 1.1 jmcneill {
225 1.1 jmcneill struct exi_channel *ch;
226 1.1 jmcneill uint32_t val;
227 1.1 jmcneill
228 1.1 jmcneill ASSERT_CHAN_VALID(chan);
229 1.1 jmcneill
230 1.1 jmcneill ch = &exi_softc->sc_chan[chan];
231 1.1 jmcneill
232 1.1 jmcneill val = RD4(exi_softc, EXI_CSR(chan));
233 1.1 jmcneill val &= ~EXI_CSR_CS;
234 1.1 jmcneill WR4(exi_softc, EXI_CSR(chan), val);
235 1.1 jmcneill
236 1.1 jmcneill mutex_exit(&ch->ch_lock);
237 1.1 jmcneill }
238 1.1 jmcneill
239 1.1 jmcneill static void
240 1.1 jmcneill exi_wait(uint8_t chan)
241 1.1 jmcneill {
242 1.1 jmcneill uint32_t val;
243 1.1 jmcneill
244 1.1 jmcneill ASSERT_CHAN_VALID(chan);
245 1.1 jmcneill
246 1.1 jmcneill do {
247 1.1 jmcneill val = RD4(exi_softc, EXI_CR(chan));
248 1.1 jmcneill } while ((val & EXI_CR_TSTART) != 0);
249 1.1 jmcneill }
250 1.1 jmcneill
251 1.1 jmcneill void
252 1.1 jmcneill exi_send_imm(uint8_t chan, uint8_t dev, const void *data, size_t datalen)
253 1.1 jmcneill {
254 1.1 jmcneill struct exi_channel *ch;
255 1.1 jmcneill uint32_t val = 0;
256 1.1 jmcneill
257 1.1 jmcneill ASSERT_CHAN_VALID(chan);
258 1.1 jmcneill ASSERT_DEV_VALID(dev);
259 1.1 jmcneill ASSERT_LEN_VALID(datalen);
260 1.1 jmcneill
261 1.1 jmcneill ch = &exi_softc->sc_chan[chan];
262 1.1 jmcneill KASSERT(mutex_owned(&ch->ch_lock));
263 1.1 jmcneill
264 1.1 jmcneill switch (datalen) {
265 1.1 jmcneill case 1:
266 1.1 jmcneill val = *(const uint8_t *)data << 24;
267 1.1 jmcneill break;
268 1.1 jmcneill case 2:
269 1.1 jmcneill val = *(const uint16_t *)data << 16;
270 1.1 jmcneill break;
271 1.1 jmcneill case 4:
272 1.1 jmcneill val = *(const uint32_t *)data;
273 1.1 jmcneill break;
274 1.1 jmcneill }
275 1.1 jmcneill
276 1.1 jmcneill WR4(exi_softc, EXI_DATA(chan), val);
277 1.1 jmcneill WR4(exi_softc, EXI_CR(chan),
278 1.1 jmcneill EXI_CR_TSTART | EXI_CR_RW_WRITE |
279 1.1 jmcneill __SHIFTIN(datalen - 1, EXI_CR_TLEN));
280 1.1 jmcneill exi_wait(chan);
281 1.1 jmcneill }
282 1.1 jmcneill
283 1.1 jmcneill void
284 1.1 jmcneill exi_recv_imm(uint8_t chan, uint8_t dev, void *data, size_t datalen)
285 1.1 jmcneill {
286 1.1 jmcneill struct exi_channel *ch;
287 1.1 jmcneill uint32_t val;
288 1.1 jmcneill
289 1.1 jmcneill ASSERT_CHAN_VALID(chan);
290 1.1 jmcneill ASSERT_DEV_VALID(dev);
291 1.1 jmcneill ASSERT_LEN_VALID(datalen);
292 1.1 jmcneill
293 1.1 jmcneill ch = &exi_softc->sc_chan[chan];
294 1.1 jmcneill KASSERT(mutex_owned(&ch->ch_lock));
295 1.1 jmcneill
296 1.1 jmcneill WR4(exi_softc, EXI_CR(chan),
297 1.1 jmcneill EXI_CR_TSTART | EXI_CR_RW_READ |
298 1.1 jmcneill __SHIFTIN(datalen - 1, EXI_CR_TLEN));
299 1.1 jmcneill exi_wait(chan);
300 1.1 jmcneill val = RD4(exi_softc, EXI_DATA(chan));
301 1.1 jmcneill
302 1.1 jmcneill switch (datalen) {
303 1.1 jmcneill case 1:
304 1.1 jmcneill *(uint8_t *)data = val >> 24;
305 1.1 jmcneill break;
306 1.1 jmcneill case 2:
307 1.1 jmcneill *(uint16_t *)data = val >> 16;
308 1.1 jmcneill break;
309 1.1 jmcneill case 4:
310 1.1 jmcneill *(uint32_t *)data = val;
311 1.1 jmcneill break;
312 1.1 jmcneill }
313 1.1 jmcneill }
314 1.1 jmcneill
315 1.1 jmcneill void
316 1.1 jmcneill exi_recv_dma(uint8_t chan, uint8_t dev, void *data, size_t datalen)
317 1.1 jmcneill {
318 1.1 jmcneill struct exi_channel *ch;
319 1.1 jmcneill int error;
320 1.1 jmcneill
321 1.1 jmcneill ASSERT_CHAN_VALID(chan);
322 1.1 jmcneill ASSERT_DEV_VALID(dev);
323 1.1 jmcneill KASSERT((datalen & 0x1f) == 0);
324 1.1 jmcneill
325 1.1 jmcneill ch = &exi_softc->sc_chan[chan];
326 1.1 jmcneill KASSERT(mutex_owned(&ch->ch_lock));
327 1.1 jmcneill
328 1.1 jmcneill error = bus_dmamap_load(exi_softc->sc_dmat, ch->ch_dmamap,
329 1.1 jmcneill data, datalen, NULL, BUS_DMA_WAITOK);
330 1.1 jmcneill if (error != 0) {
331 1.1 jmcneill device_printf(exi_softc->sc_dev, "can't load DMA handle: %d\n",
332 1.1 jmcneill error);
333 1.1 jmcneill return;
334 1.1 jmcneill }
335 1.1 jmcneill
336 1.1 jmcneill KASSERT((ch->ch_dmamap->dm_segs[0].ds_addr & 0x1f) == 0);
337 1.1 jmcneill
338 1.1 jmcneill bus_dmamap_sync(exi_softc->sc_dmat, ch->ch_dmamap, 0, datalen,
339 1.1 jmcneill BUS_DMASYNC_PREREAD);
340 1.1 jmcneill
341 1.1 jmcneill WR4(exi_softc, EXI_MAR(chan), ch->ch_dmamap->dm_segs[0].ds_addr);
342 1.1 jmcneill WR4(exi_softc, EXI_LENGTH(chan), datalen);
343 1.1 jmcneill WR4(exi_softc, EXI_CR(chan),
344 1.1 jmcneill EXI_CR_TSTART | EXI_CR_RW_READ | EXI_CR_DMA);
345 1.1 jmcneill exi_wait(chan);
346 1.1 jmcneill
347 1.1 jmcneill bus_dmamap_sync(exi_softc->sc_dmat, ch->ch_dmamap, 0, datalen,
348 1.1 jmcneill BUS_DMASYNC_POSTREAD);
349 1.1 jmcneill
350 1.1 jmcneill bus_dmamap_unload(exi_softc->sc_dmat, ch->ch_dmamap);
351 1.1 jmcneill }
352