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>
10ae866decSMatti Vaittinen #include <linux/mfd/rohm-generic.h>
112e62246bSMatti Vaittinen #include <linux/clk-provider.h>
122e62246bSMatti Vaittinen #include <linux/clkdev.h>
132e62246bSMatti Vaittinen #include <linux/regmap.h>
142e62246bSMatti Vaittinen
15ae866decSMatti Vaittinen /* clk control registers */
1642391f7eSMatti Vaittinen /* BD71815 */
1742391f7eSMatti Vaittinen #define BD71815_REG_OUT32K 0x1d
18ae866decSMatti Vaittinen /* BD71828 */
19ae866decSMatti Vaittinen #define BD71828_REG_OUT32K 0x4B
20ae866decSMatti Vaittinen /* BD71837 and BD71847 */
21ae866decSMatti Vaittinen #define BD718XX_REG_OUT32K 0x2E
22ae866decSMatti Vaittinen
23ae866decSMatti Vaittinen /*
24*fa5b6541SMatti Vaittinen * BD71837, BD71847, and BD71828 all use bit [0] to clk output control
25ae866decSMatti Vaittinen */
26ae866decSMatti Vaittinen #define CLK_OUT_EN_MASK BIT(0)
27ae866decSMatti Vaittinen
28ae866decSMatti Vaittinen
292e62246bSMatti Vaittinen struct bd718xx_clk {
302e62246bSMatti Vaittinen struct clk_hw hw;
312e62246bSMatti Vaittinen u8 reg;
322e62246bSMatti Vaittinen u8 mask;
332e62246bSMatti Vaittinen struct platform_device *pdev;
34ddddfafdSMatti Vaittinen struct regmap *regmap;
352e62246bSMatti Vaittinen };
362e62246bSMatti Vaittinen
bd71837_clk_set(struct bd718xx_clk * c,unsigned int status)37ae866decSMatti Vaittinen static int bd71837_clk_set(struct bd718xx_clk *c, unsigned int status)
382e62246bSMatti Vaittinen {
39ddddfafdSMatti Vaittinen return regmap_update_bits(c->regmap, c->reg, c->mask, status);
402e62246bSMatti Vaittinen }
412e62246bSMatti Vaittinen
bd71837_clk_disable(struct clk_hw * hw)422e62246bSMatti Vaittinen static void bd71837_clk_disable(struct clk_hw *hw)
432e62246bSMatti Vaittinen {
442e62246bSMatti Vaittinen int rv;
452e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw);
462e62246bSMatti Vaittinen
47ae866decSMatti Vaittinen rv = bd71837_clk_set(c, 0);
482e62246bSMatti Vaittinen if (rv)
492e62246bSMatti Vaittinen dev_dbg(&c->pdev->dev, "Failed to disable 32K clk (%d)\n", rv);
502e62246bSMatti Vaittinen }
512e62246bSMatti Vaittinen
bd71837_clk_enable(struct clk_hw * hw)522e62246bSMatti Vaittinen static int bd71837_clk_enable(struct clk_hw *hw)
532e62246bSMatti Vaittinen {
54ae866decSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw);
55ae866decSMatti Vaittinen
56ae866decSMatti Vaittinen return bd71837_clk_set(c, 0xffffffff);
572e62246bSMatti Vaittinen }
582e62246bSMatti Vaittinen
bd71837_clk_is_enabled(struct clk_hw * hw)592e62246bSMatti Vaittinen static int bd71837_clk_is_enabled(struct clk_hw *hw)
602e62246bSMatti Vaittinen {
612e62246bSMatti Vaittinen int enabled;
622e62246bSMatti Vaittinen int rval;
632e62246bSMatti Vaittinen struct bd718xx_clk *c = container_of(hw, struct bd718xx_clk, hw);
642e62246bSMatti Vaittinen
65ddddfafdSMatti Vaittinen rval = regmap_read(c->regmap, c->reg, &enabled);
662e62246bSMatti Vaittinen
672e62246bSMatti Vaittinen if (rval)
682e62246bSMatti Vaittinen return rval;
692e62246bSMatti Vaittinen
702e62246bSMatti Vaittinen return enabled & c->mask;
712e62246bSMatti Vaittinen }
722e62246bSMatti Vaittinen
732e62246bSMatti Vaittinen static const struct clk_ops bd71837_clk_ops = {
742e62246bSMatti Vaittinen .prepare = &bd71837_clk_enable,
752e62246bSMatti Vaittinen .unprepare = &bd71837_clk_disable,
762e62246bSMatti Vaittinen .is_prepared = &bd71837_clk_is_enabled,
772e62246bSMatti Vaittinen };
782e62246bSMatti Vaittinen
bd71837_clk_probe(struct platform_device * pdev)792e62246bSMatti Vaittinen static int bd71837_clk_probe(struct platform_device *pdev)
802e62246bSMatti Vaittinen {
812e62246bSMatti Vaittinen struct bd718xx_clk *c;
822e62246bSMatti Vaittinen int rval = -ENOMEM;
832e62246bSMatti Vaittinen const char *parent_clk;
842e62246bSMatti Vaittinen struct device *parent = pdev->dev.parent;
852e62246bSMatti Vaittinen struct clk_init_data init = {
862e62246bSMatti Vaittinen .name = "bd718xx-32k-out",
872e62246bSMatti Vaittinen .ops = &bd71837_clk_ops,
882e62246bSMatti Vaittinen };
891b1c26b2SMatti Vaittinen enum rohm_chip_type chip = platform_get_device_id(pdev)->driver_data;
902e62246bSMatti Vaittinen
912e62246bSMatti Vaittinen c = devm_kzalloc(&pdev->dev, sizeof(*c), GFP_KERNEL);
922e62246bSMatti Vaittinen if (!c)
932e62246bSMatti Vaittinen return -ENOMEM;
942e62246bSMatti Vaittinen
95ddddfafdSMatti Vaittinen c->regmap = dev_get_regmap(pdev->dev.parent, NULL);
96ddddfafdSMatti Vaittinen if (!c->regmap)
97ddddfafdSMatti Vaittinen return -ENODEV;
98ddddfafdSMatti Vaittinen
992e62246bSMatti Vaittinen init.num_parents = 1;
1002e62246bSMatti Vaittinen parent_clk = of_clk_get_parent_name(parent->of_node, 0);
1012e62246bSMatti Vaittinen
1022e62246bSMatti Vaittinen init.parent_names = &parent_clk;
1032e62246bSMatti Vaittinen if (!parent_clk) {
1042e62246bSMatti Vaittinen dev_err(&pdev->dev, "No parent clk found\n");
1052e62246bSMatti Vaittinen return -EINVAL;
1062e62246bSMatti Vaittinen }
1071b1c26b2SMatti Vaittinen switch (chip) {
1080dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71837:
1090dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71847:
1102e62246bSMatti Vaittinen c->reg = BD718XX_REG_OUT32K;
111ae866decSMatti Vaittinen c->mask = CLK_OUT_EN_MASK;
112ae866decSMatti Vaittinen break;
113ae866decSMatti Vaittinen case ROHM_CHIP_TYPE_BD71828:
114ae866decSMatti Vaittinen c->reg = BD71828_REG_OUT32K;
115ae866decSMatti Vaittinen c->mask = CLK_OUT_EN_MASK;
1160dae7f58SMatti Vaittinen break;
11742391f7eSMatti Vaittinen case ROHM_CHIP_TYPE_BD71815:
11842391f7eSMatti Vaittinen c->reg = BD71815_REG_OUT32K;
11942391f7eSMatti Vaittinen c->mask = CLK_OUT_EN_MASK;
12042391f7eSMatti Vaittinen break;
1210dae7f58SMatti Vaittinen default:
1220dae7f58SMatti Vaittinen dev_err(&pdev->dev, "Unknown clk chip\n");
1230dae7f58SMatti Vaittinen return -EINVAL;
1240dae7f58SMatti Vaittinen }
1252e62246bSMatti Vaittinen c->pdev = pdev;
1262e62246bSMatti Vaittinen c->hw.init = &init;
1272e62246bSMatti Vaittinen
1282e62246bSMatti Vaittinen of_property_read_string_index(parent->of_node,
1292e62246bSMatti Vaittinen "clock-output-names", 0, &init.name);
1302e62246bSMatti Vaittinen
1312e62246bSMatti Vaittinen rval = devm_clk_hw_register(&pdev->dev, &c->hw);
1322e62246bSMatti Vaittinen if (rval) {
1332e62246bSMatti Vaittinen dev_err(&pdev->dev, "failed to register 32K clk");
1342e62246bSMatti Vaittinen return rval;
1352e62246bSMatti Vaittinen }
1362e62246bSMatti Vaittinen rval = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_simple_get,
1372e62246bSMatti Vaittinen &c->hw);
1382e62246bSMatti Vaittinen if (rval)
1392e62246bSMatti Vaittinen dev_err(&pdev->dev, "adding clk provider failed\n");
1402e62246bSMatti Vaittinen
1412e62246bSMatti Vaittinen return rval;
1422e62246bSMatti Vaittinen }
1432e62246bSMatti Vaittinen
1441b1c26b2SMatti Vaittinen static const struct platform_device_id bd718x7_clk_id[] = {
1451b1c26b2SMatti Vaittinen { "bd71837-clk", ROHM_CHIP_TYPE_BD71837 },
1461b1c26b2SMatti Vaittinen { "bd71847-clk", ROHM_CHIP_TYPE_BD71847 },
147ae866decSMatti Vaittinen { "bd71828-clk", ROHM_CHIP_TYPE_BD71828 },
14842391f7eSMatti Vaittinen { "bd71815-clk", ROHM_CHIP_TYPE_BD71815 },
1491b1c26b2SMatti Vaittinen { },
1501b1c26b2SMatti Vaittinen };
1511b1c26b2SMatti Vaittinen MODULE_DEVICE_TABLE(platform, bd718x7_clk_id);
1521b1c26b2SMatti Vaittinen
1532e62246bSMatti Vaittinen static struct platform_driver bd71837_clk = {
1542e62246bSMatti Vaittinen .driver = {
1552e62246bSMatti Vaittinen .name = "bd718xx-clk",
1562e62246bSMatti Vaittinen },
1572e62246bSMatti Vaittinen .probe = bd71837_clk_probe,
1581b1c26b2SMatti Vaittinen .id_table = bd718x7_clk_id,
1592e62246bSMatti Vaittinen };
1602e62246bSMatti Vaittinen
1612e62246bSMatti Vaittinen module_platform_driver(bd71837_clk);
1622e62246bSMatti Vaittinen
1632e62246bSMatti Vaittinen MODULE_AUTHOR("Matti Vaittinen <matti.vaittinen@fi.rohmeurope.com>");
164*fa5b6541SMatti Vaittinen MODULE_DESCRIPTION("BD718(15/18/28/37/47/50) and chip clk driver");
1652e62246bSMatti Vaittinen MODULE_LICENSE("GPL");
1668ad1193eSGuido Günther MODULE_ALIAS("platform:bd718xx-clk");
167