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