16a369c58STero Kristo /* 26a369c58STero Kristo * TI Multiplexer Clock 36a369c58STero Kristo * 46a369c58STero Kristo * Copyright (C) 2013 Texas Instruments, Inc. 56a369c58STero Kristo * 66a369c58STero Kristo * Tero Kristo <t-kristo@ti.com> 76a369c58STero Kristo * 86a369c58STero Kristo * This program is free software; you can redistribute it and/or modify 96a369c58STero Kristo * it under the terms of the GNU General Public License version 2 as 106a369c58STero Kristo * published by the Free Software Foundation. 116a369c58STero Kristo * 126a369c58STero Kristo * This program is distributed "as is" WITHOUT ANY WARRANTY of any 136a369c58STero Kristo * kind, whether express or implied; without even the implied warranty 146a369c58STero Kristo * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 156a369c58STero Kristo * GNU General Public License for more details. 166a369c58STero Kristo */ 176a369c58STero Kristo 186a369c58STero Kristo #include <linux/clk-provider.h> 196a369c58STero Kristo #include <linux/slab.h> 206a369c58STero Kristo #include <linux/err.h> 216a369c58STero Kristo #include <linux/of.h> 226a369c58STero Kristo #include <linux/of_address.h> 236a369c58STero Kristo #include <linux/clk/ti.h> 24*7c18a65cSTero Kristo #include "clock.h" 256a369c58STero Kristo 266a369c58STero Kristo #undef pr_fmt 276a369c58STero Kristo #define pr_fmt(fmt) "%s: " fmt, __func__ 286a369c58STero Kristo 296a369c58STero Kristo #define to_clk_mux(_hw) container_of(_hw, struct clk_mux, hw) 306a369c58STero Kristo 316a369c58STero Kristo static u8 ti_clk_mux_get_parent(struct clk_hw *hw) 326a369c58STero Kristo { 336a369c58STero Kristo struct clk_mux *mux = to_clk_mux(hw); 346a369c58STero Kristo int num_parents = __clk_get_num_parents(hw->clk); 356a369c58STero Kristo u32 val; 366a369c58STero Kristo 376a369c58STero Kristo /* 386a369c58STero Kristo * FIXME need a mux-specific flag to determine if val is bitwise or 396a369c58STero Kristo * numeric. e.g. sys_clkin_ck's clksel field is 3 bits wide, but ranges 406a369c58STero Kristo * from 0x1 to 0x7 (index starts at one) 416a369c58STero Kristo * OTOH, pmd_trace_clk_mux_ck uses a separate bit for each clock, so 426a369c58STero Kristo * val = 0x4 really means "bit 2, index starts at bit 0" 436a369c58STero Kristo */ 446a369c58STero Kristo val = ti_clk_ll_ops->clk_readl(mux->reg) >> mux->shift; 456a369c58STero Kristo val &= mux->mask; 466a369c58STero Kristo 476a369c58STero Kristo if (mux->table) { 486a369c58STero Kristo int i; 496a369c58STero Kristo 506a369c58STero Kristo for (i = 0; i < num_parents; i++) 516a369c58STero Kristo if (mux->table[i] == val) 526a369c58STero Kristo return i; 536a369c58STero Kristo return -EINVAL; 546a369c58STero Kristo } 556a369c58STero Kristo 566a369c58STero Kristo if (val && (mux->flags & CLK_MUX_INDEX_BIT)) 576a369c58STero Kristo val = ffs(val) - 1; 586a369c58STero Kristo 596a369c58STero Kristo if (val && (mux->flags & CLK_MUX_INDEX_ONE)) 606a369c58STero Kristo val--; 616a369c58STero Kristo 626a369c58STero Kristo if (val >= num_parents) 636a369c58STero Kristo return -EINVAL; 646a369c58STero Kristo 656a369c58STero Kristo return val; 666a369c58STero Kristo } 676a369c58STero Kristo 686a369c58STero Kristo static int ti_clk_mux_set_parent(struct clk_hw *hw, u8 index) 696a369c58STero Kristo { 706a369c58STero Kristo struct clk_mux *mux = to_clk_mux(hw); 716a369c58STero Kristo u32 val; 726a369c58STero Kristo unsigned long flags = 0; 736a369c58STero Kristo 746a369c58STero Kristo if (mux->table) { 756a369c58STero Kristo index = mux->table[index]; 766a369c58STero Kristo } else { 776a369c58STero Kristo if (mux->flags & CLK_MUX_INDEX_BIT) 786a369c58STero Kristo index = (1 << ffs(index)); 796a369c58STero Kristo 806a369c58STero Kristo if (mux->flags & CLK_MUX_INDEX_ONE) 816a369c58STero Kristo index++; 826a369c58STero Kristo } 836a369c58STero Kristo 846a369c58STero Kristo if (mux->lock) 856a369c58STero Kristo spin_lock_irqsave(mux->lock, flags); 866a369c58STero Kristo 876a369c58STero Kristo if (mux->flags & CLK_MUX_HIWORD_MASK) { 886a369c58STero Kristo val = mux->mask << (mux->shift + 16); 896a369c58STero Kristo } else { 906a369c58STero Kristo val = ti_clk_ll_ops->clk_readl(mux->reg); 916a369c58STero Kristo val &= ~(mux->mask << mux->shift); 926a369c58STero Kristo } 936a369c58STero Kristo val |= index << mux->shift; 946a369c58STero Kristo ti_clk_ll_ops->clk_writel(val, mux->reg); 956a369c58STero Kristo 966a369c58STero Kristo if (mux->lock) 976a369c58STero Kristo spin_unlock_irqrestore(mux->lock, flags); 986a369c58STero Kristo 996a369c58STero Kristo return 0; 1006a369c58STero Kristo } 1016a369c58STero Kristo 1026a369c58STero Kristo const struct clk_ops ti_clk_mux_ops = { 1036a369c58STero Kristo .get_parent = ti_clk_mux_get_parent, 1046a369c58STero Kristo .set_parent = ti_clk_mux_set_parent, 1056a369c58STero Kristo .determine_rate = __clk_mux_determine_rate, 1066a369c58STero Kristo }; 1076a369c58STero Kristo 1086a369c58STero Kristo static struct clk *_register_mux(struct device *dev, const char *name, 1096a369c58STero Kristo const char **parent_names, u8 num_parents, 1106a369c58STero Kristo unsigned long flags, void __iomem *reg, 1116a369c58STero Kristo u8 shift, u32 mask, u8 clk_mux_flags, 1126a369c58STero Kristo u32 *table, spinlock_t *lock) 1136a369c58STero Kristo { 1146a369c58STero Kristo struct clk_mux *mux; 1156a369c58STero Kristo struct clk *clk; 1166a369c58STero Kristo struct clk_init_data init; 1176a369c58STero Kristo 1186a369c58STero Kristo /* allocate the mux */ 1196a369c58STero Kristo mux = kzalloc(sizeof(*mux), GFP_KERNEL); 1206a369c58STero Kristo if (!mux) { 1216a369c58STero Kristo pr_err("%s: could not allocate mux clk\n", __func__); 1226a369c58STero Kristo return ERR_PTR(-ENOMEM); 1236a369c58STero Kristo } 1246a369c58STero Kristo 1256a369c58STero Kristo init.name = name; 1266a369c58STero Kristo init.ops = &ti_clk_mux_ops; 1276a369c58STero Kristo init.flags = flags | CLK_IS_BASIC; 1286a369c58STero Kristo init.parent_names = parent_names; 1296a369c58STero Kristo init.num_parents = num_parents; 1306a369c58STero Kristo 1316a369c58STero Kristo /* struct clk_mux assignments */ 1326a369c58STero Kristo mux->reg = reg; 1336a369c58STero Kristo mux->shift = shift; 1346a369c58STero Kristo mux->mask = mask; 1356a369c58STero Kristo mux->flags = clk_mux_flags; 1366a369c58STero Kristo mux->lock = lock; 1376a369c58STero Kristo mux->table = table; 1386a369c58STero Kristo mux->hw.init = &init; 1396a369c58STero Kristo 1406a369c58STero Kristo clk = clk_register(dev, &mux->hw); 1416a369c58STero Kristo 1426a369c58STero Kristo if (IS_ERR(clk)) 1436a369c58STero Kristo kfree(mux); 1446a369c58STero Kristo 1456a369c58STero Kristo return clk; 1466a369c58STero Kristo } 1476a369c58STero Kristo 148*7c18a65cSTero Kristo struct clk *ti_clk_register_mux(struct ti_clk *setup) 149*7c18a65cSTero Kristo { 150*7c18a65cSTero Kristo struct ti_clk_mux *mux; 151*7c18a65cSTero Kristo u32 flags; 152*7c18a65cSTero Kristo u8 mux_flags = 0; 153*7c18a65cSTero Kristo struct clk_omap_reg *reg_setup; 154*7c18a65cSTero Kristo u32 reg; 155*7c18a65cSTero Kristo u32 mask; 156*7c18a65cSTero Kristo 157*7c18a65cSTero Kristo reg_setup = (struct clk_omap_reg *)® 158*7c18a65cSTero Kristo 159*7c18a65cSTero Kristo mux = setup->data; 160*7c18a65cSTero Kristo flags = CLK_SET_RATE_NO_REPARENT; 161*7c18a65cSTero Kristo 162*7c18a65cSTero Kristo mask = mux->num_parents; 163*7c18a65cSTero Kristo if (!(mux->flags & CLKF_INDEX_STARTS_AT_ONE)) 164*7c18a65cSTero Kristo mask--; 165*7c18a65cSTero Kristo 166*7c18a65cSTero Kristo mask = (1 << fls(mask)) - 1; 167*7c18a65cSTero Kristo reg_setup->index = mux->module; 168*7c18a65cSTero Kristo reg_setup->offset = mux->reg; 169*7c18a65cSTero Kristo 170*7c18a65cSTero Kristo if (mux->flags & CLKF_INDEX_STARTS_AT_ONE) 171*7c18a65cSTero Kristo mux_flags |= CLK_MUX_INDEX_ONE; 172*7c18a65cSTero Kristo 173*7c18a65cSTero Kristo if (mux->flags & CLKF_SET_RATE_PARENT) 174*7c18a65cSTero Kristo flags |= CLK_SET_RATE_PARENT; 175*7c18a65cSTero Kristo 176*7c18a65cSTero Kristo return _register_mux(NULL, setup->name, mux->parents, mux->num_parents, 177*7c18a65cSTero Kristo flags, (void __iomem *)reg, mux->bit_shift, mask, 178*7c18a65cSTero Kristo mux_flags, NULL, NULL); 179*7c18a65cSTero Kristo } 180*7c18a65cSTero Kristo 1816a369c58STero Kristo /** 1826a369c58STero Kristo * of_mux_clk_setup - Setup function for simple mux rate clock 1836a369c58STero Kristo * @node: DT node for the clock 1846a369c58STero Kristo * 1856a369c58STero Kristo * Sets up a basic clock multiplexer. 1866a369c58STero Kristo */ 1876a369c58STero Kristo static void of_mux_clk_setup(struct device_node *node) 1886a369c58STero Kristo { 1896a369c58STero Kristo struct clk *clk; 1906a369c58STero Kristo void __iomem *reg; 1916a369c58STero Kristo int num_parents; 1926a369c58STero Kristo const char **parent_names; 1936a369c58STero Kristo int i; 1946a369c58STero Kristo u8 clk_mux_flags = 0; 1956a369c58STero Kristo u32 mask = 0; 1966a369c58STero Kristo u32 shift = 0; 1977d5fc85dSTomi Valkeinen u32 flags = CLK_SET_RATE_NO_REPARENT; 1986a369c58STero Kristo 1996a369c58STero Kristo num_parents = of_clk_get_parent_count(node); 2006a369c58STero Kristo if (num_parents < 2) { 2016a369c58STero Kristo pr_err("mux-clock %s must have parents\n", node->name); 2026a369c58STero Kristo return; 2036a369c58STero Kristo } 2046a369c58STero Kristo parent_names = kzalloc((sizeof(char *) * num_parents), GFP_KERNEL); 2056a369c58STero Kristo if (!parent_names) 2066a369c58STero Kristo goto cleanup; 2076a369c58STero Kristo 2086a369c58STero Kristo for (i = 0; i < num_parents; i++) 2096a369c58STero Kristo parent_names[i] = of_clk_get_parent_name(node, i); 2106a369c58STero Kristo 2116a369c58STero Kristo reg = ti_clk_get_reg_addr(node, 0); 2126a369c58STero Kristo 2136a369c58STero Kristo if (!reg) 2146a369c58STero Kristo goto cleanup; 2156a369c58STero Kristo 2166a369c58STero Kristo of_property_read_u32(node, "ti,bit-shift", &shift); 2176a369c58STero Kristo 2186a369c58STero Kristo if (of_property_read_bool(node, "ti,index-starts-at-one")) 2196a369c58STero Kristo clk_mux_flags |= CLK_MUX_INDEX_ONE; 2206a369c58STero Kristo 2216a369c58STero Kristo if (of_property_read_bool(node, "ti,set-rate-parent")) 2226a369c58STero Kristo flags |= CLK_SET_RATE_PARENT; 2236a369c58STero Kristo 2246a369c58STero Kristo /* Generate bit-mask based on parent info */ 2256a369c58STero Kristo mask = num_parents; 2266a369c58STero Kristo if (!(clk_mux_flags & CLK_MUX_INDEX_ONE)) 2276a369c58STero Kristo mask--; 2286a369c58STero Kristo 2296a369c58STero Kristo mask = (1 << fls(mask)) - 1; 2306a369c58STero Kristo 231*7c18a65cSTero Kristo clk = _register_mux(NULL, node->name, parent_names, num_parents, 232*7c18a65cSTero Kristo flags, reg, shift, mask, clk_mux_flags, NULL, 233*7c18a65cSTero Kristo NULL); 2346a369c58STero Kristo 2356a369c58STero Kristo if (!IS_ERR(clk)) 2366a369c58STero Kristo of_clk_add_provider(node, of_clk_src_simple_get, clk); 2376a369c58STero Kristo 2386a369c58STero Kristo cleanup: 2396a369c58STero Kristo kfree(parent_names); 2406a369c58STero Kristo } 2416a369c58STero Kristo CLK_OF_DECLARE(mux_clk, "ti,mux-clock", of_mux_clk_setup); 2426a369c58STero Kristo 243*7c18a65cSTero Kristo struct clk_hw *ti_clk_build_component_mux(struct ti_clk_mux *setup) 244*7c18a65cSTero Kristo { 245*7c18a65cSTero Kristo struct clk_mux *mux; 246*7c18a65cSTero Kristo struct clk_omap_reg *reg; 247*7c18a65cSTero Kristo int num_parents; 248*7c18a65cSTero Kristo 249*7c18a65cSTero Kristo if (!setup) 250*7c18a65cSTero Kristo return NULL; 251*7c18a65cSTero Kristo 252*7c18a65cSTero Kristo mux = kzalloc(sizeof(*mux), GFP_KERNEL); 253*7c18a65cSTero Kristo if (!mux) 254*7c18a65cSTero Kristo return ERR_PTR(-ENOMEM); 255*7c18a65cSTero Kristo 256*7c18a65cSTero Kristo reg = (struct clk_omap_reg *)&mux->reg; 257*7c18a65cSTero Kristo 258*7c18a65cSTero Kristo mux->shift = setup->bit_shift; 259*7c18a65cSTero Kristo 260*7c18a65cSTero Kristo reg->index = setup->module; 261*7c18a65cSTero Kristo reg->offset = setup->reg; 262*7c18a65cSTero Kristo 263*7c18a65cSTero Kristo if (setup->flags & CLKF_INDEX_STARTS_AT_ONE) 264*7c18a65cSTero Kristo mux->flags |= CLK_MUX_INDEX_ONE; 265*7c18a65cSTero Kristo 266*7c18a65cSTero Kristo num_parents = setup->num_parents; 267*7c18a65cSTero Kristo 268*7c18a65cSTero Kristo mux->mask = num_parents - 1; 269*7c18a65cSTero Kristo mux->mask = (1 << fls(mux->mask)) - 1; 270*7c18a65cSTero Kristo 271*7c18a65cSTero Kristo return &mux->hw; 272*7c18a65cSTero Kristo } 273*7c18a65cSTero Kristo 2746a369c58STero Kristo static void __init of_ti_composite_mux_clk_setup(struct device_node *node) 2756a369c58STero Kristo { 2766a369c58STero Kristo struct clk_mux *mux; 2776a369c58STero Kristo int num_parents; 2786a369c58STero Kristo u32 val; 2796a369c58STero Kristo 2806a369c58STero Kristo mux = kzalloc(sizeof(*mux), GFP_KERNEL); 2816a369c58STero Kristo if (!mux) 2826a369c58STero Kristo return; 2836a369c58STero Kristo 2846a369c58STero Kristo mux->reg = ti_clk_get_reg_addr(node, 0); 2856a369c58STero Kristo 2866a369c58STero Kristo if (!mux->reg) 2876a369c58STero Kristo goto cleanup; 2886a369c58STero Kristo 2896a369c58STero Kristo if (!of_property_read_u32(node, "ti,bit-shift", &val)) 2906a369c58STero Kristo mux->shift = val; 2916a369c58STero Kristo 2926a369c58STero Kristo if (of_property_read_bool(node, "ti,index-starts-at-one")) 2936a369c58STero Kristo mux->flags |= CLK_MUX_INDEX_ONE; 2946a369c58STero Kristo 2956a369c58STero Kristo num_parents = of_clk_get_parent_count(node); 2966a369c58STero Kristo 2976a369c58STero Kristo if (num_parents < 2) { 2986a369c58STero Kristo pr_err("%s must have parents\n", node->name); 2996a369c58STero Kristo goto cleanup; 3006a369c58STero Kristo } 3016a369c58STero Kristo 3026a369c58STero Kristo mux->mask = num_parents - 1; 3036a369c58STero Kristo mux->mask = (1 << fls(mux->mask)) - 1; 3046a369c58STero Kristo 3056a369c58STero Kristo if (!ti_clk_add_component(node, &mux->hw, CLK_COMPONENT_TYPE_MUX)) 3066a369c58STero Kristo return; 3076a369c58STero Kristo 3086a369c58STero Kristo cleanup: 3096a369c58STero Kristo kfree(mux); 3106a369c58STero Kristo } 3116a369c58STero Kristo CLK_OF_DECLARE(ti_composite_mux_clk_setup, "ti,composite-mux-clock", 3126a369c58STero Kristo of_ti_composite_mux_clk_setup); 313