Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux

clk: starfive: Factor out common JH7100 and JH7110 code

The clock control registers on the StarFive JH7100 and JH7110 work
identically, so factor out the code then drivers for the two SoCs
can share it without depending on each other. No functional change.

Tested-by: Tommaso Merciai <tomm.merciai@gmail.com>
Reviewed-by: Conor Dooley <conor.dooley@microchip.com>
Reviewed-by: Emil Renner Berthing <emil.renner.berthing@canonical.com>
Signed-off-by: Emil Renner Berthing <kernel@esmil.dk>
Signed-off-by: Hal Feng <hal.feng@starfivetech.com>
Signed-off-by: Conor Dooley <conor.dooley@microchip.com>

authored by

Emil Renner Berthing and committed by
Conor Dooley
00f1cb17 c61f19ec

+342 -326
+5
drivers/clk/starfive/Kconfig
··· 1 1 # SPDX-License-Identifier: GPL-2.0 2 2 3 + config CLK_STARFIVE_JH71X0 4 + bool 5 + 3 6 config CLK_STARFIVE_JH7100 4 7 bool "StarFive JH7100 clock support" 5 8 depends on ARCH_STARFIVE || COMPILE_TEST 9 + select CLK_STARFIVE_JH71X0 6 10 default ARCH_STARFIVE 7 11 help 8 12 Say yes here to support the clock controller on the StarFive JH7100 ··· 15 11 config CLK_STARFIVE_JH7100_AUDIO 16 12 tristate "StarFive JH7100 audio clock support" 17 13 depends on CLK_STARFIVE_JH7100 14 + select CLK_STARFIVE_JH71X0 18 15 default m if ARCH_STARFIVE 19 16 help 20 17 Say Y or M here to support the audio clocks on the StarFive JH7100
+2 -1
drivers/clk/starfive/Makefile
··· 1 1 # SPDX-License-Identifier: GPL-2.0 2 - # StarFive Clock 2 + obj-$(CONFIG_CLK_STARFIVE_JH71X0) += clk-starfive-jh71x0.o 3 + 3 4 obj-$(CONFIG_CLK_STARFIVE_JH7100) += clk-starfive-jh7100.o 4 5 obj-$(CONFIG_CLK_STARFIVE_JH7100_AUDIO) += clk-starfive-jh7100-audio.o
-325
drivers/clk/starfive/clk-starfive-jh7100.c
··· 7 7 * Copyright (C) 2021 Emil Renner Berthing <kernel@esmil.dk> 8 8 */ 9 9 10 - #include <linux/bits.h> 11 10 #include <linux/clk-provider.h> 12 - #include <linux/debugfs.h> 13 11 #include <linux/device.h> 14 12 #include <linux/init.h> 15 - #include <linux/io.h> 16 - #include <linux/kernel.h> 17 13 #include <linux/mod_devicetable.h> 18 - #include <linux/module.h> 19 14 #include <linux/platform_device.h> 20 15 21 16 #include <dt-bindings/clock/starfive-jh7100.h> ··· 263 268 JH7100_GDIV(JH7100_CLK_TEMP_SENSE, "temp_sense", 0, 31, JH7100_CLK_OSC_SYS), 264 269 JH7100_GATE(JH7100_CLK_SYSERR_APB, "syserr_apb", 0, JH7100_CLK_APB2_BUS), 265 270 }; 266 - 267 - static struct jh7100_clk *jh7100_clk_from(struct clk_hw *hw) 268 - { 269 - return container_of(hw, struct jh7100_clk, hw); 270 - } 271 - 272 - static struct jh7100_clk_priv *jh7100_priv_from(struct jh7100_clk *clk) 273 - { 274 - return container_of(clk, struct jh7100_clk_priv, reg[clk->idx]); 275 - } 276 - 277 - static u32 jh7100_clk_reg_get(struct jh7100_clk *clk) 278 - { 279 - struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 280 - void __iomem *reg = priv->base + 4 * clk->idx; 281 - 282 - return readl_relaxed(reg); 283 - } 284 - 285 - static void jh7100_clk_reg_rmw(struct jh7100_clk *clk, u32 mask, u32 value) 286 - { 287 - struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 288 - void __iomem *reg = priv->base + 4 * clk->idx; 289 - unsigned long flags; 290 - 291 - spin_lock_irqsave(&priv->rmw_lock, flags); 292 - value |= readl_relaxed(reg) & ~mask; 293 - writel_relaxed(value, reg); 294 - spin_unlock_irqrestore(&priv->rmw_lock, flags); 295 - } 296 - 297 - static int jh7100_clk_enable(struct clk_hw *hw) 298 - { 299 - struct jh7100_clk *clk = jh7100_clk_from(hw); 300 - 301 - jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, JH7100_CLK_ENABLE); 302 - return 0; 303 - } 304 - 305 - static void jh7100_clk_disable(struct clk_hw *hw) 306 - { 307 - struct jh7100_clk *clk = jh7100_clk_from(hw); 308 - 309 - jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, 0); 310 - } 311 - 312 - static int jh7100_clk_is_enabled(struct clk_hw *hw) 313 - { 314 - struct jh7100_clk *clk = jh7100_clk_from(hw); 315 - 316 - return !!(jh7100_clk_reg_get(clk) & JH7100_CLK_ENABLE); 317 - } 318 - 319 - static unsigned long jh7100_clk_recalc_rate(struct clk_hw *hw, 320 - unsigned long parent_rate) 321 - { 322 - struct jh7100_clk *clk = jh7100_clk_from(hw); 323 - u32 div = jh7100_clk_reg_get(clk) & JH7100_CLK_DIV_MASK; 324 - 325 - return div ? parent_rate / div : 0; 326 - } 327 - 328 - static int jh7100_clk_determine_rate(struct clk_hw *hw, 329 - struct clk_rate_request *req) 330 - { 331 - struct jh7100_clk *clk = jh7100_clk_from(hw); 332 - unsigned long parent = req->best_parent_rate; 333 - unsigned long rate = clamp(req->rate, req->min_rate, req->max_rate); 334 - unsigned long div = min_t(unsigned long, DIV_ROUND_UP(parent, rate), clk->max_div); 335 - unsigned long result = parent / div; 336 - 337 - /* 338 - * we want the result clamped by min_rate and max_rate if possible: 339 - * case 1: div hits the max divider value, which means it's less than 340 - * parent / rate, so the result is greater than rate and min_rate in 341 - * particular. we can't do anything about result > max_rate because the 342 - * divider doesn't go any further. 343 - * case 2: div = DIV_ROUND_UP(parent, rate) which means the result is 344 - * always lower or equal to rate and max_rate. however the result may 345 - * turn out lower than min_rate, but then the next higher rate is fine: 346 - * div - 1 = ceil(parent / rate) - 1 < parent / rate 347 - * and thus 348 - * min_rate <= rate < parent / (div - 1) 349 - */ 350 - if (result < req->min_rate && div > 1) 351 - result = parent / (div - 1); 352 - 353 - req->rate = result; 354 - return 0; 355 - } 356 - 357 - static int jh7100_clk_set_rate(struct clk_hw *hw, 358 - unsigned long rate, 359 - unsigned long parent_rate) 360 - { 361 - struct jh7100_clk *clk = jh7100_clk_from(hw); 362 - unsigned long div = clamp(DIV_ROUND_CLOSEST(parent_rate, rate), 363 - 1UL, (unsigned long)clk->max_div); 364 - 365 - jh7100_clk_reg_rmw(clk, JH7100_CLK_DIV_MASK, div); 366 - return 0; 367 - } 368 - 369 - static unsigned long jh7100_clk_frac_recalc_rate(struct clk_hw *hw, 370 - unsigned long parent_rate) 371 - { 372 - struct jh7100_clk *clk = jh7100_clk_from(hw); 373 - u32 reg = jh7100_clk_reg_get(clk); 374 - unsigned long div100 = 100 * (reg & JH7100_CLK_INT_MASK) + 375 - ((reg & JH7100_CLK_FRAC_MASK) >> JH7100_CLK_FRAC_SHIFT); 376 - 377 - return (div100 >= JH7100_CLK_FRAC_MIN) ? 100 * parent_rate / div100 : 0; 378 - } 379 - 380 - static int jh7100_clk_frac_determine_rate(struct clk_hw *hw, 381 - struct clk_rate_request *req) 382 - { 383 - unsigned long parent100 = 100 * req->best_parent_rate; 384 - unsigned long rate = clamp(req->rate, req->min_rate, req->max_rate); 385 - unsigned long div100 = clamp(DIV_ROUND_CLOSEST(parent100, rate), 386 - JH7100_CLK_FRAC_MIN, JH7100_CLK_FRAC_MAX); 387 - unsigned long result = parent100 / div100; 388 - 389 - /* clamp the result as in jh7100_clk_determine_rate() above */ 390 - if (result > req->max_rate && div100 < JH7100_CLK_FRAC_MAX) 391 - result = parent100 / (div100 + 1); 392 - if (result < req->min_rate && div100 > JH7100_CLK_FRAC_MIN) 393 - result = parent100 / (div100 - 1); 394 - 395 - req->rate = result; 396 - return 0; 397 - } 398 - 399 - static int jh7100_clk_frac_set_rate(struct clk_hw *hw, 400 - unsigned long rate, 401 - unsigned long parent_rate) 402 - { 403 - struct jh7100_clk *clk = jh7100_clk_from(hw); 404 - unsigned long div100 = clamp(DIV_ROUND_CLOSEST(100 * parent_rate, rate), 405 - JH7100_CLK_FRAC_MIN, JH7100_CLK_FRAC_MAX); 406 - u32 value = ((div100 % 100) << JH7100_CLK_FRAC_SHIFT) | (div100 / 100); 407 - 408 - jh7100_clk_reg_rmw(clk, JH7100_CLK_DIV_MASK, value); 409 - return 0; 410 - } 411 - 412 - static u8 jh7100_clk_get_parent(struct clk_hw *hw) 413 - { 414 - struct jh7100_clk *clk = jh7100_clk_from(hw); 415 - u32 value = jh7100_clk_reg_get(clk); 416 - 417 - return (value & JH7100_CLK_MUX_MASK) >> JH7100_CLK_MUX_SHIFT; 418 - } 419 - 420 - static int jh7100_clk_set_parent(struct clk_hw *hw, u8 index) 421 - { 422 - struct jh7100_clk *clk = jh7100_clk_from(hw); 423 - u32 value = (u32)index << JH7100_CLK_MUX_SHIFT; 424 - 425 - jh7100_clk_reg_rmw(clk, JH7100_CLK_MUX_MASK, value); 426 - return 0; 427 - } 428 - 429 - static int jh7100_clk_mux_determine_rate(struct clk_hw *hw, 430 - struct clk_rate_request *req) 431 - { 432 - return clk_mux_determine_rate_flags(hw, req, 0); 433 - } 434 - 435 - static int jh7100_clk_get_phase(struct clk_hw *hw) 436 - { 437 - struct jh7100_clk *clk = jh7100_clk_from(hw); 438 - u32 value = jh7100_clk_reg_get(clk); 439 - 440 - return (value & JH7100_CLK_INVERT) ? 180 : 0; 441 - } 442 - 443 - static int jh7100_clk_set_phase(struct clk_hw *hw, int degrees) 444 - { 445 - struct jh7100_clk *clk = jh7100_clk_from(hw); 446 - u32 value; 447 - 448 - if (degrees == 0) 449 - value = 0; 450 - else if (degrees == 180) 451 - value = JH7100_CLK_INVERT; 452 - else 453 - return -EINVAL; 454 - 455 - jh7100_clk_reg_rmw(clk, JH7100_CLK_INVERT, value); 456 - return 0; 457 - } 458 - 459 - #ifdef CONFIG_DEBUG_FS 460 - static void jh7100_clk_debug_init(struct clk_hw *hw, struct dentry *dentry) 461 - { 462 - static const struct debugfs_reg32 jh7100_clk_reg = { 463 - .name = "CTRL", 464 - .offset = 0, 465 - }; 466 - struct jh7100_clk *clk = jh7100_clk_from(hw); 467 - struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 468 - struct debugfs_regset32 *regset; 469 - 470 - regset = devm_kzalloc(priv->dev, sizeof(*regset), GFP_KERNEL); 471 - if (!regset) 472 - return; 473 - 474 - regset->regs = &jh7100_clk_reg; 475 - regset->nregs = 1; 476 - regset->base = priv->base + 4 * clk->idx; 477 - 478 - debugfs_create_regset32("registers", 0400, dentry, regset); 479 - } 480 - #else 481 - #define jh7100_clk_debug_init NULL 482 - #endif 483 - 484 - static const struct clk_ops jh7100_clk_gate_ops = { 485 - .enable = jh7100_clk_enable, 486 - .disable = jh7100_clk_disable, 487 - .is_enabled = jh7100_clk_is_enabled, 488 - .debug_init = jh7100_clk_debug_init, 489 - }; 490 - 491 - static const struct clk_ops jh7100_clk_div_ops = { 492 - .recalc_rate = jh7100_clk_recalc_rate, 493 - .determine_rate = jh7100_clk_determine_rate, 494 - .set_rate = jh7100_clk_set_rate, 495 - .debug_init = jh7100_clk_debug_init, 496 - }; 497 - 498 - static const struct clk_ops jh7100_clk_fdiv_ops = { 499 - .recalc_rate = jh7100_clk_frac_recalc_rate, 500 - .determine_rate = jh7100_clk_frac_determine_rate, 501 - .set_rate = jh7100_clk_frac_set_rate, 502 - .debug_init = jh7100_clk_debug_init, 503 - }; 504 - 505 - static const struct clk_ops jh7100_clk_gdiv_ops = { 506 - .enable = jh7100_clk_enable, 507 - .disable = jh7100_clk_disable, 508 - .is_enabled = jh7100_clk_is_enabled, 509 - .recalc_rate = jh7100_clk_recalc_rate, 510 - .determine_rate = jh7100_clk_determine_rate, 511 - .set_rate = jh7100_clk_set_rate, 512 - .debug_init = jh7100_clk_debug_init, 513 - }; 514 - 515 - static const struct clk_ops jh7100_clk_mux_ops = { 516 - .determine_rate = jh7100_clk_mux_determine_rate, 517 - .set_parent = jh7100_clk_set_parent, 518 - .get_parent = jh7100_clk_get_parent, 519 - .debug_init = jh7100_clk_debug_init, 520 - }; 521 - 522 - static const struct clk_ops jh7100_clk_gmux_ops = { 523 - .enable = jh7100_clk_enable, 524 - .disable = jh7100_clk_disable, 525 - .is_enabled = jh7100_clk_is_enabled, 526 - .determine_rate = jh7100_clk_mux_determine_rate, 527 - .set_parent = jh7100_clk_set_parent, 528 - .get_parent = jh7100_clk_get_parent, 529 - .debug_init = jh7100_clk_debug_init, 530 - }; 531 - 532 - static const struct clk_ops jh7100_clk_mdiv_ops = { 533 - .recalc_rate = jh7100_clk_recalc_rate, 534 - .determine_rate = jh7100_clk_determine_rate, 535 - .get_parent = jh7100_clk_get_parent, 536 - .set_parent = jh7100_clk_set_parent, 537 - .set_rate = jh7100_clk_set_rate, 538 - .debug_init = jh7100_clk_debug_init, 539 - }; 540 - 541 - static const struct clk_ops jh7100_clk_gmd_ops = { 542 - .enable = jh7100_clk_enable, 543 - .disable = jh7100_clk_disable, 544 - .is_enabled = jh7100_clk_is_enabled, 545 - .recalc_rate = jh7100_clk_recalc_rate, 546 - .determine_rate = jh7100_clk_determine_rate, 547 - .get_parent = jh7100_clk_get_parent, 548 - .set_parent = jh7100_clk_set_parent, 549 - .set_rate = jh7100_clk_set_rate, 550 - .debug_init = jh7100_clk_debug_init, 551 - }; 552 - 553 - static const struct clk_ops jh7100_clk_inv_ops = { 554 - .get_phase = jh7100_clk_get_phase, 555 - .set_phase = jh7100_clk_set_phase, 556 - .debug_init = jh7100_clk_debug_init, 557 - }; 558 - 559 - const struct clk_ops *starfive_jh7100_clk_ops(u32 max) 560 - { 561 - if (max & JH7100_CLK_DIV_MASK) { 562 - if (max & JH7100_CLK_MUX_MASK) { 563 - if (max & JH7100_CLK_ENABLE) 564 - return &jh7100_clk_gmd_ops; 565 - return &jh7100_clk_mdiv_ops; 566 - } 567 - if (max & JH7100_CLK_ENABLE) 568 - return &jh7100_clk_gdiv_ops; 569 - if (max == JH7100_CLK_FRAC_MAX) 570 - return &jh7100_clk_fdiv_ops; 571 - return &jh7100_clk_div_ops; 572 - } 573 - 574 - if (max & JH7100_CLK_MUX_MASK) { 575 - if (max & JH7100_CLK_ENABLE) 576 - return &jh7100_clk_gmux_ops; 577 - return &jh7100_clk_mux_ops; 578 - } 579 - 580 - if (max & JH7100_CLK_ENABLE) 581 - return &jh7100_clk_gate_ops; 582 - 583 - return &jh7100_clk_inv_ops; 584 - } 585 - EXPORT_SYMBOL_GPL(starfive_jh7100_clk_ops); 586 271 587 272 static struct clk_hw *jh7100_clk_get(struct of_phandle_args *clkspec, void *data) 588 273 {
+2
drivers/clk/starfive/clk-starfive-jh7100.h
··· 4 4 5 5 #include <linux/bits.h> 6 6 #include <linux/clk-provider.h> 7 + #include <linux/device.h> 8 + #include <linux/spinlock.h> 7 9 8 10 /* register fields */ 9 11 #define JH7100_CLK_ENABLE BIT(31)
+333
drivers/clk/starfive/clk-starfive-jh71x0.c
··· 1 + // SPDX-License-Identifier: GPL-2.0 2 + /* 3 + * StarFive JH7100 Clock Generator Driver 4 + * 5 + * Copyright (C) 2021-2022 Emil Renner Berthing <kernel@esmil.dk> 6 + */ 7 + 8 + #include <linux/clk-provider.h> 9 + #include <linux/debugfs.h> 10 + #include <linux/device.h> 11 + #include <linux/io.h> 12 + 13 + #include "clk-starfive-jh7100.h" 14 + 15 + static struct jh7100_clk *jh7100_clk_from(struct clk_hw *hw) 16 + { 17 + return container_of(hw, struct jh7100_clk, hw); 18 + } 19 + 20 + static struct jh7100_clk_priv *jh7100_priv_from(struct jh7100_clk *clk) 21 + { 22 + return container_of(clk, struct jh7100_clk_priv, reg[clk->idx]); 23 + } 24 + 25 + static u32 jh7100_clk_reg_get(struct jh7100_clk *clk) 26 + { 27 + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 28 + void __iomem *reg = priv->base + 4 * clk->idx; 29 + 30 + return readl_relaxed(reg); 31 + } 32 + 33 + static void jh7100_clk_reg_rmw(struct jh7100_clk *clk, u32 mask, u32 value) 34 + { 35 + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 36 + void __iomem *reg = priv->base + 4 * clk->idx; 37 + unsigned long flags; 38 + 39 + spin_lock_irqsave(&priv->rmw_lock, flags); 40 + value |= readl_relaxed(reg) & ~mask; 41 + writel_relaxed(value, reg); 42 + spin_unlock_irqrestore(&priv->rmw_lock, flags); 43 + } 44 + 45 + static int jh7100_clk_enable(struct clk_hw *hw) 46 + { 47 + struct jh7100_clk *clk = jh7100_clk_from(hw); 48 + 49 + jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, JH7100_CLK_ENABLE); 50 + return 0; 51 + } 52 + 53 + static void jh7100_clk_disable(struct clk_hw *hw) 54 + { 55 + struct jh7100_clk *clk = jh7100_clk_from(hw); 56 + 57 + jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, 0); 58 + } 59 + 60 + static int jh7100_clk_is_enabled(struct clk_hw *hw) 61 + { 62 + struct jh7100_clk *clk = jh7100_clk_from(hw); 63 + 64 + return !!(jh7100_clk_reg_get(clk) & JH7100_CLK_ENABLE); 65 + } 66 + 67 + static unsigned long jh7100_clk_recalc_rate(struct clk_hw *hw, 68 + unsigned long parent_rate) 69 + { 70 + struct jh7100_clk *clk = jh7100_clk_from(hw); 71 + u32 div = jh7100_clk_reg_get(clk) & JH7100_CLK_DIV_MASK; 72 + 73 + return div ? parent_rate / div : 0; 74 + } 75 + 76 + static int jh7100_clk_determine_rate(struct clk_hw *hw, 77 + struct clk_rate_request *req) 78 + { 79 + struct jh7100_clk *clk = jh7100_clk_from(hw); 80 + unsigned long parent = req->best_parent_rate; 81 + unsigned long rate = clamp(req->rate, req->min_rate, req->max_rate); 82 + unsigned long div = min_t(unsigned long, DIV_ROUND_UP(parent, rate), clk->max_div); 83 + unsigned long result = parent / div; 84 + 85 + /* 86 + * we want the result clamped by min_rate and max_rate if possible: 87 + * case 1: div hits the max divider value, which means it's less than 88 + * parent / rate, so the result is greater than rate and min_rate in 89 + * particular. we can't do anything about result > max_rate because the 90 + * divider doesn't go any further. 91 + * case 2: div = DIV_ROUND_UP(parent, rate) which means the result is 92 + * always lower or equal to rate and max_rate. however the result may 93 + * turn out lower than min_rate, but then the next higher rate is fine: 94 + * div - 1 = ceil(parent / rate) - 1 < parent / rate 95 + * and thus 96 + * min_rate <= rate < parent / (div - 1) 97 + */ 98 + if (result < req->min_rate && div > 1) 99 + result = parent / (div - 1); 100 + 101 + req->rate = result; 102 + return 0; 103 + } 104 + 105 + static int jh7100_clk_set_rate(struct clk_hw *hw, 106 + unsigned long rate, 107 + unsigned long parent_rate) 108 + { 109 + struct jh7100_clk *clk = jh7100_clk_from(hw); 110 + unsigned long div = clamp(DIV_ROUND_CLOSEST(parent_rate, rate), 111 + 1UL, (unsigned long)clk->max_div); 112 + 113 + jh7100_clk_reg_rmw(clk, JH7100_CLK_DIV_MASK, div); 114 + return 0; 115 + } 116 + 117 + static unsigned long jh7100_clk_frac_recalc_rate(struct clk_hw *hw, 118 + unsigned long parent_rate) 119 + { 120 + struct jh7100_clk *clk = jh7100_clk_from(hw); 121 + u32 reg = jh7100_clk_reg_get(clk); 122 + unsigned long div100 = 100 * (reg & JH7100_CLK_INT_MASK) + 123 + ((reg & JH7100_CLK_FRAC_MASK) >> JH7100_CLK_FRAC_SHIFT); 124 + 125 + return (div100 >= JH7100_CLK_FRAC_MIN) ? 100 * parent_rate / div100 : 0; 126 + } 127 + 128 + static int jh7100_clk_frac_determine_rate(struct clk_hw *hw, 129 + struct clk_rate_request *req) 130 + { 131 + unsigned long parent100 = 100 * req->best_parent_rate; 132 + unsigned long rate = clamp(req->rate, req->min_rate, req->max_rate); 133 + unsigned long div100 = clamp(DIV_ROUND_CLOSEST(parent100, rate), 134 + JH7100_CLK_FRAC_MIN, JH7100_CLK_FRAC_MAX); 135 + unsigned long result = parent100 / div100; 136 + 137 + /* clamp the result as in jh7100_clk_determine_rate() above */ 138 + if (result > req->max_rate && div100 < JH7100_CLK_FRAC_MAX) 139 + result = parent100 / (div100 + 1); 140 + if (result < req->min_rate && div100 > JH7100_CLK_FRAC_MIN) 141 + result = parent100 / (div100 - 1); 142 + 143 + req->rate = result; 144 + return 0; 145 + } 146 + 147 + static int jh7100_clk_frac_set_rate(struct clk_hw *hw, 148 + unsigned long rate, 149 + unsigned long parent_rate) 150 + { 151 + struct jh7100_clk *clk = jh7100_clk_from(hw); 152 + unsigned long div100 = clamp(DIV_ROUND_CLOSEST(100 * parent_rate, rate), 153 + JH7100_CLK_FRAC_MIN, JH7100_CLK_FRAC_MAX); 154 + u32 value = ((div100 % 100) << JH7100_CLK_FRAC_SHIFT) | (div100 / 100); 155 + 156 + jh7100_clk_reg_rmw(clk, JH7100_CLK_DIV_MASK, value); 157 + return 0; 158 + } 159 + 160 + static u8 jh7100_clk_get_parent(struct clk_hw *hw) 161 + { 162 + struct jh7100_clk *clk = jh7100_clk_from(hw); 163 + u32 value = jh7100_clk_reg_get(clk); 164 + 165 + return (value & JH7100_CLK_MUX_MASK) >> JH7100_CLK_MUX_SHIFT; 166 + } 167 + 168 + static int jh7100_clk_set_parent(struct clk_hw *hw, u8 index) 169 + { 170 + struct jh7100_clk *clk = jh7100_clk_from(hw); 171 + u32 value = (u32)index << JH7100_CLK_MUX_SHIFT; 172 + 173 + jh7100_clk_reg_rmw(clk, JH7100_CLK_MUX_MASK, value); 174 + return 0; 175 + } 176 + 177 + static int jh7100_clk_mux_determine_rate(struct clk_hw *hw, 178 + struct clk_rate_request *req) 179 + { 180 + return clk_mux_determine_rate_flags(hw, req, 0); 181 + } 182 + 183 + static int jh7100_clk_get_phase(struct clk_hw *hw) 184 + { 185 + struct jh7100_clk *clk = jh7100_clk_from(hw); 186 + u32 value = jh7100_clk_reg_get(clk); 187 + 188 + return (value & JH7100_CLK_INVERT) ? 180 : 0; 189 + } 190 + 191 + static int jh7100_clk_set_phase(struct clk_hw *hw, int degrees) 192 + { 193 + struct jh7100_clk *clk = jh7100_clk_from(hw); 194 + u32 value; 195 + 196 + if (degrees == 0) 197 + value = 0; 198 + else if (degrees == 180) 199 + value = JH7100_CLK_INVERT; 200 + else 201 + return -EINVAL; 202 + 203 + jh7100_clk_reg_rmw(clk, JH7100_CLK_INVERT, value); 204 + return 0; 205 + } 206 + 207 + #ifdef CONFIG_DEBUG_FS 208 + static void jh7100_clk_debug_init(struct clk_hw *hw, struct dentry *dentry) 209 + { 210 + static const struct debugfs_reg32 jh7100_clk_reg = { 211 + .name = "CTRL", 212 + .offset = 0, 213 + }; 214 + struct jh7100_clk *clk = jh7100_clk_from(hw); 215 + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); 216 + struct debugfs_regset32 *regset; 217 + 218 + regset = devm_kzalloc(priv->dev, sizeof(*regset), GFP_KERNEL); 219 + if (!regset) 220 + return; 221 + 222 + regset->regs = &jh7100_clk_reg; 223 + regset->nregs = 1; 224 + regset->base = priv->base + 4 * clk->idx; 225 + 226 + debugfs_create_regset32("registers", 0400, dentry, regset); 227 + } 228 + #else 229 + #define jh7100_clk_debug_init NULL 230 + #endif 231 + 232 + static const struct clk_ops jh7100_clk_gate_ops = { 233 + .enable = jh7100_clk_enable, 234 + .disable = jh7100_clk_disable, 235 + .is_enabled = jh7100_clk_is_enabled, 236 + .debug_init = jh7100_clk_debug_init, 237 + }; 238 + 239 + static const struct clk_ops jh7100_clk_div_ops = { 240 + .recalc_rate = jh7100_clk_recalc_rate, 241 + .determine_rate = jh7100_clk_determine_rate, 242 + .set_rate = jh7100_clk_set_rate, 243 + .debug_init = jh7100_clk_debug_init, 244 + }; 245 + 246 + static const struct clk_ops jh7100_clk_fdiv_ops = { 247 + .recalc_rate = jh7100_clk_frac_recalc_rate, 248 + .determine_rate = jh7100_clk_frac_determine_rate, 249 + .set_rate = jh7100_clk_frac_set_rate, 250 + .debug_init = jh7100_clk_debug_init, 251 + }; 252 + 253 + static const struct clk_ops jh7100_clk_gdiv_ops = { 254 + .enable = jh7100_clk_enable, 255 + .disable = jh7100_clk_disable, 256 + .is_enabled = jh7100_clk_is_enabled, 257 + .recalc_rate = jh7100_clk_recalc_rate, 258 + .determine_rate = jh7100_clk_determine_rate, 259 + .set_rate = jh7100_clk_set_rate, 260 + .debug_init = jh7100_clk_debug_init, 261 + }; 262 + 263 + static const struct clk_ops jh7100_clk_mux_ops = { 264 + .determine_rate = jh7100_clk_mux_determine_rate, 265 + .set_parent = jh7100_clk_set_parent, 266 + .get_parent = jh7100_clk_get_parent, 267 + .debug_init = jh7100_clk_debug_init, 268 + }; 269 + 270 + static const struct clk_ops jh7100_clk_gmux_ops = { 271 + .enable = jh7100_clk_enable, 272 + .disable = jh7100_clk_disable, 273 + .is_enabled = jh7100_clk_is_enabled, 274 + .determine_rate = jh7100_clk_mux_determine_rate, 275 + .set_parent = jh7100_clk_set_parent, 276 + .get_parent = jh7100_clk_get_parent, 277 + .debug_init = jh7100_clk_debug_init, 278 + }; 279 + 280 + static const struct clk_ops jh7100_clk_mdiv_ops = { 281 + .recalc_rate = jh7100_clk_recalc_rate, 282 + .determine_rate = jh7100_clk_determine_rate, 283 + .get_parent = jh7100_clk_get_parent, 284 + .set_parent = jh7100_clk_set_parent, 285 + .set_rate = jh7100_clk_set_rate, 286 + .debug_init = jh7100_clk_debug_init, 287 + }; 288 + 289 + static const struct clk_ops jh7100_clk_gmd_ops = { 290 + .enable = jh7100_clk_enable, 291 + .disable = jh7100_clk_disable, 292 + .is_enabled = jh7100_clk_is_enabled, 293 + .recalc_rate = jh7100_clk_recalc_rate, 294 + .determine_rate = jh7100_clk_determine_rate, 295 + .get_parent = jh7100_clk_get_parent, 296 + .set_parent = jh7100_clk_set_parent, 297 + .set_rate = jh7100_clk_set_rate, 298 + .debug_init = jh7100_clk_debug_init, 299 + }; 300 + 301 + static const struct clk_ops jh7100_clk_inv_ops = { 302 + .get_phase = jh7100_clk_get_phase, 303 + .set_phase = jh7100_clk_set_phase, 304 + .debug_init = jh7100_clk_debug_init, 305 + }; 306 + 307 + const struct clk_ops *starfive_jh7100_clk_ops(u32 max) 308 + { 309 + if (max & JH7100_CLK_DIV_MASK) { 310 + if (max & JH7100_CLK_MUX_MASK) { 311 + if (max & JH7100_CLK_ENABLE) 312 + return &jh7100_clk_gmd_ops; 313 + return &jh7100_clk_mdiv_ops; 314 + } 315 + if (max & JH7100_CLK_ENABLE) 316 + return &jh7100_clk_gdiv_ops; 317 + if (max == JH7100_CLK_FRAC_MAX) 318 + return &jh7100_clk_fdiv_ops; 319 + return &jh7100_clk_div_ops; 320 + } 321 + 322 + if (max & JH7100_CLK_MUX_MASK) { 323 + if (max & JH7100_CLK_ENABLE) 324 + return &jh7100_clk_gmux_ops; 325 + return &jh7100_clk_mux_ops; 326 + } 327 + 328 + if (max & JH7100_CLK_ENABLE) 329 + return &jh7100_clk_gate_ops; 330 + 331 + return &jh7100_clk_inv_ops; 332 + } 333 + EXPORT_SYMBOL_GPL(starfive_jh7100_clk_ops);