octeon_twsi.c revision 1.2 1 1.2 simonb /* $NetBSD: octeon_twsi.c,v 1.2 2020/06/18 13:52:08 simonb Exp $ */
2 1.1 hikaru
3 1.1 hikaru /*
4 1.1 hikaru * Copyright (c) 2007 Internet Initiative Japan, Inc.
5 1.1 hikaru * All rights reserved.
6 1.1 hikaru *
7 1.1 hikaru * Redistribution and use in source and binary forms, with or without
8 1.1 hikaru * modification, are permitted provided that the following conditions
9 1.1 hikaru * are met:
10 1.1 hikaru * 1. Redistributions of source code must retain the above copyright
11 1.1 hikaru * notice, this list of conditions and the following disclaimer.
12 1.1 hikaru * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 hikaru * notice, this list of conditions and the following disclaimer in the
14 1.1 hikaru * documentation and/or other materials provided with the distribution.
15 1.1 hikaru *
16 1.1 hikaru * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
17 1.1 hikaru * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 hikaru * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 hikaru * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
20 1.1 hikaru * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 hikaru * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 hikaru * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 hikaru * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 hikaru * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 hikaru * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 hikaru * SUCH DAMAGE.
27 1.1 hikaru */
28 1.1 hikaru
29 1.1 hikaru #undef TWSIDEBUG
30 1.1 hikaru #undef TWSITEST
31 1.1 hikaru
32 1.1 hikaru #include <sys/cdefs.h>
33 1.2 simonb __KERNEL_RCSID(0, "$NetBSD: octeon_twsi.c,v 1.2 2020/06/18 13:52:08 simonb Exp $");
34 1.1 hikaru
35 1.1 hikaru #include "opt_octeon.h"
36 1.1 hikaru
37 1.1 hikaru #include <sys/param.h>
38 1.1 hikaru #include <sys/systm.h>
39 1.1 hikaru #include <sys/types.h>
40 1.1 hikaru #include <sys/device.h>
41 1.1 hikaru #include <sys/lock.h>
42 1.1 hikaru
43 1.1 hikaru #include <sys/bus.h>
44 1.1 hikaru
45 1.1 hikaru #include <dev/i2c/i2cvar.h>
46 1.1 hikaru
47 1.1 hikaru #include <mips/cavium/include/iobusvar.h>
48 1.1 hikaru #include <mips/cavium/dev/octeon_twsireg.h>
49 1.1 hikaru
50 1.1 hikaru #ifdef TWSIDEBUG
51 1.1 hikaru #define DPRINTF(x) printf x
52 1.1 hikaru #else
53 1.1 hikaru #define DPRINTF(x)
54 1.1 hikaru #endif
55 1.1 hikaru
56 1.1 hikaru struct octeon_twsi_reg;
57 1.1 hikaru
58 1.1 hikaru struct octeon_twsi_softc {
59 1.1 hikaru device_t sc_dev;
60 1.1 hikaru bus_space_tag_t sc_regt;
61 1.1 hikaru bus_space_handle_t sc_regh;
62 1.1 hikaru
63 1.1 hikaru void *sc_ih;
64 1.1 hikaru
65 1.1 hikaru struct i2c_controller sc_i2c;
66 1.1 hikaru struct lock sc_lock;
67 1.1 hikaru
68 1.1 hikaru /* ... */
69 1.1 hikaru };
70 1.1 hikaru
71 1.1 hikaru /* Auto-configuration */
72 1.1 hikaru
73 1.1 hikaru static int octeon_twsi_match(device_t, struct cfdata *,
74 1.1 hikaru void *);
75 1.1 hikaru static void octeon_twsi_attach(device_t, device_t,
76 1.1 hikaru void *);
77 1.1 hikaru
78 1.1 hikaru /* High-Level Controller Master */
79 1.1 hikaru
80 1.1 hikaru #ifdef notyet
81 1.1 hikaru static uint8_t octeon_twsi_hlcm_read_1(struct octeon_twsi_softc *,
82 1.1 hikaru ...)
83 1.1 hikaru static uint64_t octeon_twsi_hlcm_read_4(struct octeon_twsi_softc *,
84 1.1 hikaru ...)
85 1.1 hikaru static void octeon_twsi_hlcm_read(struct octeon_twsi_softc *,
86 1.1 hikaru ...)
87 1.1 hikaru static void octeon_twsi_hlcm_write_1(struct octeon_twsi_softc *,
88 1.1 hikaru ...)
89 1.1 hikaru static void octeon_twsi_hlcm_write_4(struct octeon_twsi_softc *,
90 1.1 hikaru ...)
91 1.1 hikaru static void octeon_twsi_hlcm_write(struct octeon_twsi_softc *,
92 1.1 hikaru ...)
93 1.1 hikaru #endif
94 1.1 hikaru
95 1.1 hikaru /* High-Level Controller Slave */
96 1.1 hikaru
97 1.1 hikaru /* XXX */
98 1.1 hikaru
99 1.1 hikaru /* Control Register */
100 1.1 hikaru
101 1.1 hikaru #ifdef notyet
102 1.1 hikaru #define _CONTROL_READ(sc, reg) \
103 1.1 hikaru octeon_twsi_control_read((sc), MIO_TWS_SW_TWSI_EOP_IA_##reg)
104 1.1 hikaru #define _CONTROL_WRITE(sc, reg, value) \
105 1.1 hikaru octeon_twsi_control_write((sc), MIO_TWS_SW_TWSI_EOP_IA_##reg, value)
106 1.1 hikaru static uint8_t octeon_twsi_control_read(struct octeon_twsi_softc *sc,
107 1.1 hikaru uint64_t);
108 1.1 hikaru static void octeon_twsi_control_write(struct octeon_twsi_softc *sc,
109 1.1 hikaru uint64_t, uint8_t);
110 1.1 hikaru #endif
111 1.1 hikaru
112 1.1 hikaru /* Register accessors */
113 1.1 hikaru
114 1.1 hikaru static inline uint64_t octeon_twsi_reg_rd(struct octeon_twsi_softc *, int);
115 1.1 hikaru static inline void octeon_twsi_reg_wr(struct octeon_twsi_softc *, int,
116 1.1 hikaru uint64_t);
117 1.1 hikaru #ifdef TWSIDEBUG
118 1.1 hikaru static inline void octeon_twsi_reg_dump(struct octeon_twsi_softc *, int);
119 1.1 hikaru #endif
120 1.1 hikaru
121 1.1 hikaru /* Test functions */
122 1.1 hikaru
123 1.1 hikaru #ifdef TWSIDEBUG
124 1.1 hikaru static void octeon_twsi_test(struct octeon_twsi_softc *);
125 1.1 hikaru #endif
126 1.1 hikaru
127 1.1 hikaru /* Debug functions */
128 1.1 hikaru
129 1.1 hikaru #ifdef TWSIDEBUG
130 1.1 hikaru static inline void octeon_twsi_debug_reg_dump(struct octeon_twsi_softc *,
131 1.1 hikaru int);
132 1.1 hikaru static void octeon_twsi_debug_dumpregs(struct octeon_twsi_softc *);
133 1.1 hikaru static void octeon_twsi_debug_dumpreg(struct octeon_twsi_softc *,
134 1.1 hikaru const struct octeon_twsi_reg *);
135 1.1 hikaru #endif
136 1.1 hikaru
137 1.1 hikaru /* -------------------------------------------------------------------------- */
138 1.1 hikaru
139 1.1 hikaru /*
140 1.1 hikaru * Auto-configuration
141 1.1 hikaru */
142 1.1 hikaru
143 1.1 hikaru CFATTACH_DECL_NEW(octeon_twsi, sizeof(struct octeon_twsi_softc),
144 1.1 hikaru octeon_twsi_match, octeon_twsi_attach, NULL, NULL);
145 1.1 hikaru
146 1.1 hikaru static int
147 1.1 hikaru octeon_twsi_match(device_t parent, struct cfdata *cf, void *aux)
148 1.1 hikaru {
149 1.1 hikaru struct iobus_attach_args *aa = aux;
150 1.1 hikaru
151 1.1 hikaru if (strcmp(cf->cf_name, aa->aa_name) != 0)
152 1.1 hikaru return 0;
153 1.1 hikaru return 1;
154 1.1 hikaru }
155 1.1 hikaru
156 1.1 hikaru static void
157 1.1 hikaru octeon_twsi_attach(device_t parent, device_t self, void *aux)
158 1.1 hikaru {
159 1.1 hikaru struct octeon_twsi_softc *sc = device_private(self);
160 1.1 hikaru struct iobus_attach_args *aa = aux;
161 1.1 hikaru int status;
162 1.1 hikaru
163 1.1 hikaru sc->sc_dev = self;
164 1.1 hikaru sc->sc_regt = aa->aa_bust;
165 1.1 hikaru
166 1.1 hikaru status = bus_space_map(sc->sc_regt, MIO_TWS_BASE_0, MIO_TWS_SIZE, 0,
167 1.1 hikaru &sc->sc_regh);
168 1.1 hikaru if (status != 0)
169 1.1 hikaru panic(": can't map register");
170 1.1 hikaru
171 1.1 hikaru aprint_normal("\n");
172 1.1 hikaru
173 1.1 hikaru #ifdef TWSITEST
174 1.1 hikaru octeon_twsi_test(sc);
175 1.1 hikaru #endif
176 1.1 hikaru }
177 1.1 hikaru
178 1.1 hikaru /* -------------------------------------------------------------------------- */
179 1.1 hikaru
180 1.1 hikaru /*
181 1.1 hikaru * Initialization, basic operations
182 1.1 hikaru */
183 1.1 hikaru
184 1.1 hikaru #ifdef notyet
185 1.1 hikaru
186 1.1 hikaru static void
187 1.1 hikaru octeon_twsi_wait(struct octeon_twsi_softc *sc)
188 1.1 hikaru {
189 1.1 hikaru }
190 1.1 hikaru
191 1.1 hikaru static void
192 1.1 hikaru octeon_twsi_intr(struct octeon_twsi_softc *sc)
193 1.1 hikaru {
194 1.1 hikaru }
195 1.1 hikaru
196 1.1 hikaru static void
197 1.1 hikaru octeon_twsi_lock(struct octeon_twsi_softc *sc)
198 1.1 hikaru {
199 1.1 hikaru }
200 1.1 hikaru
201 1.1 hikaru static void
202 1.1 hikaru octeon_twsi_unlock(struct octeon_twsi_softc *sc)
203 1.1 hikaru {
204 1.1 hikaru }
205 1.1 hikaru
206 1.1 hikaru #endif
207 1.1 hikaru
208 1.1 hikaru /* -------------------------------------------------------------------------- */
209 1.1 hikaru
210 1.1 hikaru /*
211 1.1 hikaru * High-Level Controller as a Master
212 1.1 hikaru */
213 1.1 hikaru
214 1.1 hikaru #ifdef notyet
215 1.1 hikaru
216 1.1 hikaru #define _BUFTOLE32(buf) \
217 1.1 hikaru ((buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | (buf[3] << 0))
218 1.1 hikaru #define _LE32TOBUF(buf, x) \
219 1.1 hikaru do { \
220 1.1 hikaru buf[0] = (char)((x) >> 24); \
221 1.1 hikaru buf[1] = (char)((x) >> 16); \
222 1.1 hikaru buf[2] = (char)((x) >> 8); \
223 1.1 hikaru buf[3] = (char)((x) >> 0); \
224 1.1 hikaru } while (0)
225 1.1 hikaru
226 1.1 hikaru static void
227 1.1 hikaru octeon_twsi_hlcm_read(struct octeon_twsi_softc *sc, int addr, char *buf,
228 1.1 hikaru size_t len)
229 1.1 hikaru {
230 1.1 hikaru uint64_t cmd;
231 1.1 hikaru size_t resid;
232 1.1 hikaru
233 1.1 hikaru octeon_twsi_lock(sc);
234 1.1 hikaru
235 1.1 hikaru #ifdef notyet
236 1.1 hikaru
237 1.1 hikaru octeon_twsi_hlcm_setup(sc);
238 1.1 hikaru
239 1.1 hikaru resid = len;
240 1.1 hikaru
241 1.1 hikaru while (resid > 4) {
242 1.2 simonb cmd =
243 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_FOUR, MIO_TWS_SW_TWSI_OP) |
244 1.2 simonb MIO_TWS_SW_TWSI_R |
245 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A);
246 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
247 1.1 hikaru octeon_twsi_wait(sc);
248 1.1 hikaru cmd = octeon_twsi_reg_rd(sc);
249 1.1 hikaru _LE32TOBUF(&buf[len - 1 - resid], (uint32_t)cmd);
250 1.1 hikaru resid -= 4;
251 1.1 hikaru }
252 1.1 hikaru
253 1.1 hikaru while (resid > 0) {
254 1.2 simonb cmd =
255 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_ONE, MIO_TWS_SW_TWSI_OP) |
256 1.2 simonb MIO_TWS_SW_TWSI_R |
257 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A);
258 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
259 1.1 hikaru octeon_twsi_wait(sc);
260 1.1 hikaru cmd = octeon_twsi_reg_rd(sc);
261 1.1 hikaru buf[len - 1 - resid] = (uint8_t)cmd;
262 1.1 hikaru resid--;
263 1.1 hikaru }
264 1.1 hikaru
265 1.1 hikaru #endif
266 1.1 hikaru
267 1.1 hikaru octeon_twsi_unlock(sc);
268 1.1 hikaru }
269 1.1 hikaru
270 1.1 hikaru static void
271 1.1 hikaru octeon_twsi_hlcm_write(struct octeon_twsi_softc *sc, int addr, char *buf,
272 1.1 hikaru size_t len)
273 1.1 hikaru {
274 1.1 hikaru uint64_t cmd;
275 1.1 hikaru size_t resid;
276 1.1 hikaru
277 1.1 hikaru octeon_twsi_lock(sc);
278 1.1 hikaru
279 1.1 hikaru #ifdef notyet
280 1.1 hikaru
281 1.1 hikaru octeon_twsi_hlcm_setup(sc);
282 1.1 hikaru
283 1.1 hikaru resid = len;
284 1.1 hikaru
285 1.1 hikaru while (resid > 4) {
286 1.2 simonb cmd =
287 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_FOUR, MIO_TWS_SW_TWSI_OP) |
288 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
289 1.2 simonb __SHIFTIN(_BUFTOLE32(&buf[len - 1 - resid]), MIO_TWS_SW_TWSI_D);
290 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
291 1.1 hikaru octeon_twsi_wait(sc);
292 1.1 hikaru resid -= 4;
293 1.1 hikaru }
294 1.1 hikaru
295 1.1 hikaru while (resid > 0) {
296 1.2 simonb cmd =
297 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_ONE, MIO_TWS_SW_TWSI_OP) |
298 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
299 1.2 simonb __SHIFTIN(buf[len - 1 - resid], MIO_TWS_SW_TWSI_D);
300 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
301 1.1 hikaru octeon_twsi_wait(sc);
302 1.1 hikaru resid--;
303 1.1 hikaru }
304 1.1 hikaru
305 1.1 hikaru /* MIO_TWS_SW_TWSI:V must be zero */
306 1.1 hikaru
307 1.1 hikaru /* check error */
308 1.1 hikaru if (MIO_TWS_SW_TWSI:R == 0) {
309 1.1 hikaru code = MIO_TWS_SW_TWSI:D;
310 1.1 hikaru }
311 1.1 hikaru #endif
312 1.1 hikaru
313 1.1 hikaru octeon_twsi_unlock(sc);
314 1.1 hikaru }
315 1.1 hikaru
316 1.1 hikaru static void
317 1.1 hikaru octeon_twsi_hlcm_setup(struct octeon_twsi_softc *sc, ...)
318 1.1 hikaru {
319 1.1 hikaru /* XXX */
320 1.1 hikaru
321 1.1 hikaru _CONTROL_WR(sc, TWSI_CTL, TWSI_CTL_CE | TWSI_CTL_ENAB | TWSI_AAK);
322 1.1 hikaru }
323 1.1 hikaru
324 1.1 hikaru static uint8_t
325 1.1 hikaru octeon_twsi_hlcm_read_1(struct octeon_twsi_softc *sc, ...)
326 1.1 hikaru {
327 1.1 hikaru /* XXX */
328 1.1 hikaru return 0;
329 1.1 hikaru }
330 1.1 hikaru
331 1.1 hikaru static uint64_t
332 1.1 hikaru octeon_twsi_hlcm_read_4(struct octeon_twsi_softc *sc, ...)
333 1.1 hikaru {
334 1.1 hikaru /* XXX */
335 1.1 hikaru return 0;
336 1.1 hikaru }
337 1.1 hikaru
338 1.1 hikaru static void
339 1.1 hikaru octeon_twsi_hlcm_write_1(struct octeon_twsi_softc *sc, ...)
340 1.1 hikaru {
341 1.1 hikaru /* XXX */
342 1.1 hikaru }
343 1.1 hikaru
344 1.1 hikaru static void
345 1.1 hikaru octeon_twsi_hlcm_write_4(struct octeon_twsi_softc *sc, ...)
346 1.1 hikaru {
347 1.1 hikaru /* XXX */
348 1.1 hikaru }
349 1.1 hikaru
350 1.1 hikaru #endif
351 1.1 hikaru
352 1.1 hikaru /* -------------------------------------------------------------------------- */
353 1.1 hikaru
354 1.1 hikaru /*
355 1.1 hikaru * High-Level Controller as a Slave
356 1.1 hikaru */
357 1.1 hikaru
358 1.1 hikaru #ifdef notyet
359 1.1 hikaru
360 1.1 hikaru static void
361 1.1 hikaru octeon_twsi_hlcs_setup(struct octeon_twsi_softc *sc, ...)
362 1.1 hikaru {
363 1.1 hikaru /* XXX */
364 1.1 hikaru }
365 1.1 hikaru
366 1.1 hikaru #endif
367 1.1 hikaru
368 1.1 hikaru /* -------------------------------------------------------------------------- */
369 1.1 hikaru
370 1.1 hikaru /*
371 1.1 hikaru * TWSI Control Register operations
372 1.1 hikaru */
373 1.1 hikaru
374 1.1 hikaru #ifdef notyet
375 1.1 hikaru
376 1.1 hikaru static uint8_t
377 1.1 hikaru octeon_twsi_control_read(struct octeon_twsi_softc *sc, uint64_t eop_ia)
378 1.1 hikaru {
379 1.1 hikaru uint64_t cmd;
380 1.1 hikaru
381 1.2 simonb cmd =
382 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_EXTEND, MIO_TWS_SW_TWSI_OP) |
383 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
384 1.2 simonb __SHIFTIN(eop_ia, MIO_TWS_SW_TWSI_EOP_IA);
385 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
386 1.1 hikaru octeon_twsi_wait(sc);
387 1.1 hikaru return (uint8_t)octeon_twsi_reg_rd(sc, MIO_TWS_SW_TWSI_OFFSET);
388 1.1 hikaru }
389 1.1 hikaru
390 1.1 hikaru static void
391 1.1 hikaru octeon_twsi_control_write(struct octeon_twsi_softc *sc, uint64_t eop_ia,
392 1.1 hikaru char *buf, size_t len)
393 1.1 hikaru {
394 1.1 hikaru uint64_t cmd;
395 1.1 hikaru
396 1.2 simonb cmd =
397 1.2 simonb __SHIFTIN(MIO_TWS_SW_TWSI_OP_EXTEND, MIO_TWS_SW_TWSI_OP) |
398 1.2 simonb __SHIFTIN(addr, MIO_TWS_SW_TWSI_A_SHIFT) |
399 1.2 simonb __SHIFTIN(eop_ia, MIO_TWS_SW_TWSI_EOP_IA) |
400 1.2 simonb __SHIFTIN(_BUFTOLE32(&buf[len - 1 - resid]), MIO_TWS_SW_TWSI_D);
401 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
402 1.1 hikaru octeon_twsi_wait(sc);
403 1.1 hikaru }
404 1.1 hikaru
405 1.1 hikaru #endif
406 1.1 hikaru
407 1.1 hikaru /* -------------------------------------------------------------------------- */
408 1.1 hikaru
409 1.1 hikaru /*
410 1.1 hikaru * Send / receive operations
411 1.1 hikaru */
412 1.1 hikaru
413 1.1 hikaru /* Send (== software to TWSI) */
414 1.1 hikaru
415 1.1 hikaru #ifdef notyet
416 1.1 hikaru
417 1.1 hikaru static void
418 1.1 hikaru octeon_twsi_send(struct octeon_twsi_softc *sc, ...)
419 1.1 hikaru {
420 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
421 1.1 hikaru }
422 1.1 hikaru
423 1.1 hikaru /* Receive (== TWSI to software) */
424 1.1 hikaru
425 1.1 hikaru static void
426 1.1 hikaru octeon_twsi_recv(struct octeon_twsi_softc *sc, ...)
427 1.1 hikaru {
428 1.1 hikaru /* XXX */
429 1.1 hikaru octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
430 1.1 hikaru octeon_twsi_wait(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
431 1.1 hikaru octeon_twsi_reg_rd(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
432 1.1 hikaru }
433 1.1 hikaru
434 1.1 hikaru #endif
435 1.1 hikaru
436 1.1 hikaru /* -------------------------------------------------------------------------- */
437 1.1 hikaru
438 1.1 hikaru /*
439 1.1 hikaru * Register accessors
440 1.1 hikaru */
441 1.1 hikaru
442 1.1 hikaru static inline uint64_t
443 1.1 hikaru octeon_twsi_reg_rd(struct octeon_twsi_softc *sc, int offset)
444 1.1 hikaru {
445 1.1 hikaru return bus_space_read_8(sc->sc_regt, sc->sc_regh, offset);
446 1.1 hikaru }
447 1.1 hikaru
448 1.1 hikaru static inline void
449 1.1 hikaru octeon_twsi_reg_wr(struct octeon_twsi_softc *sc, int offset, uint64_t value)
450 1.1 hikaru {
451 1.1 hikaru bus_space_write_8(sc->sc_regt, sc->sc_regh, offset, value);
452 1.1 hikaru }
453 1.1 hikaru
454 1.1 hikaru #ifdef TWSIDEBUG
455 1.1 hikaru
456 1.1 hikaru void
457 1.1 hikaru octeon_twsi_reg_dump(struct octeon_twsi_softc *sc, int offset)
458 1.1 hikaru {
459 1.1 hikaru octeon_twsi_debug_reg_dump(sc, offset);
460 1.1 hikaru }
461 1.1 hikaru
462 1.1 hikaru #endif
463 1.1 hikaru
464 1.1 hikaru /* -------------------------------------------------------------------------- */
465 1.1 hikaru
466 1.1 hikaru /*
467 1.1 hikaru * Test functions
468 1.1 hikaru */
469 1.1 hikaru
470 1.1 hikaru #ifdef TWSITEST
471 1.1 hikaru
472 1.1 hikaru void
473 1.1 hikaru octeon_twsi_test(struct octeon_twsi_softc *sc)
474 1.1 hikaru {
475 1.1 hikaru octeon_twsi_debug_dumpregs(sc);
476 1.1 hikaru }
477 1.1 hikaru
478 1.1 hikaru #endif
479 1.1 hikaru
480 1.1 hikaru /* -------------------------------------------------------------------------- */
481 1.1 hikaru
482 1.1 hikaru #ifdef TWSIDEBUG
483 1.1 hikaru
484 1.1 hikaru /*
485 1.1 hikaru * Debug functions
486 1.1 hikaru *
487 1.1 hikaru * octeon_twsi_debug_reg_dump
488 1.1 hikaru * octeon_twsi_debug_dumpregs
489 1.1 hikaru * octeon_twsi_debug_dumpreg
490 1.1 hikaru */
491 1.1 hikaru
492 1.1 hikaru struct octeon_twsi_reg {
493 1.1 hikaru const char *name;
494 1.1 hikaru int offset;
495 1.1 hikaru const char *format;
496 1.1 hikaru };
497 1.1 hikaru
498 1.1 hikaru static const struct octeon_twsi_reg octeon_twsi_regs[] = {
499 1.1 hikaru #define _ENTRY(x) { #x, x##_OFFSET, x##_BITS }
500 1.1 hikaru _ENTRY(MIO_TWS_SW_TWSI),
501 1.1 hikaru _ENTRY(MIO_TWS_TWSI_SW),
502 1.1 hikaru _ENTRY(MIO_TWS_INT),
503 1.1 hikaru _ENTRY(MIO_TWS_SW_TWSI_EXT)
504 1.1 hikaru #undef _ENTRY
505 1.1 hikaru };
506 1.1 hikaru
507 1.1 hikaru void
508 1.1 hikaru octeon_twsi_debug_reg_dump(struct octeon_twsi_softc *sc, int offset)
509 1.1 hikaru {
510 1.1 hikaru int i;
511 1.1 hikaru const struct octeon_twsi_reg *reg;
512 1.1 hikaru
513 1.1 hikaru reg = NULL;
514 1.1 hikaru for (i = 0; i < (int)__arraycount(octeon_twsi_regs); i++)
515 1.1 hikaru if (octeon_twsi_regs[i].offset == offset) {
516 1.1 hikaru reg = &octeon_twsi_regs[i];
517 1.1 hikaru break;
518 1.1 hikaru }
519 1.1 hikaru KASSERT(reg != NULL);
520 1.1 hikaru
521 1.1 hikaru octeon_twsi_debug_dumpreg(sc, reg);
522 1.1 hikaru }
523 1.1 hikaru
524 1.1 hikaru void
525 1.1 hikaru octeon_twsi_debug_dumpregs(struct octeon_twsi_softc *sc)
526 1.1 hikaru {
527 1.1 hikaru int i;
528 1.1 hikaru
529 1.1 hikaru for (i = 0; i < (int)__arraycount(octeon_twsi_regs); i++)
530 1.1 hikaru octeon_twsi_debug_dumpreg(sc, &octeon_twsi_regs[i]);
531 1.1 hikaru }
532 1.1 hikaru
533 1.1 hikaru void
534 1.1 hikaru octeon_twsi_debug_dumpreg(struct octeon_twsi_softc *sc,
535 1.1 hikaru const struct octeon_twsi_reg *reg)
536 1.1 hikaru {
537 1.1 hikaru uint64_t value;
538 1.1 hikaru char buf[256];
539 1.1 hikaru
540 1.1 hikaru value = octeon_twsi_reg_rd(sc, reg->offset);
541 1.1 hikaru snprintb(buf, sizeof(buf), reg->format, value);
542 1.1 hikaru printf("\t%-24s: %s\n", reg->name, buf);
543 1.1 hikaru }
544 1.1 hikaru
545 1.1 hikaru #endif
546