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> 112e62246bSMatti Vaittinen #include <linux/clk-provider.h> 122e62246bSMatti Vaittinen #include <linux/clkdev.h> 132e62246bSMatti Vaittinen #include <linux/regmap.h> 142e62246bSMatti Vaittinen 152e62246bSMatti Vaittinen struct bd718xx_clk { 162e62246bSMatti Vaittinen struct clk_hw hw; 172e62246bSMatti Vaittinen u8 reg; 182e62246bSMatti Vaittinen u8 mask; 192e62246bSMatti Vaittinen struct platform_device *pdev; 202e62246bSMatti Vaittinen struct bd718xx *mfd; 212e62246bSMatti Vaittinen }; 222e62246bSMatti Vaittinen 232e62246bSMatti Vaittinen static int bd71837_clk_set(struct clk_hw *hw, int status) 242e62246bSMatti Vaittinen { 252e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 262e62246bSMatti Vaittinen 272e62246bSMatti Vaittinen return regmap_update_bits(c->mfd->regmap, c->reg, c->mask, status); 282e62246bSMatti Vaittinen } 292e62246bSMatti Vaittinen 302e62246bSMatti Vaittinen static void bd71837_clk_disable(struct clk_hw *hw) 312e62246bSMatti Vaittinen { 322e62246bSMatti Vaittinen int rv; 332e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 342e62246bSMatti Vaittinen 352e62246bSMatti Vaittinen rv = bd71837_clk_set(hw, 0); 362e62246bSMatti Vaittinen if (rv) 372e62246bSMatti Vaittinen dev_dbg(&c->pdev->dev, "Failed to disable 32K clk (%d)\n", rv); 382e62246bSMatti Vaittinen } 392e62246bSMatti Vaittinen 402e62246bSMatti Vaittinen static int bd71837_clk_enable(struct clk_hw *hw) 412e62246bSMatti Vaittinen { 422e62246bSMatti Vaittinen return bd71837_clk_set(hw, 1); 432e62246bSMatti Vaittinen } 442e62246bSMatti Vaittinen 452e62246bSMatti Vaittinen static int bd71837_clk_is_enabled(struct clk_hw *hw) 462e62246bSMatti Vaittinen { 472e62246bSMatti Vaittinen int enabled; 482e62246bSMatti Vaittinen int rval; 492e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw); 502e62246bSMatti Vaittinen 512e62246bSMatti Vaittinen rval = regmap_read(c->mfd->regmap, c->reg, &enabled); 522e62246bSMatti Vaittinen 532e62246bSMatti Vaittinen if (rval) 542e62246bSMatti Vaittinen return rval; 552e62246bSMatti Vaittinen 562e62246bSMatti Vaittinen return enabled & c->mask; 572e62246bSMatti Vaittinen } 582e62246bSMatti Vaittinen 592e62246bSMatti Vaittinen static const struct clk_ops bd71837_clk_ops = { 602e62246bSMatti Vaittinen .prepare = &bd71837_clk_enable, 612e62246bSMatti Vaittinen .unprepare = &bd71837_clk_disable, 622e62246bSMatti Vaittinen .is_prepared = &bd71837_clk_is_enabled, 632e62246bSMatti Vaittinen }; 642e62246bSMatti Vaittinen 652e62246bSMatti Vaittinen static int bd71837_clk_probe(struct platform_device *pdev) 662e62246bSMatti Vaittinen { 672e62246bSMatti Vaittinen struct bd718xx_clk *c; 682e62246bSMatti Vaittinen int rval = -ENOMEM; 692e62246bSMatti Vaittinen const char *parent_clk; 702e62246bSMatti Vaittinen struct device *parent = pdev->dev.parent; 712e62246bSMatti Vaittinen struct bd718xx *mfd = dev_get_drvdata(parent); 722e62246bSMatti Vaittinen struct clk_init_data init = { 732e62246bSMatti Vaittinen .name = "bd718xx-32k-out", 742e62246bSMatti Vaittinen .ops = &bd71837_clk_ops, 752e62246bSMatti Vaittinen }; 762e62246bSMatti Vaittinen 772e62246bSMatti Vaittinen c = devm_kzalloc(&pdev->dev, sizeof(*c), GFP_KERNEL); 782e62246bSMatti Vaittinen if (!c) 792e62246bSMatti Vaittinen return -ENOMEM; 802e62246bSMatti Vaittinen 812e62246bSMatti Vaittinen init.num_parents = 1; 822e62246bSMatti Vaittinen parent_clk = of_clk_get_parent_name(parent->of_node, 0); 832e62246bSMatti Vaittinen 842e62246bSMatti Vaittinen init.parent_names = &parent_clk; 852e62246bSMatti Vaittinen if (!parent_clk) { 862e62246bSMatti Vaittinen dev_err(&pdev->dev, "No parent clk found\n"); 872e62246bSMatti Vaittinen return -EINVAL; 882e62246bSMatti Vaittinen } 892e62246bSMatti Vaittinen 902e62246bSMatti Vaittinen c->reg = BD718XX_REG_OUT32K; 912e62246bSMatti Vaittinen c->mask = BD718XX_OUT32K_EN; 922e62246bSMatti Vaittinen c->mfd = mfd; 932e62246bSMatti Vaittinen c->pdev = pdev; 942e62246bSMatti Vaittinen c->hw.init = &init; 952e62246bSMatti Vaittinen 962e62246bSMatti Vaittinen of_property_read_string_index(parent->of_node, 972e62246bSMatti Vaittinen "clock-output-names", 0, &init.name); 982e62246bSMatti Vaittinen 992e62246bSMatti Vaittinen rval = devm_clk_hw_register(&pdev->dev, &c->hw); 1002e62246bSMatti Vaittinen if (rval) { 1012e62246bSMatti Vaittinen dev_err(&pdev->dev, "failed to register 32K clk"); 1022e62246bSMatti Vaittinen return rval; 1032e62246bSMatti Vaittinen } 1042e62246bSMatti Vaittinen rval = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_simple_get, 1052e62246bSMatti Vaittinen &c->hw); 1062e62246bSMatti Vaittinen if (rval) 1072e62246bSMatti Vaittinen dev_err(&pdev->dev, "adding clk provider failed\n"); 1082e62246bSMatti Vaittinen 1092e62246bSMatti Vaittinen return rval; 1102e62246bSMatti Vaittinen } 1112e62246bSMatti Vaittinen 1122e62246bSMatti Vaittinen static struct platform_driver bd71837_clk = { 1132e62246bSMatti Vaittinen .driver = { 1142e62246bSMatti Vaittinen .name = "bd718xx-clk", 1152e62246bSMatti Vaittinen }, 1162e62246bSMatti Vaittinen .probe = bd71837_clk_probe, 1172e62246bSMatti Vaittinen }; 1182e62246bSMatti Vaittinen 1192e62246bSMatti Vaittinen module_platform_driver(bd71837_clk); 1202e62246bSMatti Vaittinen 1212e62246bSMatti Vaittinen MODULE_AUTHOR("Matti Vaittinen <matti.vaittinen@fi.rohmeurope.com>"); 1222e62246bSMatti Vaittinen MODULE_DESCRIPTION("BD71837 chip clk driver"); 1232e62246bSMatti Vaittinen MODULE_LICENSE("GPL"); 124