12e62246bSMatti Vaittinen // SPDX-License-Identifier: GPL-2.0 22e62246bSMatti Vaittinen // Copyright (C) 2018 ROHM Semiconductors 32e62246bSMatti Vaittinen 42e62246bSMatti Vaittinen #include <linux/kernel.h> 52e62246bSMatti Vaittinen #include <linux/module.h> 62e62246bSMatti Vaittinen #include <linux/init.h> 72e62246bSMatti Vaittinen #include <linux/err.h> 82e62246bSMatti Vaittinen #include <linux/platform_device.h> 92e62246bSMatti Vaittinen #include <linux/slab.h> 102e62246bSMatti Vaittinen #include <linux/mfd/rohm-bd718x7.h> 110dae7f58SMatti Vaittinen #include <linux/mfd/rohm-bd70528.h> 122e62246bSMatti Vaittinen #include <linux/clk-provider.h> 132e62246bSMatti Vaittinen #include <linux/clkdev.h> 142e62246bSMatti Vaittinen #include <linux/regmap.h> 152e62246bSMatti Vaittinen 162e62246bSMatti Vaittinen struct bd718xx_clk { 172e62246bSMatti Vaittinen struct clk_hw hw; 182e62246bSMatti Vaittinen u8 reg; 192e62246bSMatti Vaittinen u8 mask; 202e62246bSMatti Vaittinen struct platform_device *pdev; 212a6a7aacSMatti Vaittinen struct rohm_regmap_dev *mfd; 222e62246bSMatti Vaittinen }; 232e62246bSMatti Vaittinen 242e62246bSMatti Vaittinen static int bd71837_clk_set(struct clk_hw *hw, int status) 252e62246bSMatti Vaittinen { 262e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 272e62246bSMatti Vaittinen 282e62246bSMatti Vaittinen return regmap_update_bits(c->mfd->regmap, c->reg, c->mask, status); 292e62246bSMatti Vaittinen } 302e62246bSMatti Vaittinen 312e62246bSMatti Vaittinen static void bd71837_clk_disable(struct clk_hw *hw) 322e62246bSMatti Vaittinen { 332e62246bSMatti Vaittinen int rv; 342e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 352e62246bSMatti Vaittinen 362e62246bSMatti Vaittinen rv = bd71837_clk_set(hw, 0); 372e62246bSMatti Vaittinen if (rv) 382e62246bSMatti Vaittinen dev_dbg(&c->pdev->dev, "Failed to disable 32K clk (%d)\n", rv); 392e62246bSMatti Vaittinen } 402e62246bSMatti Vaittinen 412e62246bSMatti Vaittinen static int bd71837_clk_enable(struct clk_hw *hw) 422e62246bSMatti Vaittinen { 432e62246bSMatti Vaittinen return bd71837_clk_set(hw, 1); 442e62246bSMatti Vaittinen } 452e62246bSMatti Vaittinen 462e62246bSMatti Vaittinen static int bd71837_clk_is_enabled(struct clk_hw *hw) 472e62246bSMatti Vaittinen { 482e62246bSMatti Vaittinen int enabled; 492e62246bSMatti Vaittinen int rval; 502e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 512e62246bSMatti Vaittinen 522e62246bSMatti Vaittinen rval = regmap_read(c->mfd->regmap, c->reg, &enabled); 532e62246bSMatti Vaittinen 542e62246bSMatti Vaittinen if (rval) 552e62246bSMatti Vaittinen return rval; 562e62246bSMatti Vaittinen 572e62246bSMatti Vaittinen return enabled & c->mask; 582e62246bSMatti Vaittinen } 592e62246bSMatti Vaittinen 602e62246bSMatti Vaittinen static const struct clk_ops bd71837_clk_ops = { 612e62246bSMatti Vaittinen .prepare = &bd71837_clk_enable, 622e62246bSMatti Vaittinen .unprepare = &bd71837_clk_disable, 632e62246bSMatti Vaittinen .is_prepared = &bd71837_clk_is_enabled, 642e62246bSMatti Vaittinen }; 652e62246bSMatti Vaittinen 662e62246bSMatti Vaittinen static int bd71837_clk_probe(struct platform_device *pdev) 672e62246bSMatti Vaittinen { 682e62246bSMatti Vaittinen struct bd718xx_clk *c; 692e62246bSMatti Vaittinen int rval = -ENOMEM; 702e62246bSMatti Vaittinen const char *parent_clk; 712e62246bSMatti Vaittinen struct device *parent = pdev->dev.parent; 722a6a7aacSMatti Vaittinen struct rohm_regmap_dev *mfd = dev_get_drvdata(parent); 732e62246bSMatti Vaittinen struct clk_init_data init = { 742e62246bSMatti Vaittinen .name = "bd718xx-32k-out", 752e62246bSMatti Vaittinen .ops = &bd71837_clk_ops, 762e62246bSMatti Vaittinen }; 772e62246bSMatti Vaittinen 782e62246bSMatti Vaittinen c = devm_kzalloc(&pdev->dev, sizeof(*c), GFP_KERNEL); 792e62246bSMatti Vaittinen if (!c) 802e62246bSMatti Vaittinen return -ENOMEM; 812e62246bSMatti Vaittinen 822e62246bSMatti Vaittinen init.num_parents = 1; 832e62246bSMatti Vaittinen parent_clk = of_clk_get_parent_name(parent->of_node, 0); 842e62246bSMatti Vaittinen 852e62246bSMatti Vaittinen init.parent_names = &parent_clk; 862e62246bSMatti Vaittinen if (!parent_clk) { 872e62246bSMatti Vaittinen dev_err(&pdev->dev, "No parent clk found\n"); 882e62246bSMatti Vaittinen return -EINVAL; 892e62246bSMatti Vaittinen } 900dae7f58SMatti Vaittinen switch (mfd->chip_type) { 910dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71837: 920dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71847: 932e62246bSMatti Vaittinen c->reg = BD718XX_REG_OUT32K; 942e62246bSMatti Vaittinen c->mask = BD718XX_OUT32K_EN; 950dae7f58SMatti Vaittinen break; 960dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD70528: 970dae7f58SMatti Vaittinen c->reg = BD70528_REG_CLK_OUT; 980dae7f58SMatti Vaittinen c->mask = BD70528_CLK_OUT_EN_MASK; 990dae7f58SMatti Vaittinen break; 1000dae7f58SMatti Vaittinen default: 1010dae7f58SMatti Vaittinen dev_err(&pdev->dev, "Unknown clk chip\n"); 1020dae7f58SMatti Vaittinen return -EINVAL; 1030dae7f58SMatti Vaittinen } 1042e62246bSMatti Vaittinen c->mfd = mfd; 1052e62246bSMatti Vaittinen c->pdev = pdev; 1062e62246bSMatti Vaittinen c->hw.init = &init; 1072e62246bSMatti Vaittinen 1082e62246bSMatti Vaittinen of_property_read_string_index(parent->of_node, 1092e62246bSMatti Vaittinen "clock-output-names", 0, &init.name); 1102e62246bSMatti Vaittinen 1112e62246bSMatti Vaittinen rval = devm_clk_hw_register(&pdev->dev, &c->hw); 1122e62246bSMatti Vaittinen if (rval) { 1132e62246bSMatti Vaittinen dev_err(&pdev->dev, "failed to register 32K clk"); 1142e62246bSMatti Vaittinen return rval; 1152e62246bSMatti Vaittinen } 1162e62246bSMatti Vaittinen rval = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_simple_get, 1172e62246bSMatti Vaittinen &c->hw); 1182e62246bSMatti Vaittinen if (rval) 1192e62246bSMatti Vaittinen dev_err(&pdev->dev, "adding clk provider failed\n"); 1202e62246bSMatti Vaittinen 1212e62246bSMatti Vaittinen return rval; 1222e62246bSMatti Vaittinen } 1232e62246bSMatti Vaittinen 1242e62246bSMatti Vaittinen static struct platform_driver bd71837_clk = { 1252e62246bSMatti Vaittinen .driver = { 1262e62246bSMatti Vaittinen .name = "bd718xx-clk", 1272e62246bSMatti Vaittinen }, 1282e62246bSMatti Vaittinen .probe = bd71837_clk_probe, 1292e62246bSMatti Vaittinen }; 1302e62246bSMatti Vaittinen 1312e62246bSMatti Vaittinen module_platform_driver(bd71837_clk); 1322e62246bSMatti Vaittinen 1332e62246bSMatti Vaittinen MODULE_AUTHOR("Matti Vaittinen <matti.vaittinen@fi.rohmeurope.com>"); 1340dae7f58SMatti Vaittinen MODULE_DESCRIPTION("BD71837/BD71847/BD70528 chip clk driver"); 1352e62246bSMatti Vaittinen MODULE_LICENSE("GPL"); 136