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 */ 16ae866decSMatti Vaittinen /* BD70528 */ 17ae866decSMatti Vaittinen #define BD70528_REG_OUT32K 0x2c 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 /* 24ae866decSMatti Vaittinen * BD71837, BD71847, BD70528 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; 342a6a7aacSMatti Vaittinen struct rohm_regmap_dev *mfd; 352e62246bSMatti Vaittinen }; 362e62246bSMatti Vaittinen 37ae866decSMatti Vaittinen static int bd71837_clk_set(struct bd718xx_clk *c, unsigned int status) 382e62246bSMatti Vaittinen { 392e62246bSMatti Vaittinen return regmap_update_bits(c->mfd->regmap, c->reg, c->mask, status); 402e62246bSMatti Vaittinen } 412e62246bSMatti Vaittinen 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 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 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 652e62246bSMatti Vaittinen rval = regmap_read(c->mfd->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 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; 852a6a7aacSMatti Vaittinen struct rohm_regmap_dev *mfd = dev_get_drvdata(parent); 862e62246bSMatti Vaittinen struct clk_init_data init = { 872e62246bSMatti Vaittinen .name = "bd718xx-32k-out", 882e62246bSMatti Vaittinen .ops = &bd71837_clk_ops, 892e62246bSMatti Vaittinen }; 901b1c26b2SMatti Vaittinen enum rohm_chip_type chip = platform_get_device_id(pdev)->driver_data; 912e62246bSMatti Vaittinen 922e62246bSMatti Vaittinen c = devm_kzalloc(&pdev->dev, sizeof(*c), GFP_KERNEL); 932e62246bSMatti Vaittinen if (!c) 942e62246bSMatti Vaittinen return -ENOMEM; 952e62246bSMatti Vaittinen 962e62246bSMatti Vaittinen init.num_parents = 1; 972e62246bSMatti Vaittinen parent_clk = of_clk_get_parent_name(parent->of_node, 0); 982e62246bSMatti Vaittinen 992e62246bSMatti Vaittinen init.parent_names = &parent_clk; 1002e62246bSMatti Vaittinen if (!parent_clk) { 1012e62246bSMatti Vaittinen dev_err(&pdev->dev, "No parent clk found\n"); 1022e62246bSMatti Vaittinen return -EINVAL; 1032e62246bSMatti Vaittinen } 1041b1c26b2SMatti Vaittinen switch (chip) { 1050dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71837: 1060dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD71847: 1072e62246bSMatti Vaittinen c->reg = BD718XX_REG_OUT32K; 108ae866decSMatti Vaittinen c->mask = CLK_OUT_EN_MASK; 109ae866decSMatti Vaittinen break; 110ae866decSMatti Vaittinen case ROHM_CHIP_TYPE_BD71828: 111ae866decSMatti Vaittinen c->reg = BD71828_REG_OUT32K; 112ae866decSMatti Vaittinen c->mask = CLK_OUT_EN_MASK; 1130dae7f58SMatti Vaittinen break; 1140dae7f58SMatti Vaittinen case ROHM_CHIP_TYPE_BD70528: 115ae866decSMatti Vaittinen c->reg = BD70528_REG_OUT32K; 116ae866decSMatti Vaittinen c->mask = CLK_OUT_EN_MASK; 1170dae7f58SMatti Vaittinen break; 1180dae7f58SMatti Vaittinen default: 1190dae7f58SMatti Vaittinen dev_err(&pdev->dev, "Unknown clk chip\n"); 1200dae7f58SMatti Vaittinen return -EINVAL; 1210dae7f58SMatti Vaittinen } 1222e62246bSMatti Vaittinen c->mfd = mfd; 1232e62246bSMatti Vaittinen c->pdev = pdev; 1242e62246bSMatti Vaittinen c->hw.init = &init; 1252e62246bSMatti Vaittinen 1262e62246bSMatti Vaittinen of_property_read_string_index(parent->of_node, 1272e62246bSMatti Vaittinen "clock-output-names", 0, &init.name); 1282e62246bSMatti Vaittinen 1292e62246bSMatti Vaittinen rval = devm_clk_hw_register(&pdev->dev, &c->hw); 1302e62246bSMatti Vaittinen if (rval) { 1312e62246bSMatti Vaittinen dev_err(&pdev->dev, "failed to register 32K clk"); 1322e62246bSMatti Vaittinen return rval; 1332e62246bSMatti Vaittinen } 1342e62246bSMatti Vaittinen rval = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_simple_get, 1352e62246bSMatti Vaittinen &c->hw); 1362e62246bSMatti Vaittinen if (rval) 1372e62246bSMatti Vaittinen dev_err(&pdev->dev, "adding clk provider failed\n"); 1382e62246bSMatti Vaittinen 1392e62246bSMatti Vaittinen return rval; 1402e62246bSMatti Vaittinen } 1412e62246bSMatti Vaittinen 1421b1c26b2SMatti Vaittinen static const struct platform_device_id bd718x7_clk_id[] = { 1431b1c26b2SMatti Vaittinen { "bd71837-clk", ROHM_CHIP_TYPE_BD71837 }, 1441b1c26b2SMatti Vaittinen { "bd71847-clk", ROHM_CHIP_TYPE_BD71847 }, 1451b1c26b2SMatti Vaittinen { "bd70528-clk", ROHM_CHIP_TYPE_BD70528 }, 146ae866decSMatti Vaittinen { "bd71828-clk", ROHM_CHIP_TYPE_BD71828 }, 1471b1c26b2SMatti Vaittinen { }, 1481b1c26b2SMatti Vaittinen }; 1491b1c26b2SMatti Vaittinen MODULE_DEVICE_TABLE(platform, bd718x7_clk_id); 1501b1c26b2SMatti Vaittinen 1512e62246bSMatti Vaittinen static struct platform_driver bd71837_clk = { 1522e62246bSMatti Vaittinen .driver = { 1532e62246bSMatti Vaittinen .name = "bd718xx-clk", 1542e62246bSMatti Vaittinen }, 1552e62246bSMatti Vaittinen .probe = bd71837_clk_probe, 1561b1c26b2SMatti Vaittinen .id_table = bd718x7_clk_id, 1572e62246bSMatti Vaittinen }; 1582e62246bSMatti Vaittinen 1592e62246bSMatti Vaittinen module_platform_driver(bd71837_clk); 1602e62246bSMatti Vaittinen 1612e62246bSMatti Vaittinen MODULE_AUTHOR("Matti Vaittinen <matti.vaittinen@fi.rohmeurope.com>"); 1620dae7f58SMatti Vaittinen MODULE_DESCRIPTION("BD71837/BD71847/BD70528 chip clk driver"); 1632e62246bSMatti Vaittinen MODULE_LICENSE("GPL"); 1648ad1193eSGuido Günther MODULE_ALIAS("platform:bd718xx-clk"); 165