tegra210_car.c revision 1.23
1 /* $NetBSD: tegra210_car.c,v 1.23 2018/12/14 12:29:22 skrll Exp $ */ 2 3 /*- 4 * Copyright (c) 2015-2017 Jared McNeill <jmcneill (at) invisible.ca> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: tegra210_car.c,v 1.23 2018/12/14 12:29:22 skrll Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/bus.h> 34 #include <sys/device.h> 35 #include <sys/intr.h> 36 #include <sys/systm.h> 37 #include <sys/kernel.h> 38 #include <sys/rndpool.h> 39 #include <sys/rndsource.h> 40 #include <sys/atomic.h> 41 #include <sys/kmem.h> 42 43 #include <dev/clk/clk_backend.h> 44 45 #include <arm/nvidia/tegra_reg.h> 46 #include <arm/nvidia/tegra210_carreg.h> 47 #include <arm/nvidia/tegra_clock.h> 48 #include <arm/nvidia/tegra_pmcreg.h> 49 #include <arm/nvidia/tegra_var.h> 50 51 #include <dev/fdt/fdtvar.h> 52 53 static int tegra210_car_match(device_t, cfdata_t, void *); 54 static void tegra210_car_attach(device_t, device_t, void *); 55 56 static struct clk *tegra210_car_clock_decode(device_t, int, const void *, 57 size_t); 58 59 static const struct fdtbus_clock_controller_func tegra210_car_fdtclock_funcs = { 60 .decode = tegra210_car_clock_decode 61 }; 62 63 /* DT clock ID to clock name mappings */ 64 static struct tegra210_car_clock_id { 65 const char *name; 66 u_int id; 67 } tegra210_car_clock_ids[] = { 68 { "ISPB", 3 }, 69 { "RTC", 4 }, 70 { "TIMER", 5 }, 71 { "UARTA", 6 }, 72 { "GPIO", 8 }, 73 { "SDMMC2", 9 }, 74 { "I2S1", 11 }, 75 { "I2C1", 12 }, 76 { "SDMMC1", 14 }, 77 { "SDMMC4", 15 }, 78 { "PWM", 17 }, 79 { "I2S2", 18 }, 80 { "USBD", 22 }, 81 { "ISP", 23 }, 82 { "DISP2", 26 }, 83 { "DISP1", 27 }, 84 { "HOST1X", 28 }, 85 { "I2S0", 30 }, 86 { "MC", 32 }, 87 { "AHBDMA", 33 }, 88 { "APBDMA", 34 }, 89 { "PMC", 38 }, 90 { "KFUSE", 40 }, 91 { "SBC1", 41 }, 92 { "SBC2", 44 }, 93 { "SBC3", 46 }, 94 { "I2C5", 47 }, 95 { "DSIA", 48 }, 96 { "CSI", 52 }, 97 { "I2C2", 54 }, 98 { "UARTC", 55 }, 99 { "MIPI_CAL", 56 }, 100 { "EMC", 57 }, 101 { "USB2", 58 }, 102 { "BSEV", 63 }, 103 { "UARTD", 65 }, 104 { "I2C3", 67 }, 105 { "SBC4", 68 }, 106 { "SDMMC3", 69 }, 107 { "PCIE", 70 }, 108 { "OWR", 71 }, 109 { "AFI", 72 }, 110 { "CSITE", 73 }, 111 { "SOC_THERM", 78 }, 112 { "DTV", 79 }, 113 { "I2CSLOW", 81 }, 114 { "DSIB", 82 }, 115 { "TSEC", 83 }, 116 { "XUSB_HOST", 89 }, 117 { "CSUS", 92 }, 118 { "MSELECT", 99 }, 119 { "TSENSOR", 100 }, 120 { "I2S3", 101 }, 121 { "I2S4", 102 }, 122 { "I2C4", 103 }, 123 { "D_AUDIO", 106 }, 124 { "APB2APE", 107 }, 125 { "HDA2CODEC_2X", 111 }, 126 { "SPDIF_2X", 118 }, 127 { "ACTMON", 119 }, 128 { "EXTERN1", 120 }, 129 { "EXTERN2", 121 }, 130 { "EXTERN3", 122 }, 131 { "SATA_OOB", 123 }, 132 { "SATA", 124 }, 133 { "HDA", 125 }, 134 { "HDA2HDMI", 128 }, 135 { "XUSB_GATE", 143 }, 136 { "CILAB", 144 }, 137 { "CILCD", 145 }, 138 { "CILE", 146 }, 139 { "DSIALP", 147 }, 140 { "DSIBLP", 148 }, 141 { "ENTROPY", 149 }, 142 { "XUSB_SS", 156 }, 143 { "DMIC1", 161 }, 144 { "DMIC2", 162 }, 145 { "I2C6", 166 }, 146 { "VIM2_CLK", 171 }, 147 { "MIPIBIF", 173 }, 148 { "CLK72MHZ", 177 }, 149 { "VIC03", 178 }, 150 { "DPAUX", 181 }, 151 { "SOR0", 182 }, 152 { "SOR1", 183 }, 153 { "GPU", 184 }, 154 { "DBGAPB", 185 }, 155 { "PLL_P_OUT_ADSP", 187 }, 156 { "PLL_G_REF", 189 }, 157 { "SDMMC_LEGACY", 193 }, 158 { "NVDEC", 194 }, 159 { "NVJPG", 195 }, 160 { "DMIC3", 197 }, 161 { "APE", 198 }, 162 { "MAUD", 202 }, 163 { "TSECB", 206 }, 164 { "DPAUX1", 207 }, 165 { "VI_I2C", 208 }, 166 { "HSIC_TRK", 209 }, 167 { "USB2_TRK", 210 }, 168 { "QSPI", 211 }, 169 { "UARTAPE", 212 }, 170 { "NVENC", 219 }, 171 { "SOR_SAFE", 222 }, 172 { "PLL_P_OUT_CPU", 223 }, 173 { "UARTB", 224 }, 174 { "VFIR", 225 }, 175 { "SPDIF_IN", 226 }, 176 { "SPDIF_OUT", 227 }, 177 { "VI", 228 }, 178 { "VI_SENSOR", 229 }, 179 { "FUSE", 230 }, 180 { "FUSE_BURN", 231 }, 181 { "CLK_32K", 232 }, 182 { "CLK_M", 233 }, 183 { "CLK_M_DIV2", 234 }, 184 { "CLK_M_DIV4", 235 }, 185 { "PLL_REF", 236 }, 186 { "PLL_C", 237 }, 187 { "PLL_C_OUT1", 238 }, 188 { "PLL_C2", 239 }, 189 { "PLL_C3", 240 }, 190 { "PLL_M", 241 }, 191 { "PLL_M_OUT1", 242 }, 192 { "PLL_P", 243 }, 193 { "PLL_P_OUT1", 244 }, 194 { "PLL_P_OUT2", 245 }, 195 { "PLL_P_OUT3", 246 }, 196 { "PLL_P_OUT4", 247 }, 197 { "PLL_A", 248 }, 198 { "PLL_A_OUT0", 249 }, 199 { "PLL_D", 250 }, 200 { "PLL_D_OUT0", 251 }, 201 { "PLL_D2", 252 }, 202 { "PLL_D2_OUT0", 253 }, 203 { "PLL_U", 254 }, 204 { "PLL_U_480M", 255 }, 205 { "PLL_U_60M", 256 }, 206 { "PLL_U_48M", 257 }, 207 { "PLL_X", 259 }, 208 { "PLL_X_OUT0", 260 }, 209 { "PLL_RE_VCO", 261 }, 210 { "PLL_RE_OUT", 262 }, 211 { "PLL_E", 263 }, 212 { "SPDIF_IN_SYNC", 264 }, 213 { "I2S0_SYNC", 265 }, 214 { "I2S1_SYNC", 266 }, 215 { "I2S2_SYNC", 267 }, 216 { "I2S3_SYNC", 268 }, 217 { "I2S4_SYNC", 269 }, 218 { "VIMCLK_SYNC", 270 }, 219 { "AUDIO0", 271 }, 220 { "AUDIO1", 272 }, 221 { "AUDIO2", 273 }, 222 { "AUDIO3", 274 }, 223 { "AUDIO4", 275 }, 224 { "SPDIF", 276 }, 225 { "CLK_OUT_1", 277 }, 226 { "CLK_OUT_2", 278 }, 227 { "CLK_OUT_3", 279 }, 228 { "BLINK", 280 }, 229 { "SOR1_SRC", 282 }, 230 { "XUSB_HOST_SRC", 284 }, 231 { "XUSB_FALCON_SRC", 285 }, 232 { "XUSB_FS_SRC", 286 }, 233 { "XUSB_SS_SRC", 287 }, 234 { "XUSB_DEV_SRC", 288 }, 235 { "XUSB_DEV", 289 }, 236 { "XUSB_HS_SRC", 290 }, 237 { "SCLK", 291 }, 238 { "HCLK", 292 }, 239 { "PCLK", 293 }, 240 { "CCLK_G", 294 }, 241 { "CCLK_LP", 295 }, 242 { "DFLL_REF", 296 }, 243 { "DFLL_SOC", 297 }, 244 { "VI_SENSOR2", 298 }, 245 { "PLL_P_OUT5", 299 }, 246 { "CML0", 300 }, 247 { "CML1", 301 }, 248 { "PLL_C4", 302 }, 249 { "PLL_DP", 303 }, 250 { "PLL_E_MUX", 304 }, 251 { "PLL_MB", 305 }, 252 { "PLL_A1", 306 }, 253 { "PLL_D_DSI_OUT", 307 }, 254 { "PLL_C4_OUT0", 308 }, 255 { "PLL_C4_OUT1", 309 }, 256 { "PLL_C4_OUT2", 310 }, 257 { "PLL_C4_OUT3", 311 }, 258 { "PLL_U_OUT", 312 }, 259 { "PLL_U_OUT1", 313 }, 260 { "PLL_U_OUT2", 314 }, 261 { "USB2_HSIC_TRK", 315 }, 262 { "PLL_P_OUT_HSIO", 316 }, 263 { "PLL_P_OUT_XUSB", 317 }, 264 { "XUSB_SSP_SRC", 318 }, 265 { "PLL_RE_OUT1", 319 }, 266 { "AUDIO0_MUX", 350 }, 267 { "AUDIO1_MUX", 351 }, 268 { "AUDIO2_MUX", 352 }, 269 { "AUDIO3_MUX", 353 }, 270 { "AUDIO4_MUX", 354 }, 271 { "SPDIF_MUX", 355 }, 272 { "CLK_OUT_1_MUX", 356 }, 273 { "CLK_OUT_2_MUX", 357 }, 274 { "CLK_OUT_3_MUX", 358 }, 275 { "DSIA_MUX", 359 }, 276 { "DSIB_MUX", 360 }, 277 { "SOR0_LVDS", 361 }, 278 { "XUSB_SS_DIV2", 362 }, 279 { "PLL_M_UD", 363 }, 280 { "PLL_C_UD", 364 }, 281 { "SCLK_MUX", 365 }, 282 }; 283 284 static struct clk *tegra210_car_clock_get(void *, const char *); 285 static void tegra210_car_clock_put(void *, struct clk *); 286 static u_int tegra210_car_clock_get_rate(void *, struct clk *); 287 static int tegra210_car_clock_set_rate(void *, struct clk *, u_int); 288 static int tegra210_car_clock_enable(void *, struct clk *); 289 static int tegra210_car_clock_disable(void *, struct clk *); 290 static int tegra210_car_clock_set_parent(void *, struct clk *, 291 struct clk *); 292 static struct clk *tegra210_car_clock_get_parent(void *, struct clk *); 293 294 static const struct clk_funcs tegra210_car_clock_funcs = { 295 .get = tegra210_car_clock_get, 296 .put = tegra210_car_clock_put, 297 .get_rate = tegra210_car_clock_get_rate, 298 .set_rate = tegra210_car_clock_set_rate, 299 .enable = tegra210_car_clock_enable, 300 .disable = tegra210_car_clock_disable, 301 .set_parent = tegra210_car_clock_set_parent, 302 .get_parent = tegra210_car_clock_get_parent, 303 }; 304 305 #define CLK_FIXED(_name, _rate) { \ 306 .base = { .name = (_name) }, .type = TEGRA_CLK_FIXED, \ 307 .u = { .fixed = { .rate = (_rate) } } \ 308 } 309 310 #define CLK_PLL(_name, _parent, _base, _divm, _divn, _divp) { \ 311 .base = { .name = (_name) }, .type = TEGRA_CLK_PLL, \ 312 .parent = (_parent), \ 313 .u = { \ 314 .pll = { \ 315 .base_reg = (_base), \ 316 .divm_mask = (_divm), \ 317 .divn_mask = (_divn), \ 318 .divp_mask = (_divp), \ 319 } \ 320 } \ 321 } 322 323 #define CLK_MUX(_name, _reg, _bits, _p) { \ 324 .base = { .name = (_name) }, .type = TEGRA_CLK_MUX, \ 325 .u = { \ 326 .mux = { \ 327 .nparents = __arraycount(_p), \ 328 .parents = (_p), \ 329 .reg = (_reg), \ 330 .bits = (_bits) \ 331 } \ 332 } \ 333 } 334 335 #define CLK_FIXED_DIV(_name, _parent, _div) { \ 336 .base = { .name = (_name) }, .type = TEGRA_CLK_FIXED_DIV, \ 337 .parent = (_parent), \ 338 .u = { \ 339 .fixed_div = { \ 340 .div = (_div) \ 341 } \ 342 } \ 343 } 344 345 #define CLK_DIV(_name, _parent, _reg, _bits) { \ 346 .base = { .name = (_name) }, .type = TEGRA_CLK_DIV, \ 347 .parent = (_parent), \ 348 .u = { \ 349 .div = { \ 350 .reg = (_reg), \ 351 .bits = (_bits) \ 352 } \ 353 } \ 354 } 355 356 #define CLK_GATE(_name, _parent, _set, _clr, _bits) { \ 357 .base = { .name = (_name), .flags = CLK_SET_RATE_PARENT }, \ 358 .type = TEGRA_CLK_GATE, \ 359 .parent = (_parent), \ 360 .u = { \ 361 .gate = { \ 362 .set_reg = (_set), \ 363 .clr_reg = (_clr), \ 364 .bits = (_bits), \ 365 } \ 366 } \ 367 } 368 369 #define CLK_GATE_L(_name, _parent, _bits) \ 370 CLK_GATE(_name, _parent, \ 371 CAR_CLK_ENB_L_SET_REG, CAR_CLK_ENB_L_CLR_REG, \ 372 _bits) 373 374 #define CLK_GATE_H(_name, _parent, _bits) \ 375 CLK_GATE(_name, _parent, \ 376 CAR_CLK_ENB_H_SET_REG, CAR_CLK_ENB_H_CLR_REG, \ 377 _bits) 378 379 #define CLK_GATE_U(_name, _parent, _bits) \ 380 CLK_GATE(_name, _parent, \ 381 CAR_CLK_ENB_U_SET_REG, CAR_CLK_ENB_U_CLR_REG, \ 382 _bits) 383 384 #define CLK_GATE_V(_name, _parent, _bits) \ 385 CLK_GATE(_name, _parent, \ 386 CAR_CLK_ENB_V_SET_REG, CAR_CLK_ENB_V_CLR_REG, \ 387 _bits) 388 389 #define CLK_GATE_W(_name, _parent, _bits) \ 390 CLK_GATE(_name, _parent, \ 391 CAR_CLK_ENB_W_SET_REG, CAR_CLK_ENB_W_CLR_REG, \ 392 _bits) 393 394 #define CLK_GATE_X(_name, _parent, _bits) \ 395 CLK_GATE(_name, _parent, \ 396 CAR_CLK_ENB_X_SET_REG, CAR_CLK_ENB_X_CLR_REG, \ 397 _bits) 398 399 #define CLK_GATE_Y(_name, _parent, _bits) \ 400 CLK_GATE(_name, _parent, \ 401 CAR_CLK_ENB_Y_SET_REG, CAR_CLK_ENB_Y_CLR_REG, \ 402 _bits) 403 404 405 #define CLK_GATE_SIMPLE(_name, _parent, _reg, _bits) \ 406 CLK_GATE(_name, _parent, _reg, _reg, _bits) 407 408 static const char *mux_uart_p[] = 409 { "PLL_P", "PLL_C2", "PLL_C", "PLL_C4_OUT0", 410 NULL, "PLL_C4_OUT1", "CLK_M", "PLL_C4_OUT2" }; 411 412 static const char *mux_sdmmc1_p[] = 413 { "PLL_P", "PLL_A", "PLL_C", "PLL_C4_OUT0", 414 "PLL_M", "PLL_E", "CLK_M", "PLL_C4_OUT0" }; 415 416 static const char *mux_sdmmc2_4_p[] = 417 { "PLL_P", "PLL_C4_OUT2"/*LJ*/, "PLL_C4_OUT0"/*LJ*/, "PLL_C4_OUT2", 418 "PLL_M", "PLL_E", "CLK_M", "PLL_C4_OUT0" }; 419 420 static const char *mux_sdmmc3_p[] = 421 { "PLL_P", "PLL_A", "PLL_C", "PLL_C4_OUT2", 422 "PLL_C4_OUT1", "PLL_E", "CLK_M", "PLL_C4_OUT0" }; 423 424 static const char *mux_i2c_p[] = 425 { "PLL_P", "PLL_C2_OUT0", "PLL_C", "PLL_C4_OUT0", 426 NULL, "PLL_C4_OUT1", "CLK_M", "PLL_C4_OUT2" }; 427 428 static const char *mux_xusb_host_p[] = 429 { "CLK_M", "PLL_P", NULL, NULL, 430 NULL, "PLL_REF", NULL, NULL }; 431 432 static const char *mux_xusb_fs_p[] = 433 { "CLK_M", NULL, "PLL_U_48M", NULL, 434 "PLL_P", NULL, "PLL_U_480M", NULL }; 435 436 static const char *mux_xusb_ss_p[] = 437 { "CLK_M", "PLL_REF", "CLK_32K", "PLL_U_480M", 438 NULL, NULL, NULL, NULL }; 439 440 static const char *mux_mselect_p[] = 441 { "PLL_P", "PLL_C2", "PLL_C", "PLL_C4_OUT2", 442 "PLL_C4_OUT1", "CLK_S", "CLK_M", "PLL_C4_OUT0" }; 443 444 static const char *mux_tsensor_p[] = 445 { "PLL_P", "PLL_C2", "PLL_C", "PLL_C4_OUT0", 446 "CLK_M", "PLL_C4_OUT1", "CLK_S", "PLL_C4_OUT2" }; 447 448 static const char *mux_soc_therm_p[] = 449 { "CLK_M", "PLL_C", "PLL_P", "PLL_A", 450 "PLL_C2", "PLL_C4_OUT0", "PLL_C4_OUT1", "PLL_C4_OUT2" }; 451 452 static const char *mux_hda2codec_2x_p[] = 453 { "PLL_P", "PLL_C2", "PLL_C4_OUT0", "PLL_A", 454 "PLL_A", "PLL_C4_OUT1", "CLK_M", "PLL_C4_OUT2" }; 455 456 static const char *mux_hda_p[] = 457 { "PLL_P", "PLL_C2", "PLL_C", "PLL_C4_OUT0", 458 NULL, "PLL_C4_OUT1", "CLK_M", "PLL_C4_OUT2" }; 459 460 static const char *mux_sata_p[] = 461 { "PLL_P", NULL, "PLL_C", NULL, NULL, NULL, "CLK_M" }; 462 463 static struct tegra_clk tegra210_car_clocks[] = { 464 CLK_FIXED("CLK_M", TEGRA210_REF_FREQ), 465 466 CLK_PLL("PLL_P", "CLK_M", CAR_PLLP_BASE_REG, 467 CAR_PLLP_BASE_DIVM, CAR_PLLP_BASE_DIVN, CAR_PLLP_BASE_DIVP), 468 CLK_PLL("PLL_C", "CLK_M", CAR_PLLC_BASE_REG, 469 CAR_PLLC_BASE_DIVM, CAR_PLLC_BASE_DIVN, CAR_PLLC_BASE_DIVP), 470 CLK_PLL("PLL_U", "CLK_M", CAR_PLLU_BASE_REG, 471 CAR_PLLU_BASE_DIVM, CAR_PLLU_BASE_DIVN, CAR_PLLU_BASE_DIVP), 472 CLK_PLL("PLL_X", "CLK_M", CAR_PLLX_BASE_REG, 473 CAR_PLLX_BASE_DIVM, CAR_PLLX_BASE_DIVN, CAR_PLLX_BASE_DIVP), 474 CLK_PLL("PLL_E", "CLK_M", CAR_PLLE_BASE_REG, 475 CAR_PLLE_BASE_DIVM, CAR_PLLE_BASE_DIVN, CAR_PLLE_BASE_DIVP_CML), 476 CLK_PLL("PLL_D", "CLK_M", CAR_PLLD_BASE_REG, 477 CAR_PLLD_BASE_DIVM, CAR_PLLD_BASE_DIVN, CAR_PLLD_BASE_DIVP), 478 CLK_PLL("PLL_D2", "CLK_M", CAR_PLLD2_BASE_REG, 479 CAR_PLLD2_BASE_DIVM, CAR_PLLD2_BASE_DIVN, CAR_PLLD2_BASE_DIVP), 480 CLK_PLL("PLL_REF", "CLK_M", CAR_PLLREFE_BASE_REG, 481 CAR_PLLREFE_BASE_DIVM, CAR_PLLREFE_BASE_DIVN, CAR_PLLREFE_BASE_DIVP), 482 483 CLK_FIXED_DIV("PLL_U_480M", "PLL_U", 1), 484 CLK_FIXED_DIV("PLL_U_48M", "PLL_U", 10), 485 486 CLK_MUX("MUX_UARTA", CAR_CLKSRC_UARTA_REG, CAR_CLKSRC_UART_SRC, 487 mux_uart_p), 488 CLK_MUX("MUX_UARTB", CAR_CLKSRC_UARTB_REG, CAR_CLKSRC_UART_SRC, 489 mux_uart_p), 490 CLK_MUX("MUX_UARTC", CAR_CLKSRC_UARTC_REG, CAR_CLKSRC_UART_SRC, 491 mux_uart_p), 492 CLK_MUX("MUX_UARTD", CAR_CLKSRC_UARTD_REG, CAR_CLKSRC_UART_SRC, 493 mux_uart_p), 494 495 CLK_MUX("MUX_SDMMC1", CAR_CLKSRC_SDMMC1_REG, CAR_CLKSRC_SDMMC_SRC, 496 mux_sdmmc1_p), 497 CLK_MUX("MUX_SDMMC2", CAR_CLKSRC_SDMMC2_REG, CAR_CLKSRC_SDMMC_SRC, 498 mux_sdmmc2_4_p), 499 CLK_MUX("MUX_SDMMC3", CAR_CLKSRC_SDMMC3_REG, CAR_CLKSRC_SDMMC_SRC, 500 mux_sdmmc3_p), 501 CLK_MUX("MUX_SDMMC4", CAR_CLKSRC_SDMMC4_REG, CAR_CLKSRC_SDMMC_SRC, 502 mux_sdmmc2_4_p), 503 504 CLK_MUX("MUX_I2C1", CAR_CLKSRC_I2C1_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 505 CLK_MUX("MUX_I2C2", CAR_CLKSRC_I2C2_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 506 CLK_MUX("MUX_I2C3", CAR_CLKSRC_I2C3_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 507 CLK_MUX("MUX_I2C4", CAR_CLKSRC_I2C4_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 508 CLK_MUX("MUX_I2C5", CAR_CLKSRC_I2C5_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 509 CLK_MUX("MUX_I2C6", CAR_CLKSRC_I2C6_REG, CAR_CLKSRC_I2C_SRC, mux_i2c_p), 510 511 CLK_MUX("MUX_XUSB_HOST", 512 CAR_CLKSRC_XUSB_HOST_REG, CAR_CLKSRC_XUSB_HOST_SRC, 513 mux_xusb_host_p), 514 CLK_MUX("MUX_XUSB_FALCON", 515 CAR_CLKSRC_XUSB_FALCON_REG, CAR_CLKSRC_XUSB_FALCON_SRC, 516 mux_xusb_host_p), 517 CLK_MUX("MUX_XUSB_SS", 518 CAR_CLKSRC_XUSB_SS_REG, CAR_CLKSRC_XUSB_SS_SRC, 519 mux_xusb_ss_p), 520 CLK_MUX("MUX_XUSB_FS", 521 CAR_CLKSRC_XUSB_FS_REG, CAR_CLKSRC_XUSB_FS_SRC, 522 mux_xusb_fs_p), 523 524 CLK_MUX("MUX_MSELECT", 525 CAR_CLKSRC_MSELECT_REG, CAR_CLKSRC_MSELECT_SRC, 526 mux_mselect_p), 527 528 CLK_MUX("MUX_TSENSOR", 529 CAR_CLKSRC_TSENSOR_REG, CAR_CLKSRC_TSENSOR_SRC, 530 mux_tsensor_p), 531 CLK_MUX("MUX_SOC_THERM", 532 CAR_CLKSRC_SOC_THERM_REG, CAR_CLKSRC_SOC_THERM_SRC, 533 mux_soc_therm_p), 534 535 CLK_MUX("MUX_HDA2CODEC_2X", 536 CAR_CLKSRC_HDA2CODEC_2X_REG, CAR_CLKSRC_HDA2CODEC_2X_SRC, 537 mux_hda2codec_2x_p), 538 CLK_MUX("MUX_HDA", 539 CAR_CLKSRC_HDA_REG, CAR_CLKSRC_HDA_SRC, 540 mux_hda_p), 541 542 CLK_MUX("MUX_SATA_OOB", 543 CAR_CLKSRC_SATA_OOB_REG , CAR_CLKSRC_SATA_OOB_SRC, 544 mux_sata_p), 545 CLK_MUX("MUX_SATA", 546 CAR_CLKSRC_SATA_REG, CAR_CLKSRC_SATA_SRC, 547 mux_sata_p), 548 549 CLK_DIV("DIV_UARTA", "MUX_UARTA", 550 CAR_CLKSRC_UARTA_REG, CAR_CLKSRC_UART_DIV), 551 CLK_DIV("DIV_UARTB", "MUX_UARTB", 552 CAR_CLKSRC_UARTB_REG, CAR_CLKSRC_UART_DIV), 553 CLK_DIV("DIV_UARTC", "MUX_UARTC", 554 CAR_CLKSRC_UARTC_REG, CAR_CLKSRC_UART_DIV), 555 CLK_DIV("DIV_UARTD", "MUX_UARTD", 556 CAR_CLKSRC_UARTD_REG, CAR_CLKSRC_UART_DIV), 557 558 CLK_DIV("DIV_SDMMC1", "MUX_SDMMC1", 559 CAR_CLKSRC_SDMMC1_REG, CAR_CLKSRC_SDMMC_DIV), 560 CLK_DIV("DIV_SDMMC2", "MUX_SDMMC2", 561 CAR_CLKSRC_SDMMC2_REG, CAR_CLKSRC_SDMMC_DIV), 562 CLK_DIV("DIV_SDMMC3", "MUX_SDMMC3", 563 CAR_CLKSRC_SDMMC3_REG, CAR_CLKSRC_SDMMC_DIV), 564 CLK_DIV("DIV_SDMMC4", "MUX_SDMMC4", 565 CAR_CLKSRC_SDMMC4_REG, CAR_CLKSRC_SDMMC_DIV), 566 567 CLK_DIV("DIV_I2C1", "MUX_I2C1", 568 CAR_CLKSRC_I2C1_REG, CAR_CLKSRC_I2C_DIV), 569 CLK_DIV("DIV_I2C2", "MUX_I2C2", 570 CAR_CLKSRC_I2C2_REG, CAR_CLKSRC_I2C_DIV), 571 CLK_DIV("DIV_I2C3", "MUX_I2C3", 572 CAR_CLKSRC_I2C3_REG, CAR_CLKSRC_I2C_DIV), 573 CLK_DIV("DIV_I2C4", "MUX_I2C4", 574 CAR_CLKSRC_I2C4_REG, CAR_CLKSRC_I2C_DIV), 575 CLK_DIV("DIV_I2C5", "MUX_I2C5", 576 CAR_CLKSRC_I2C5_REG, CAR_CLKSRC_I2C_DIV), 577 CLK_DIV("DIV_I2C6", "MUX_I2C6", 578 CAR_CLKSRC_I2C6_REG, CAR_CLKSRC_I2C_DIV), 579 580 CLK_DIV("XUSB_HOST_SRC", "MUX_XUSB_HOST", 581 CAR_CLKSRC_XUSB_HOST_REG, CAR_CLKSRC_XUSB_HOST_DIV), 582 CLK_DIV("XUSB_SS_SRC", "MUX_XUSB_SS", 583 CAR_CLKSRC_XUSB_SS_REG, CAR_CLKSRC_XUSB_SS_DIV), 584 CLK_DIV("XUSB_FS_SRC", "MUX_XUSB_FS", 585 CAR_CLKSRC_XUSB_FS_REG, CAR_CLKSRC_XUSB_FS_DIV), 586 CLK_DIV("XUSB_FALCON_SRC", "MUX_XUSB_FALCON", 587 CAR_CLKSRC_XUSB_FALCON_REG, CAR_CLKSRC_XUSB_FALCON_DIV), 588 CLK_DIV("USB2_HSIC_TRK", "CLK_M", 589 CAR_CLKSRC_USB2_HSIC_TRK_REG, CAR_CLKSRC_USB2_HSIC_TRK_DIV), 590 CLK_DIV("DIV_PLL_U_OUT1", "PLL_U", 591 CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT1_RATIO), 592 CLK_DIV("DIV_PLL_U_OUT2", "PLL_U", 593 CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT2_RATIO), 594 595 CLK_DIV("DIV_MSELECT", "MUX_MSELECT", 596 CAR_CLKSRC_MSELECT_REG, CAR_CLKSRC_MSELECT_DIV), 597 598 CLK_DIV("DIV_TSENSOR", "MUX_TSENSOR", 599 CAR_CLKSRC_TSENSOR_REG, CAR_CLKSRC_TSENSOR_DIV), 600 CLK_DIV("DIV_SOC_THERM", "MUX_SOC_THERM", 601 CAR_CLKSRC_SOC_THERM_REG, CAR_CLKSRC_SOC_THERM_DIV), 602 603 CLK_DIV("DIV_HDA2CODEC_2X", "MUX_HDA2CODEC_2X", 604 CAR_CLKSRC_HDA2CODEC_2X_REG, CAR_CLKSRC_HDA2CODEC_2X_DIV), 605 CLK_DIV("DIV_HDA", "MUX_HDA", 606 CAR_CLKSRC_HDA_REG, CAR_CLKSRC_HDA_DIV), 607 608 CLK_DIV("DIV_SATA_OOB", "MUX_SATA_OOB", 609 CAR_CLKSRC_SATA_OOB_REG, CAR_CLKSRC_SATA_OOB_DIV), 610 CLK_DIV("DIV_SATA", "MUX_SATA", 611 CAR_CLKSRC_SATA_REG, CAR_CLKSRC_SATA_DIV), 612 613 CLK_GATE_SIMPLE("PLL_U_OUT1", "DIV_PLL_U_OUT1", 614 CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT1_CLKEN), 615 CLK_GATE_SIMPLE("PLL_U_OUT2", "DIV_PLL_U_OUT2", 616 CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT2_CLKEN), 617 618 CLK_GATE_SIMPLE("CML0", "PLL_E", 619 CAR_PLLE_AUX_REG, CAR_PLLE_AUX_CML0_OEN), 620 CLK_GATE_SIMPLE("CML1", "PLL_E", 621 CAR_PLLE_AUX_REG, CAR_PLLE_AUX_CML1_OEN), 622 623 CLK_GATE_L("UARTA", "DIV_UARTA", CAR_DEV_L_UARTA), 624 CLK_GATE_L("UARTB", "DIV_UARTB", CAR_DEV_L_UARTB), 625 CLK_GATE_H("UARTC", "DIV_UARTC", CAR_DEV_H_UARTC), 626 CLK_GATE_U("UARTD", "DIV_UARTD", CAR_DEV_U_UARTD), 627 CLK_GATE_L("SDMMC1", "DIV_SDMMC1", CAR_DEV_L_SDMMC1), 628 CLK_GATE_L("SDMMC2", "DIV_SDMMC2", CAR_DEV_L_SDMMC2), 629 CLK_GATE_U("SDMMC3", "DIV_SDMMC3", CAR_DEV_U_SDMMC3), 630 CLK_GATE_L("SDMMC4", "DIV_SDMMC4", CAR_DEV_L_SDMMC4), 631 CLK_GATE_L("I2C1", "DIV_I2C1", CAR_DEV_L_I2C1), 632 CLK_GATE_H("I2C2", "DIV_I2C2", CAR_DEV_H_I2C2), 633 CLK_GATE_U("I2C3", "DIV_I2C3", CAR_DEV_U_I2C3), 634 CLK_GATE_V("I2C4", "DIV_I2C4", CAR_DEV_V_I2C4), 635 CLK_GATE_H("I2C5", "DIV_I2C5", CAR_DEV_H_I2C5), 636 CLK_GATE_X("I2C6", "DIV_I2C6", CAR_DEV_X_I2C6), 637 CLK_GATE_W("XUSB_GATE", "CLK_M", CAR_DEV_W_XUSB), 638 CLK_GATE_U("XUSB_HOST", "XUSB_HOST_SRC", CAR_DEV_U_XUSB_HOST), 639 CLK_GATE_W("XUSB_SS", "XUSB_SS_SRC", CAR_DEV_W_XUSB_SS), 640 CLK_GATE_H("FUSE", "CLK_M", CAR_DEV_H_FUSE), 641 CLK_GATE_Y("USB2_TRK", "USB2_HSIC_TRK", CAR_DEV_Y_USB2_TRK), 642 CLK_GATE_Y("HSIC_TRK", "USB2_HSIC_TRK", CAR_DEV_Y_HSIC_TRK), 643 CLK_GATE_H("APBDMA", "CLK_M", CAR_DEV_H_APBDMA), 644 CLK_GATE_L("USBD", "PLL_U_480M", CAR_DEV_L_USBD), 645 CLK_GATE_H("USB2", "PLL_U_480M", CAR_DEV_H_USB2), 646 CLK_GATE_V("MSELECT", "DIV_MSELECT", CAR_DEV_V_MSELECT), 647 CLK_GATE_U("PCIE", "CLK_M", CAR_DEV_U_PCIE), 648 CLK_GATE_U("AFI", "MSELECT", CAR_DEV_U_AFI), 649 CLK_GATE_V("TSENSOR", "DIV_TSENSOR", CAR_DEV_V_TSENSOR), 650 CLK_GATE_U("SOC_THERM", "DIV_SOC_THERM", CAR_DEV_U_SOC_THERM), 651 CLK_GATE_W("HDA2HDMI", "CLK_M", CAR_DEV_W_HDA2HDMICODEC), 652 CLK_GATE_V("HDA2CODEC_2X", "DIV_HDA2CODEC_2X", CAR_DEV_V_HDA2CODEC_2X), 653 CLK_GATE_V("HDA", "DIV_HDA", CAR_DEV_V_HDA), 654 655 CLK_GATE_V("SATA_OOB", "DIV_SATA_OOB", CAR_DEV_V_SATA_OOB), 656 CLK_GATE_V("SATA", "DIV_SATA", CAR_DEV_V_SATA), 657 }; 658 659 struct tegra210_init_parent { 660 const char *clock; 661 const char *parent; 662 u_int rate; 663 u_int enable; 664 } tegra210_init_parents[] = { 665 { "SDMMC1", "PLL_P", 0, 0 }, 666 { "SDMMC2", "PLL_P", 0, 0 }, 667 { "SDMMC3", "PLL_P", 0, 0 }, 668 { "SDMMC4", "PLL_P", 0, 0 }, 669 { "SOC_THERM", "PLL_P", 0, 0 }, 670 { "TSENSOR", "CLK_M", 0, 0 }, 671 { "XUSB_GATE", NULL, 0, 1 }, 672 { "XUSB_HOST_SRC", "PLL_P", 102000000, 0 }, 673 { "XUSB_FALCON_SRC", "PLL_P", 204000000, 0 }, 674 { "XUSB_SS_SRC", "PLL_U_480M", 120000000, 0 }, 675 { "XUSB_FS_SRC", "PLL_U_48M", 48000000, 0 }, 676 { "PLL_U_OUT1", NULL, 48000000, 1 }, 677 { "PLL_U_OUT2", NULL, 60000000, 1 }, 678 { "CML0", NULL, 0, 1 }, 679 { "CML1", NULL, 0, 0 }, 680 { "AFI", NULL, 0, 1 }, 681 { "PCIE", NULL, 0, 1 }, 682 { "SATA", "PLL_P", 104000000, 0 }, 683 { "SATA_OOB", "PLL_P", 204000000, 0 }, 684 }; 685 686 struct tegra210_car_rst { 687 u_int set_reg; 688 u_int clr_reg; 689 u_int mask; 690 }; 691 692 static struct tegra210_car_reset_reg { 693 u_int set_reg; 694 u_int clr_reg; 695 } tegra210_car_reset_regs[] = { 696 { CAR_RST_DEV_L_SET_REG, CAR_RST_DEV_L_CLR_REG }, 697 { CAR_RST_DEV_H_SET_REG, CAR_RST_DEV_H_CLR_REG }, 698 { CAR_RST_DEV_U_SET_REG, CAR_RST_DEV_U_CLR_REG }, 699 { CAR_RST_DEV_V_SET_REG, CAR_RST_DEV_V_CLR_REG }, 700 { CAR_RST_DEV_W_SET_REG, CAR_RST_DEV_W_CLR_REG }, 701 { CAR_RST_DEV_X_SET_REG, CAR_RST_DEV_X_CLR_REG }, 702 { CAR_RST_DEV_Y_SET_REG, CAR_RST_DEV_Y_CLR_REG }, 703 }; 704 705 static void * tegra210_car_reset_acquire(device_t, const void *, size_t); 706 static void tegra210_car_reset_release(device_t, void *); 707 static int tegra210_car_reset_assert(device_t, void *); 708 static int tegra210_car_reset_deassert(device_t, void *); 709 710 static const struct fdtbus_reset_controller_func tegra210_car_fdtreset_funcs = { 711 .acquire = tegra210_car_reset_acquire, 712 .release = tegra210_car_reset_release, 713 .reset_assert = tegra210_car_reset_assert, 714 .reset_deassert = tegra210_car_reset_deassert, 715 }; 716 717 struct tegra210_car_softc { 718 device_t sc_dev; 719 bus_space_tag_t sc_bst; 720 bus_space_handle_t sc_bsh; 721 722 struct clk_domain sc_clkdom; 723 724 u_int sc_clock_cells; 725 u_int sc_reset_cells; 726 727 kmutex_t sc_rndlock; 728 krndsource_t sc_rndsource; 729 }; 730 731 static void tegra210_car_init(struct tegra210_car_softc *); 732 static void tegra210_car_utmip_init(struct tegra210_car_softc *); 733 static void tegra210_car_xusb_init(struct tegra210_car_softc *); 734 static void tegra210_car_watchdog_init(struct tegra210_car_softc *); 735 static void tegra210_car_parent_init(struct tegra210_car_softc *); 736 737 738 CFATTACH_DECL_NEW(tegra210_car, sizeof(struct tegra210_car_softc), 739 tegra210_car_match, tegra210_car_attach, NULL, NULL); 740 741 static int 742 tegra210_car_match(device_t parent, cfdata_t cf, void *aux) 743 { 744 const char * const compatible[] = { "nvidia,tegra210-car", NULL }; 745 struct fdt_attach_args * const faa = aux; 746 747 #if 0 748 return of_match_compatible(faa->faa_phandle, compatible); 749 #else 750 if (of_match_compatible(faa->faa_phandle, compatible) == 0) 751 return 0; 752 753 return 999; 754 #endif 755 } 756 757 static void 758 tegra210_car_attach(device_t parent, device_t self, void *aux) 759 { 760 struct tegra210_car_softc * const sc = device_private(self); 761 struct fdt_attach_args * const faa = aux; 762 const int phandle = faa->faa_phandle; 763 bus_addr_t addr; 764 bus_size_t size; 765 int error, n; 766 767 if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) { 768 aprint_error(": couldn't get registers\n"); 769 return; 770 } 771 772 sc->sc_dev = self; 773 sc->sc_bst = faa->faa_bst; 774 error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh); 775 if (error) { 776 aprint_error(": couldn't map %#" PRIx64 ": %d", 777 (uint64_t)addr, error); 778 return; 779 } 780 if (of_getprop_uint32(phandle, "#clock-cells", &sc->sc_clock_cells)) 781 sc->sc_clock_cells = 1; 782 if (of_getprop_uint32(phandle, "#reset-cells", &sc->sc_reset_cells)) 783 sc->sc_reset_cells = 1; 784 785 aprint_naive("\n"); 786 aprint_normal(": CAR\n"); 787 788 sc->sc_clkdom.name = device_xname(self); 789 sc->sc_clkdom.funcs = &tegra210_car_clock_funcs; 790 sc->sc_clkdom.priv = sc; 791 for (n = 0; n < __arraycount(tegra210_car_clocks); n++) { 792 tegra210_car_clocks[n].base.domain = &sc->sc_clkdom; 793 clk_attach(&tegra210_car_clocks[n].base); 794 } 795 796 fdtbus_register_clock_controller(self, phandle, 797 &tegra210_car_fdtclock_funcs); 798 fdtbus_register_reset_controller(self, phandle, 799 &tegra210_car_fdtreset_funcs); 800 801 tegra210_car_init(sc); 802 803 #ifdef TEGRA210_CAR_DEBUG 804 for (n = 0; n < __arraycount(tegra210_car_clocks); n++) { 805 struct clk *clk = TEGRA_CLK_BASE(&tegra210_car_clocks[n]); 806 struct clk *clk_parent = clk_get_parent(clk); 807 device_printf(self, "clk %s (parent %s): ", clk->name, 808 clk_parent ? clk_parent->name : "none"); 809 printf("%u Hz\n", clk_get_rate(clk)); 810 } 811 #endif 812 } 813 814 static void 815 tegra210_car_init(struct tegra210_car_softc *sc) 816 { 817 tegra210_car_parent_init(sc); 818 tegra210_car_utmip_init(sc); 819 tegra210_car_xusb_init(sc); 820 tegra210_car_watchdog_init(sc); 821 } 822 823 static void 824 tegra210_car_parent_init(struct tegra210_car_softc *sc) 825 { 826 struct clk *clk, *clk_parent; 827 int error; 828 u_int n; 829 830 for (n = 0; n < __arraycount(tegra210_init_parents); n++) { 831 clk = clk_get(&sc->sc_clkdom, tegra210_init_parents[n].clock); 832 KASSERTMSG(clk != NULL, "tegra210 clock %s not found", tegra210_init_parents[n].clock); 833 834 if (tegra210_init_parents[n].parent != NULL) { 835 clk_parent = clk_get(&sc->sc_clkdom, 836 tegra210_init_parents[n].parent); 837 KASSERT(clk_parent != NULL); 838 839 error = clk_set_parent(clk, clk_parent); 840 if (error) { 841 aprint_error_dev(sc->sc_dev, 842 "couldn't set '%s' parent to '%s': %d\n", 843 clk->name, clk_parent->name, error); 844 } 845 clk_put(clk_parent); 846 } 847 if (tegra210_init_parents[n].rate != 0) { 848 error = clk_set_rate(clk, tegra210_init_parents[n].rate); 849 if (error) { 850 aprint_error_dev(sc->sc_dev, 851 "couldn't set '%s' rate to %u Hz: %d\n", 852 clk->name, tegra210_init_parents[n].rate, 853 error); 854 } 855 } 856 if (tegra210_init_parents[n].enable) { 857 error = clk_enable(clk); 858 if (error) { 859 aprint_error_dev(sc->sc_dev, 860 "couldn't enable '%s': %d\n", clk->name, 861 error); 862 } 863 } 864 clk_put(clk); 865 } 866 } 867 868 static void 869 tegra210_car_utmip_init(struct tegra210_car_softc *sc) 870 { 871 bus_space_tag_t bst = sc->sc_bst; 872 bus_space_handle_t bsh = sc->sc_bsh; 873 874 /* 875 * Set up the UTMI PLL. 876 */ 877 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG3_REG, 878 0, CAR_UTMIP_PLL_CFG3_REF_SRC_SEL); 879 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG3_REG, 880 0, CAR_UTMIP_PLL_CFG3_REF_DIS); 881 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 882 0, CAR_UTMIPLL_HW_PWRDN_CFG0_IDDQ_OVERRIDE); 883 delay(10); 884 /* TODO UTMIP_PLL_CFG0 */ 885 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG2_REG, 886 CAR_UTMIP_PLL_CFG2_PHY_XTAL_CLOCKEN, 0); 887 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG2_REG, 888 0, CAR_UTMIP_PLL_CFG2_ACTIVE_DLY_COUNT); /* Don't care */ 889 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG2_REG, 890 0, CAR_UTMIP_PLL_CFG2_STABLE_COUNT); 891 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG1_REG, 892 0, CAR_UTMIP_PLL_CFG1_ENABLE_DLY_COUNT); 893 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG1_REG, 894 0x3, CAR_UTMIP_PLL_CFG1_XTAL_FREQ_COUNT); 895 896 bus_space_write_4(bst, bsh, CAR_CLK_ENB_U_SET_REG, CAR_DEV_U_AFI); 897 bus_space_write_4(bst, bsh, CAR_CLK_ENB_U_SET_REG, CAR_DEV_U_PCIE); 898 899 bus_space_write_4(bst, bsh, CAR_RST_DEV_L_CLR_REG, CAR_DEV_L_USBD); 900 bus_space_write_4(bst, bsh, CAR_RST_DEV_H_CLR_REG, CAR_DEV_H_USB2); 901 bus_space_write_4(bst, bsh, CAR_RST_DEV_W_CLR_REG, CAR_DEV_W_XUSB); 902 bus_space_write_4(bst, bsh, CAR_RST_DEV_U_CLR_REG, CAR_DEV_U_AFI); 903 bus_space_write_4(bst, bsh, CAR_RST_DEV_U_CLR_REG, CAR_DEV_U_PCIE); 904 bus_space_write_4(bst, bsh, CAR_RST_DEV_U_CLR_REG, CAR_DEV_U_PCIEXCLK); 905 bus_space_write_4(bst, bsh, CAR_RST_DEV_Y_CLR_REG, CAR_DEV_Y_PEX_USB_UPHY); 906 bus_space_write_4(bst, bsh, CAR_RST_DEV_Y_CLR_REG, CAR_DEV_Y_SATA_USB_UPHY); 907 908 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG2_REG, 909 CAR_UTMIP_PLL_CFG2_PD_SAMP_A_POWERUP | 910 CAR_UTMIP_PLL_CFG2_PD_SAMP_B_POWERUP | 911 CAR_UTMIP_PLL_CFG2_PD_SAMP_C_POWERUP, 912 CAR_UTMIP_PLL_CFG2_PD_SAMP_A_POWERDOWN | 913 CAR_UTMIP_PLL_CFG2_PD_SAMP_B_POWERDOWN | 914 CAR_UTMIP_PLL_CFG2_PD_SAMP_C_POWERDOWN); 915 916 /* 917 * Set up UTMI PLL under hardware control 918 */ 919 tegra_reg_set_clear(bst, bsh, CAR_UTMIP_PLL_CFG1_REG, 0, 920 CAR_UTMIP_PLL_CFG1_PLL_ENABLE_POWERUP | CAR_UTMIP_PLL_CFG1_PLL_ENABLE_POWERDOWN); 921 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 922 0, CAR_UTMIPLL_HW_PWRDN_CFG0_IDDQ_SWCTL); 923 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 924 CAR_UTMIPLL_HW_PWRDN_CFG0_IDDQ_PD_INCLUDE, 0); 925 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 926 0, CAR_UTMIPLL_HW_PWRDN_CFG0_CLK_ENABLE_SWCTL); 927 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 928 CAR_UTMIPLL_HW_PWRDN_CFG0_USE_LOCKDET, 0); 929 tegra_reg_set_clear(bst, bsh, CLK_RST_CONTROLLER_XUSB_PLL_CFG0_REG, 930 0, CLK_RST_CONTROLLER_XUSB_PLL_CFG0_UTMIPLL_LOCK_DLY); 931 delay(1); 932 tegra_reg_set_clear(bst, bsh, CAR_UTMIPLL_HW_PWRDN_CFG0_REG, 933 CAR_UTMIPLL_HW_PWRDN_CFG0_SEQ_ENABLE, 0); 934 } 935 936 static void 937 tegra210_car_xusb_init(struct tegra210_car_softc *sc) 938 { 939 const bus_space_tag_t bst = sc->sc_bst; 940 const bus_space_handle_t bsh = sc->sc_bsh; 941 uint32_t val; 942 943 /* 944 * Set up the PLLU. 945 */ 946 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, CAR_PLLU_BASE_OVERRIDE, 0); 947 tegra_reg_set_clear(bst, bsh, CAR_PLLU_MISC_REG, CAR_PLLU_MISC_IDDQ, 0); 948 tegra_reg_set_clear(bst, bsh, CAR_PLLU_MISC_REG, 0, CAR_PLLU_MISC_IDDQ); 949 tegra_reg_set_clear(bst, bsh, CAR_PLLU_OUTA_REG, 0, CAR_PLLU_OUTA_OUT1_RSTN); 950 tegra_reg_set_clear(bst, bsh, CAR_PLLU_OUTA_REG, 0, CAR_PLLU_OUTA_OUT2_RSTN); 951 delay(5); 952 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, 953 __SHIFTIN(0x19, CAR_PLLU_BASE_DIVN) | 954 __SHIFTIN(0x2, CAR_PLLU_BASE_DIVM) | 955 __SHIFTIN(0x1, CAR_PLLU_BASE_DIVP), 956 CAR_PLLU_BASE_DIVN | CAR_PLLU_BASE_DIVM | CAR_PLLU_BASE_DIVP); 957 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, CAR_PLLU_BASE_ENABLE, 0); 958 do { 959 delay(2); 960 val = bus_space_read_4(bst, bsh, CAR_PLLU_BASE_REG); 961 } while ((val & CAR_PLLU_BASE_LOCK) == 0); 962 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, CAR_PLLU_BASE_CLKENABLE_ICUSB, 0); 963 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, CAR_PLLU_BASE_CLKENABLE_HSIC, 0); 964 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, CAR_PLLU_BASE_CLKENABLE_USB, 0); 965 tegra_reg_set_clear(bst, bsh, CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT1_RSTN, 0); 966 tegra_reg_set_clear(bst, bsh, CAR_PLLU_OUTA_REG, CAR_PLLU_OUTA_OUT2_RSTN, 0); 967 delay(2); 968 969 /* 970 * Now switch PLLU to hw controlled mode. 971 */ 972 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, 0, CAR_PLLU_BASE_OVERRIDE); 973 tegra_reg_set_clear(bst, bsh, CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_REG, 974 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_IDDQ_PD_INCLUDE | 975 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_USE_SWITCH_DETECT | 976 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_USE_LOCKDET, 977 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_CLK_ENABLE_SWCTL | 978 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_CLK_SWITCH_SWCTL); 979 tegra_reg_set_clear(bst, bsh, CLK_RST_CONTROLLER_XUSB_PLL_CFG0_REG, 0, 980 CLK_RST_CONTROLLER_XUSB_PLL_CFG0_PLLU_LOCK_DLY); 981 delay(1); 982 tegra_reg_set_clear(bst, bsh, CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_REG, 983 CLK_RST_CONTROLLER_PLLU_HW_PWRDN_CFG0_SEQ_ENABLE, 0); 984 delay(1); 985 tegra_reg_set_clear(bst, bsh, CAR_PLLU_BASE_REG, 0, CAR_PLLU_BASE_CLKENABLE_USB); 986 987 /* 988 * Set up PLLREFE 989 */ 990 tegra_reg_set_clear(bst, bsh, CAR_PLLREFE_MISC_REG, 991 0, CAR_PLLREFE_MISC_IDDQ); 992 delay(5); 993 tegra_reg_set_clear(bst, bsh, CAR_PLLREFE_BASE_REG, 994 __SHIFTIN(0x4, CAR_PLLREFE_BASE_DIVM) | 995 __SHIFTIN(0x41, CAR_PLLREFE_BASE_DIVN) | 996 __SHIFTIN(0x0, CAR_PLLREFE_BASE_DIVP) | 997 __SHIFTIN(0x0, CAR_PLLREFE_BASE_KCP), 998 CAR_PLLREFE_BASE_DIVM | 999 CAR_PLLREFE_BASE_DIVN | 1000 CAR_PLLREFE_BASE_DIVP | 1001 CAR_PLLREFE_BASE_KCP); 1002 tegra_reg_set_clear(bst, bsh, CAR_PLLREFE_BASE_REG, 1003 CAR_PLLREFE_BASE_ENABLE, 0); 1004 do { 1005 delay(2); 1006 val = bus_space_read_4(bst, bsh, CAR_PLLREFE_MISC_REG); 1007 } while ((val & CAR_PLLREFE_MISC_LOCK) == 0); 1008 1009 /* 1010 * Set up the PLLE. 1011 */ 1012 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, 0, CAR_PLLE_AUX_REF_SEL_PLLREFE); 1013 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, 0, CAR_PLLE_AUX_REF_SRC); 1014 tegra_reg_set_clear(bst, bsh, CAR_PLLE_MISC_REG, 0, CAR_PLLE_MISC_IDDQ_OVERRIDE); 1015 delay(5); 1016 tegra_reg_set_clear(bst, bsh, CAR_PLLE_BASE_REG, 1017 __SHIFTIN(0xe, CAR_PLLE_BASE_DIVP_CML) | 1018 __SHIFTIN(0x7d, CAR_PLLE_BASE_DIVN) | 1019 __SHIFTIN(0x2, CAR_PLLE_BASE_DIVM), 1020 CAR_PLLE_BASE_DIVP_CML | 1021 CAR_PLLE_BASE_DIVN | 1022 CAR_PLLE_BASE_DIVM); 1023 tegra_reg_set_clear(bst, bsh, CAR_PLLE_MISC_REG, 1024 CAR_PLLE_MISC_PTS, 1025 CAR_PLLE_MISC_KCP | CAR_PLLE_MISC_VREG_CTRL | CAR_PLLE_MISC_KVCO); 1026 tegra_reg_set_clear(bst, bsh, CAR_PLLE_BASE_REG, CAR_PLLE_BASE_ENABLE, 0); 1027 do { 1028 delay(2); 1029 val = bus_space_read_4(bst, bsh, CAR_PLLE_MISC_REG); 1030 } while ((val & CAR_PLLE_MISC_LOCK) == 0); 1031 tegra_reg_set_clear(bst, bsh, CAR_PLLE_SS_CNTL_REG, 1032 __SHIFTIN(1, CAR_PLLE_SS_CNTL_SSCINC) | 1033 __SHIFTIN(0x23, CAR_PLLE_SS_CNTL_SSCINCINTRV) | 1034 __SHIFTIN(0x21, CAR_PLLE_SS_CNTL_SSCMAX), 1035 CAR_PLLE_SS_CNTL_SSCINC | 1036 CAR_PLLE_SS_CNTL_SSCINCINTRV | 1037 CAR_PLLE_SS_CNTL_SSCMAX | 1038 CAR_PLLE_SS_CNTL_SSCINVERT | 1039 CAR_PLLE_SS_CNTL_SSCCENTER | 1040 CAR_PLLE_SS_CNTL_BYPASS_SS | 1041 CAR_PLLE_SS_CNTL_SSCBYP); 1042 delay(1); 1043 tegra_reg_set_clear(bst, bsh, CAR_PLLE_SS_CNTL_REG, 0, CAR_PLLE_SS_CNTL_INTERP_RESET); 1044 tegra_reg_set_clear(bst, bsh, CAR_PLLE_MISC_REG, 0, CAR_PLLE_MISC_IDDQ_SWCTL); 1045 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, 0, CAR_PLLE_AUX_SS_SWCTL); 1046 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, 0, CAR_PLLE_AUX_ENABLE_SWCTL); 1047 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, CAR_PLLE_AUX_SS_SEQ_INCLUDE, 0); 1048 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, CAR_PLLE_AUX_USE_LOCKDET, 0); 1049 delay(1); 1050 tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, CAR_PLLE_AUX_SEQ_ENABLE, 0); 1051 1052 bus_space_write_4(bst, bsh, CAR_CLK_ENB_W_SET_REG, CAR_DEV_W_XUSB); 1053 bus_space_write_4(bst, bsh, CAR_CLK_ENB_W_SET_REG, CAR_DEV_W_XUSB_PADCTL); 1054 } 1055 1056 static void 1057 tegra210_car_watchdog_init(struct tegra210_car_softc *sc) 1058 { 1059 const bus_space_tag_t bst = sc->sc_bst; 1060 const bus_space_handle_t bsh = sc->sc_bsh; 1061 1062 /* Enable watchdog timer reset for system */ 1063 tegra_reg_set_clear(bst, bsh, CAR_RST_SOURCE_REG, 1064 CAR_RST_SOURCE_WDT_EN|CAR_RST_SOURCE_WDT_SYS_RST_EN, 0); 1065 } 1066 1067 static struct tegra_clk * 1068 tegra210_car_clock_find(const char *name) 1069 { 1070 u_int n; 1071 1072 for (n = 0; n < __arraycount(tegra210_car_clocks); n++) { 1073 if (strcmp(tegra210_car_clocks[n].base.name, name) == 0) { 1074 return &tegra210_car_clocks[n]; 1075 } 1076 } 1077 1078 return NULL; 1079 } 1080 1081 static struct tegra_clk * 1082 tegra210_car_clock_find_by_id(u_int clock_id) 1083 { 1084 u_int n; 1085 1086 for (n = 0; n < __arraycount(tegra210_car_clock_ids); n++) { 1087 if (tegra210_car_clock_ids[n].id == clock_id) { 1088 const char *name = tegra210_car_clock_ids[n].name; 1089 return tegra210_car_clock_find(name); 1090 } 1091 } 1092 1093 return NULL; 1094 } 1095 1096 static struct clk * 1097 tegra210_car_clock_decode(device_t dev, int cc_phandle, const void *data, 1098 size_t len) 1099 { 1100 struct tegra210_car_softc * const sc = device_private(dev); 1101 struct tegra_clk *tclk; 1102 1103 if (len != sc->sc_clock_cells * 4) { 1104 return NULL; 1105 } 1106 1107 const u_int clock_id = be32dec(data); 1108 1109 tclk = tegra210_car_clock_find_by_id(clock_id); 1110 if (tclk) 1111 return TEGRA_CLK_BASE(tclk); 1112 1113 return NULL; 1114 } 1115 1116 static struct clk * 1117 tegra210_car_clock_get(void *priv, const char *name) 1118 { 1119 struct tegra_clk *tclk; 1120 1121 tclk = tegra210_car_clock_find(name); 1122 if (tclk == NULL) 1123 return NULL; 1124 1125 atomic_inc_uint(&tclk->refcnt); 1126 1127 return TEGRA_CLK_BASE(tclk); 1128 } 1129 1130 static void 1131 tegra210_car_clock_put(void *priv, struct clk *clk) 1132 { 1133 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1134 1135 KASSERT(tclk->refcnt > 0); 1136 1137 atomic_dec_uint(&tclk->refcnt); 1138 } 1139 1140 static u_int 1141 tegra210_car_clock_get_rate_pll(struct tegra210_car_softc *sc, 1142 struct tegra_clk *tclk) 1143 { 1144 struct tegra_pll_clk *tpll = &tclk->u.pll; 1145 struct tegra_clk *tclk_parent; 1146 bus_space_tag_t bst = sc->sc_bst; 1147 bus_space_handle_t bsh = sc->sc_bsh; 1148 u_int divm, divn, divp; 1149 uint64_t rate; 1150 1151 KASSERT(tclk->type == TEGRA_CLK_PLL); 1152 1153 tclk_parent = tegra210_car_clock_find(tclk->parent); 1154 KASSERT(tclk_parent != NULL); 1155 1156 const u_int rate_parent = tegra210_car_clock_get_rate(sc, 1157 TEGRA_CLK_BASE(tclk_parent)); 1158 1159 const uint32_t base = bus_space_read_4(bst, bsh, tpll->base_reg); 1160 divm = __SHIFTOUT(base, tpll->divm_mask); 1161 divn = __SHIFTOUT(base, tpll->divn_mask); 1162 if (tpll->base_reg == CAR_PLLU_BASE_REG) { 1163 divp = __SHIFTOUT(base, tpll->divp_mask) ? 0 : 1; 1164 } else if (tpll->base_reg == CAR_PLLP_BASE_REG) { 1165 /* XXX divp is not applied to PLLP's primary output */ 1166 divp = 0; 1167 } else if (tpll->base_reg == CAR_PLLE_BASE_REG) { 1168 divp = 0; 1169 divm *= __SHIFTOUT(base, tpll->divp_mask); 1170 } else { 1171 divp = __SHIFTOUT(base, tpll->divp_mask); 1172 } 1173 1174 rate = (uint64_t)rate_parent * divn; 1175 return rate / (divm << divp); 1176 } 1177 1178 static int 1179 tegra210_car_clock_set_rate_pll(struct tegra210_car_softc *sc, 1180 struct tegra_clk *tclk, u_int rate) 1181 { 1182 struct tegra_pll_clk *tpll = &tclk->u.pll; 1183 bus_space_tag_t bst = sc->sc_bst; 1184 bus_space_handle_t bsh = sc->sc_bsh; 1185 struct clk *clk_parent; 1186 uint32_t bp, base; 1187 1188 clk_parent = tegra210_car_clock_get_parent(sc, TEGRA_CLK_BASE(tclk)); 1189 if (clk_parent == NULL) 1190 return EIO; 1191 const u_int rate_parent = tegra210_car_clock_get_rate(sc, clk_parent); 1192 if (rate_parent == 0) 1193 return EIO; 1194 1195 if (tpll->base_reg == CAR_PLLX_BASE_REG) { 1196 const u_int divm = 1; 1197 const u_int divn = rate / rate_parent; 1198 const u_int divp = 0; 1199 1200 bp = bus_space_read_4(bst, bsh, CAR_CCLKG_BURST_POLICY_REG); 1201 bp &= ~CAR_CCLKG_BURST_POLICY_CPU_STATE; 1202 bp |= __SHIFTIN(CAR_CCLKG_BURST_POLICY_CPU_STATE_IDLE, 1203 CAR_CCLKG_BURST_POLICY_CPU_STATE); 1204 bp &= ~CAR_CCLKG_BURST_POLICY_CWAKEUP_IDLE_SOURCE; 1205 bp |= __SHIFTIN(CAR_CCLKG_BURST_POLICY_CWAKEUP_SOURCE_CLKM, 1206 CAR_CCLKG_BURST_POLICY_CWAKEUP_IDLE_SOURCE); 1207 bus_space_write_4(bst, bsh, CAR_CCLKG_BURST_POLICY_REG, bp); 1208 1209 base = bus_space_read_4(bst, bsh, CAR_PLLX_BASE_REG); 1210 base &= ~CAR_PLLX_BASE_DIVM; 1211 base &= ~CAR_PLLX_BASE_DIVN; 1212 base &= ~CAR_PLLX_BASE_DIVP; 1213 base |= __SHIFTIN(divm, CAR_PLLX_BASE_DIVM); 1214 base |= __SHIFTIN(divn, CAR_PLLX_BASE_DIVN); 1215 base |= __SHIFTIN(divp, CAR_PLLX_BASE_DIVP); 1216 bus_space_write_4(bst, bsh, CAR_PLLX_BASE_REG, base); 1217 1218 tegra_reg_set_clear(bst, bsh, CAR_PLLX_MISC_REG, 1219 CAR_PLLX_MISC_LOCK_ENABLE, 0); 1220 do { 1221 delay(2); 1222 base = bus_space_read_4(bst, bsh, tpll->base_reg); 1223 } while ((base & CAR_PLLX_BASE_LOCK) == 0); 1224 delay(100); 1225 1226 bp &= ~CAR_CCLKG_BURST_POLICY_CPU_STATE; 1227 bp |= __SHIFTIN(CAR_CCLKG_BURST_POLICY_CPU_STATE_RUN, 1228 CAR_CCLKG_BURST_POLICY_CPU_STATE); 1229 bp &= ~CAR_CCLKG_BURST_POLICY_CWAKEUP_IDLE_SOURCE; 1230 bp |= __SHIFTIN(CAR_CCLKG_BURST_POLICY_CWAKEUP_SOURCE_PLLX_OUT0_LJ, 1231 CAR_CCLKG_BURST_POLICY_CWAKEUP_IDLE_SOURCE); 1232 bus_space_write_4(bst, bsh, CAR_CCLKG_BURST_POLICY_REG, bp); 1233 1234 return 0; 1235 } else if (tpll->base_reg == CAR_PLLD2_BASE_REG) { 1236 const u_int divm = 1; 1237 const u_int pldiv = 1; 1238 const u_int divn = (rate << pldiv) / rate_parent; 1239 1240 /* Set frequency */ 1241 tegra_reg_set_clear(bst, bsh, tpll->base_reg, 1242 __SHIFTIN(divm, CAR_PLLD2_BASE_DIVM) | 1243 __SHIFTIN(divn, CAR_PLLD2_BASE_DIVN) | 1244 __SHIFTIN(pldiv, CAR_PLLD2_BASE_DIVP), 1245 CAR_PLLD2_BASE_REF_SRC_SEL | 1246 CAR_PLLD2_BASE_DIVM | 1247 CAR_PLLD2_BASE_DIVN | 1248 CAR_PLLD2_BASE_DIVP); 1249 1250 return 0; 1251 } else { 1252 aprint_error_dev(sc->sc_dev, "failed to set %s rate to %u\n", 1253 tclk->base.name, rate); 1254 /* TODO */ 1255 return EOPNOTSUPP; 1256 } 1257 } 1258 1259 static int 1260 tegra210_car_clock_set_parent_mux(struct tegra210_car_softc *sc, 1261 struct tegra_clk *tclk, struct tegra_clk *tclk_parent) 1262 { 1263 struct tegra_mux_clk *tmux = &tclk->u.mux; 1264 bus_space_tag_t bst = sc->sc_bst; 1265 bus_space_handle_t bsh = sc->sc_bsh; 1266 uint32_t v; 1267 u_int src; 1268 1269 KASSERT(tclk->type == TEGRA_CLK_MUX); 1270 1271 for (src = 0; src < tmux->nparents; src++) { 1272 if (tmux->parents[src] == NULL) { 1273 continue; 1274 } 1275 if (strcmp(tmux->parents[src], tclk_parent->base.name) == 0) { 1276 break; 1277 } 1278 } 1279 if (src == tmux->nparents) { 1280 return EINVAL; 1281 } 1282 1283 v = bus_space_read_4(bst, bsh, tmux->reg); 1284 v &= ~tmux->bits; 1285 v |= __SHIFTIN(src, tmux->bits); 1286 bus_space_write_4(bst, bsh, tmux->reg, v); 1287 1288 return 0; 1289 } 1290 1291 static struct tegra_clk * 1292 tegra210_car_clock_get_parent_mux(struct tegra210_car_softc *sc, 1293 struct tegra_clk *tclk) 1294 { 1295 struct tegra_mux_clk *tmux = &tclk->u.mux; 1296 bus_space_tag_t bst = sc->sc_bst; 1297 bus_space_handle_t bsh = sc->sc_bsh; 1298 1299 KASSERT(tclk->type == TEGRA_CLK_MUX); 1300 1301 const uint32_t v = bus_space_read_4(bst, bsh, tmux->reg); 1302 const u_int src = __SHIFTOUT(v, tmux->bits); 1303 1304 KASSERT(src < tmux->nparents); 1305 1306 if (tmux->parents[src] == NULL) { 1307 return NULL; 1308 } 1309 1310 return tegra210_car_clock_find(tmux->parents[src]); 1311 } 1312 1313 static u_int 1314 tegra210_car_clock_get_rate_fixed_div(struct tegra210_car_softc *sc, 1315 struct tegra_clk *tclk) 1316 { 1317 struct tegra_fixed_div_clk *tfixed_div = &tclk->u.fixed_div; 1318 struct clk *clk_parent; 1319 1320 clk_parent = tegra210_car_clock_get_parent(sc, TEGRA_CLK_BASE(tclk)); 1321 if (clk_parent == NULL) 1322 return 0; 1323 const u_int parent_rate = tegra210_car_clock_get_rate(sc, clk_parent); 1324 1325 return parent_rate / tfixed_div->div; 1326 } 1327 1328 static u_int 1329 tegra210_car_clock_get_rate_div(struct tegra210_car_softc *sc, 1330 struct tegra_clk *tclk) 1331 { 1332 struct tegra_div_clk *tdiv = &tclk->u.div; 1333 bus_space_tag_t bst = sc->sc_bst; 1334 bus_space_handle_t bsh = sc->sc_bsh; 1335 struct clk *clk_parent; 1336 u_int rate; 1337 1338 KASSERT(tclk->type == TEGRA_CLK_DIV); 1339 1340 clk_parent = tegra210_car_clock_get_parent(sc, TEGRA_CLK_BASE(tclk)); 1341 const u_int parent_rate = tegra210_car_clock_get_rate(sc, clk_parent); 1342 1343 const uint32_t v = bus_space_read_4(bst, bsh, tdiv->reg); 1344 u_int raw_div = __SHIFTOUT(v, tdiv->bits); 1345 1346 switch (tdiv->reg) { 1347 case CAR_CLKSRC_I2C1_REG: 1348 case CAR_CLKSRC_I2C2_REG: 1349 case CAR_CLKSRC_I2C3_REG: 1350 case CAR_CLKSRC_I2C4_REG: 1351 case CAR_CLKSRC_I2C5_REG: 1352 case CAR_CLKSRC_I2C6_REG: 1353 rate = parent_rate / (raw_div + 1); 1354 break; 1355 case CAR_CLKSRC_UARTA_REG: 1356 case CAR_CLKSRC_UARTB_REG: 1357 case CAR_CLKSRC_UARTC_REG: 1358 case CAR_CLKSRC_UARTD_REG: 1359 if (v & CAR_CLKSRC_UART_DIV_ENB) { 1360 rate = parent_rate / ((raw_div / 2) + 1); 1361 } else { 1362 rate = parent_rate; 1363 } 1364 break; 1365 case CAR_CLKSRC_SDMMC2_REG: 1366 case CAR_CLKSRC_SDMMC4_REG: 1367 switch (__SHIFTOUT(v, CAR_CLKSRC_SDMMC_SRC)) { 1368 case 1: 1369 case 2: 1370 case 5: 1371 raw_div = 0; /* ignore divisor for _LJ options */ 1372 break; 1373 } 1374 /* FALLTHROUGH */ 1375 default: 1376 rate = parent_rate / ((raw_div / 2) + 1); 1377 break; 1378 } 1379 1380 return rate; 1381 } 1382 1383 static int 1384 tegra210_car_clock_set_rate_div(struct tegra210_car_softc *sc, 1385 struct tegra_clk *tclk, u_int rate) 1386 { 1387 struct tegra_div_clk *tdiv = &tclk->u.div; 1388 bus_space_tag_t bst = sc->sc_bst; 1389 bus_space_handle_t bsh = sc->sc_bsh; 1390 struct clk *clk_parent; 1391 u_int raw_div; 1392 uint32_t v; 1393 1394 KASSERT(tclk->type == TEGRA_CLK_DIV); 1395 1396 clk_parent = tegra210_car_clock_get_parent(sc, TEGRA_CLK_BASE(tclk)); 1397 if (clk_parent == NULL) 1398 return EINVAL; 1399 const u_int parent_rate = tegra210_car_clock_get_rate(sc, clk_parent); 1400 1401 v = bus_space_read_4(bst, bsh, tdiv->reg); 1402 1403 raw_div = __SHIFTOUT(tdiv->bits, tdiv->bits); 1404 1405 switch (tdiv->reg) { 1406 case CAR_CLKSRC_UARTA_REG: 1407 case CAR_CLKSRC_UARTB_REG: 1408 case CAR_CLKSRC_UARTC_REG: 1409 case CAR_CLKSRC_UARTD_REG: 1410 if (rate == parent_rate) { 1411 v &= ~CAR_CLKSRC_UART_DIV_ENB; 1412 } else if (rate) { 1413 v |= CAR_CLKSRC_UART_DIV_ENB; 1414 raw_div = (parent_rate / rate) * 2; 1415 if (raw_div >= 2) 1416 raw_div -= 2; 1417 } 1418 break; 1419 case CAR_CLKSRC_I2C1_REG: 1420 case CAR_CLKSRC_I2C2_REG: 1421 case CAR_CLKSRC_I2C3_REG: 1422 case CAR_CLKSRC_I2C4_REG: 1423 case CAR_CLKSRC_I2C5_REG: 1424 case CAR_CLKSRC_I2C6_REG: 1425 if (rate) 1426 raw_div = (parent_rate / rate) - 1; 1427 break; 1428 case CAR_CLKSRC_SDMMC1_REG: 1429 case CAR_CLKSRC_SDMMC2_REG: 1430 case CAR_CLKSRC_SDMMC3_REG: 1431 case CAR_CLKSRC_SDMMC4_REG: 1432 if (rate) { 1433 for (raw_div = 0x00; raw_div <= 0xff; raw_div++) { 1434 u_int calc_rate = 1435 parent_rate / ((raw_div / 2) + 1); 1436 if (calc_rate <= rate) 1437 break; 1438 } 1439 if (raw_div == 0x100) 1440 return EINVAL; 1441 } 1442 break; 1443 default: 1444 if (rate) { 1445 raw_div = (parent_rate / rate) * 2; 1446 if (raw_div >= 2) 1447 raw_div -= 2; 1448 } 1449 break; 1450 } 1451 1452 v &= ~tdiv->bits; 1453 v |= __SHIFTIN(raw_div, tdiv->bits); 1454 1455 bus_space_write_4(bst, bsh, tdiv->reg, v); 1456 1457 return 0; 1458 } 1459 1460 static int 1461 tegra210_car_clock_enable_gate(struct tegra210_car_softc *sc, 1462 struct tegra_clk *tclk, bool enable) 1463 { 1464 struct tegra_gate_clk *tgate = &tclk->u.gate; 1465 bus_space_tag_t bst = sc->sc_bst; 1466 bus_space_handle_t bsh = sc->sc_bsh; 1467 bus_size_t reg; 1468 1469 KASSERT(tclk->type == TEGRA_CLK_GATE); 1470 1471 if (tgate->set_reg == tgate->clr_reg) { 1472 uint32_t v = bus_space_read_4(bst, bsh, tgate->set_reg); 1473 if (enable) { 1474 v |= tgate->bits; 1475 } else { 1476 v &= ~tgate->bits; 1477 } 1478 bus_space_write_4(bst, bsh, tgate->set_reg, v); 1479 } else { 1480 if (enable) { 1481 reg = tgate->set_reg; 1482 } else { 1483 reg = tgate->clr_reg; 1484 } 1485 bus_space_write_4(bst, bsh, reg, tgate->bits); 1486 } 1487 1488 return 0; 1489 } 1490 1491 static u_int 1492 tegra210_car_clock_get_rate(void *priv, struct clk *clk) 1493 { 1494 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1495 struct clk *clk_parent; 1496 1497 switch (tclk->type) { 1498 case TEGRA_CLK_FIXED: 1499 return tclk->u.fixed.rate; 1500 case TEGRA_CLK_PLL: 1501 return tegra210_car_clock_get_rate_pll(priv, tclk); 1502 case TEGRA_CLK_MUX: 1503 case TEGRA_CLK_GATE: 1504 clk_parent = tegra210_car_clock_get_parent(priv, clk); 1505 if (clk_parent == NULL) 1506 return EINVAL; 1507 return tegra210_car_clock_get_rate(priv, clk_parent); 1508 case TEGRA_CLK_FIXED_DIV: 1509 return tegra210_car_clock_get_rate_fixed_div(priv, tclk); 1510 case TEGRA_CLK_DIV: 1511 return tegra210_car_clock_get_rate_div(priv, tclk); 1512 default: 1513 panic("tegra210: unknown tclk type %d", tclk->type); 1514 } 1515 } 1516 1517 static int 1518 tegra210_car_clock_set_rate(void *priv, struct clk *clk, u_int rate) 1519 { 1520 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1521 struct clk *clk_parent; 1522 1523 KASSERT((clk->flags & CLK_SET_RATE_PARENT) == 0); 1524 1525 switch (tclk->type) { 1526 case TEGRA_CLK_FIXED: 1527 case TEGRA_CLK_MUX: 1528 return EIO; 1529 case TEGRA_CLK_FIXED_DIV: 1530 clk_parent = tegra210_car_clock_get_parent(priv, clk); 1531 if (clk_parent == NULL) 1532 return EIO; 1533 return tegra210_car_clock_set_rate(priv, clk_parent, 1534 rate * tclk->u.fixed_div.div); 1535 case TEGRA_CLK_GATE: 1536 return EINVAL; 1537 case TEGRA_CLK_PLL: 1538 return tegra210_car_clock_set_rate_pll(priv, tclk, rate); 1539 case TEGRA_CLK_DIV: 1540 return tegra210_car_clock_set_rate_div(priv, tclk, rate); 1541 default: 1542 panic("tegra210: unknown tclk type %d", tclk->type); 1543 } 1544 } 1545 1546 static int 1547 tegra210_car_clock_enable(void *priv, struct clk *clk) 1548 { 1549 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1550 struct clk *clk_parent; 1551 1552 if (tclk->type != TEGRA_CLK_GATE) { 1553 clk_parent = tegra210_car_clock_get_parent(priv, clk); 1554 if (clk_parent == NULL) 1555 return 0; 1556 return tegra210_car_clock_enable(priv, clk_parent); 1557 } 1558 1559 return tegra210_car_clock_enable_gate(priv, tclk, true); 1560 } 1561 1562 static int 1563 tegra210_car_clock_disable(void *priv, struct clk *clk) 1564 { 1565 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1566 1567 if (tclk->type != TEGRA_CLK_GATE) 1568 return EINVAL; 1569 1570 return tegra210_car_clock_enable_gate(priv, tclk, false); 1571 } 1572 1573 static int 1574 tegra210_car_clock_set_parent(void *priv, struct clk *clk, 1575 struct clk *clk_parent) 1576 { 1577 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1578 struct tegra_clk *tclk_parent = TEGRA_CLK_PRIV(clk_parent); 1579 struct clk *nclk_parent; 1580 1581 if (tclk->type != TEGRA_CLK_MUX) { 1582 nclk_parent = tegra210_car_clock_get_parent(priv, clk); 1583 if (nclk_parent == clk_parent || nclk_parent == NULL) 1584 return EINVAL; 1585 return tegra210_car_clock_set_parent(priv, nclk_parent, 1586 clk_parent); 1587 } 1588 1589 return tegra210_car_clock_set_parent_mux(priv, tclk, tclk_parent); 1590 } 1591 1592 static struct clk * 1593 tegra210_car_clock_get_parent(void *priv, struct clk *clk) 1594 { 1595 struct tegra_clk *tclk = TEGRA_CLK_PRIV(clk); 1596 struct tegra_clk *tclk_parent = NULL; 1597 1598 switch (tclk->type) { 1599 case TEGRA_CLK_FIXED: 1600 case TEGRA_CLK_PLL: 1601 case TEGRA_CLK_FIXED_DIV: 1602 case TEGRA_CLK_DIV: 1603 case TEGRA_CLK_GATE: 1604 if (tclk->parent) { 1605 tclk_parent = tegra210_car_clock_find(tclk->parent); 1606 } 1607 break; 1608 case TEGRA_CLK_MUX: 1609 tclk_parent = tegra210_car_clock_get_parent_mux(priv, tclk); 1610 break; 1611 } 1612 1613 if (tclk_parent == NULL) 1614 return NULL; 1615 1616 return TEGRA_CLK_BASE(tclk_parent); 1617 } 1618 1619 static void * 1620 tegra210_car_reset_acquire(device_t dev, const void *data, size_t len) 1621 { 1622 struct tegra210_car_softc * const sc = device_private(dev); 1623 struct tegra210_car_rst *rst; 1624 1625 if (len != sc->sc_reset_cells * 4) 1626 return NULL; 1627 1628 const u_int reset_id = be32dec(data); 1629 1630 if (reset_id >= __arraycount(tegra210_car_reset_regs) * 32) 1631 return NULL; 1632 1633 const u_int reg = reset_id / 32; 1634 1635 rst = kmem_alloc(sizeof(*rst), KM_SLEEP); 1636 rst->set_reg = tegra210_car_reset_regs[reg].set_reg; 1637 rst->clr_reg = tegra210_car_reset_regs[reg].clr_reg; 1638 rst->mask = __BIT(reset_id % 32); 1639 1640 return rst; 1641 } 1642 1643 static void 1644 tegra210_car_reset_release(device_t dev, void *priv) 1645 { 1646 struct tegra210_car_rst *rst = priv; 1647 1648 kmem_free(rst, sizeof(*rst)); 1649 } 1650 1651 static int 1652 tegra210_car_reset_assert(device_t dev, void *priv) 1653 { 1654 struct tegra210_car_softc * const sc = device_private(dev); 1655 struct tegra210_car_rst *rst = priv; 1656 1657 bus_space_write_4(sc->sc_bst, sc->sc_bsh, rst->set_reg, rst->mask); 1658 1659 return 0; 1660 } 1661 1662 static int 1663 tegra210_car_reset_deassert(device_t dev, void *priv) 1664 { 1665 struct tegra210_car_softc * const sc = device_private(dev); 1666 struct tegra210_car_rst *rst = priv; 1667 1668 bus_space_write_4(sc->sc_bst, sc->sc_bsh, rst->clr_reg, rst->mask); 1669 1670 return 0; 1671 } 1672 1673 void 1674 tegra210_car_xusbio_enable_hw_control(void) 1675 { 1676 device_t dev = device_find_by_driver_unit("tegra210car", 0); 1677 KASSERT(dev != NULL); 1678 struct tegra210_car_softc * const sc = device_private(dev); 1679 bus_space_tag_t bst = sc->sc_bst; 1680 bus_space_handle_t bsh = sc->sc_bsh; 1681 1682 tegra_reg_set_clear(bst, bsh, CAR_XUSBIO_PLL_CFG0_REG, 1683 0, 1684 CAR_XUSBIO_PLL_CFG0_CLK_ENABLE_SWCTL | 1685 CAR_XUSBIO_PLL_CFG0_PADPLL_RESET_SWCTL); 1686 tegra_reg_set_clear(bst, bsh, CAR_XUSBIO_PLL_CFG0_REG, 1687 CAR_XUSBIO_PLL_CFG0_PADPLL_SLEEP_IDDQ | 1688 CAR_XUSBIO_PLL_CFG0_PADPLL_USE_LOCKDET, 1689 0); 1690 } 1691 1692 void 1693 tegra210_car_xusbio_enable_hw_seq(void) 1694 { 1695 device_t dev = device_find_by_driver_unit("tegra210car", 0); 1696 KASSERT(dev != NULL); 1697 struct tegra210_car_softc * const sc = device_private(dev); 1698 bus_space_tag_t bst = sc->sc_bst; 1699 bus_space_handle_t bsh = sc->sc_bsh; 1700 1701 tegra_reg_set_clear(bst, bsh, CAR_XUSBIO_PLL_CFG0_REG, 1702 CAR_XUSBIO_PLL_CFG0_SEQ_ENABLE, 0); 1703 } 1704 1705 void 1706 tegra210_car_sata_enable_hw_control(void) 1707 { 1708 device_t dev = device_find_by_driver_unit("tegra210car", 0); 1709 KASSERT(dev != NULL); 1710 struct tegra210_car_softc * const sc = device_private(dev); 1711 bus_space_tag_t bst = sc->sc_bst; 1712 bus_space_handle_t bsh = sc->sc_bsh; 1713 1714 tegra_reg_set_clear(bst, bsh, CAR_SATA_PLL_CFG0_REG, 1715 0, 1716 CAR_SATA_PLL_CFG0_PADPLL_RESET_SWCTL); 1717 tegra_reg_set_clear(bst, bsh, CAR_SATA_PLL_CFG0_REG, 1718 CAR_SATA_PLL_CFG0_SEQ_PADPLL_SLEEP_IDDQ | 1719 CAR_SATA_PLL_CFG0_PADPLL_USE_LOCKDET, 1720 0); 1721 } 1722 1723 void 1724 tegra210_car_sata_enable_hw_seq(void) 1725 { 1726 device_t dev = device_find_by_driver_unit("tegra210car", 0); 1727 KASSERT(dev != NULL); 1728 struct tegra210_car_softc * const sc = device_private(dev); 1729 bus_space_tag_t bst = sc->sc_bst; 1730 bus_space_handle_t bsh = sc->sc_bsh; 1731 1732 tegra_reg_set_clear(bst, bsh, CAR_SATA_PLL_CFG0_REG, 1733 CAR_SATA_PLL_CFG0_SEQ_ENABLE, 0); 1734 } 1735 1736
Indexes created Tue Sep 30 20:09:53 GMT 2025