| /* |
| * Copyright (c) 2014, The Linux Foundation. All rights reserved. |
| * |
| * This software is licensed under the terms of the GNU General Public |
| * License version 2, as published by the Free Software Foundation, and |
| * may be copied, distributed, and modified under those terms. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/bitops.h> |
| #include <linux/err.h> |
| #include <linux/platform_device.h> |
| #include <linux/module.h> |
| #include <linux/of.h> |
| #include <linux/of_device.h> |
| #include <linux/clk-provider.h> |
| #include <linux/regmap.h> |
| |
| #include <dt-bindings/clock/qcom,lcc-msm8960.h> |
| |
| #include "common.h" |
| #include "clk-regmap.h" |
| #include "clk-pll.h" |
| #include "clk-rcg.h" |
| #include "clk-branch.h" |
| #include "clk-regmap-divider.h" |
| #include "clk-regmap-mux.h" |
| |
| static struct clk_pll pll4 = { |
| .l_reg = 0x4, |
| .m_reg = 0x8, |
| .n_reg = 0xc, |
| .config_reg = 0x14, |
| .mode_reg = 0x0, |
| .status_reg = 0x18, |
| .status_bit = 16, |
| .clkr.hw.init = &(struct clk_init_data){ |
| .name = "pll4", |
| .parent_names = (const char *[]){ "pxo" }, |
| .num_parents = 1, |
| .ops = &clk_pll_ops, |
| }, |
| }; |
| |
| #define P_PXO 0 |
| #define P_PLL4 1 |
| |
| static const u8 lcc_pxo_pll4_map[] = { |
| [P_PXO] = 0, |
| [P_PLL4] = 2, |
| }; |
| |
| static const char *lcc_pxo_pll4[] = { |
| "pxo", |
| "pll4_vote", |
| }; |
| |
| static struct freq_tbl clk_tbl_aif_osr_492[] = { |
| { 512000, P_PLL4, 4, 1, 240 }, |
| { 768000, P_PLL4, 4, 1, 160 }, |
| { 1024000, P_PLL4, 4, 1, 120 }, |
| { 1536000, P_PLL4, 4, 1, 80 }, |
| { 2048000, P_PLL4, 4, 1, 60 }, |
| { 3072000, P_PLL4, 4, 1, 40 }, |
| { 4096000, P_PLL4, 4, 1, 30 }, |
| { 6144000, P_PLL4, 4, 1, 20 }, |
| { 8192000, P_PLL4, 4, 1, 15 }, |
| { 12288000, P_PLL4, 4, 1, 10 }, |
| { 24576000, P_PLL4, 4, 1, 5 }, |
| { 27000000, P_PXO, 1, 0, 0 }, |
| { } |
| }; |
| |
| static struct freq_tbl clk_tbl_aif_osr_393[] = { |
| { 512000, P_PLL4, 4, 1, 192 }, |
| { 768000, P_PLL4, 4, 1, 128 }, |
| { 1024000, P_PLL4, 4, 1, 96 }, |
| { 1536000, P_PLL4, 4, 1, 64 }, |
| { 2048000, P_PLL4, 4, 1, 48 }, |
| { 3072000, P_PLL4, 4, 1, 32 }, |
| { 4096000, P_PLL4, 4, 1, 24 }, |
| { 6144000, P_PLL4, 4, 1, 16 }, |
| { 8192000, P_PLL4, 4, 1, 12 }, |
| { 12288000, P_PLL4, 4, 1, 8 }, |
| { 24576000, P_PLL4, 4, 1, 4 }, |
| { 27000000, P_PXO, 1, 0, 0 }, |
| { } |
| }; |
| |
| static struct clk_rcg mi2s_osr_src = { |
| .ns_reg = 0x48, |
| .md_reg = 0x4c, |
| .mn = { |
| .mnctr_en_bit = 8, |
| .mnctr_reset_bit = 7, |
| .mnctr_mode_shift = 5, |
| .n_val_shift = 24, |
| .m_val_shift = 8, |
| .width = 8, |
| }, |
| .p = { |
| .pre_div_shift = 3, |
| .pre_div_width = 2, |
| }, |
| .s = { |
| .src_sel_shift = 0, |
| .parent_map = lcc_pxo_pll4_map, |
| }, |
| .freq_tbl = clk_tbl_aif_osr_393, |
| .clkr = { |
| .enable_reg = 0x48, |
| .enable_mask = BIT(9), |
| .hw.init = &(struct clk_init_data){ |
| .name = "mi2s_osr_src", |
| .parent_names = lcc_pxo_pll4, |
| .num_parents = 2, |
| .ops = &clk_rcg_ops, |
| .flags = CLK_SET_RATE_GATE, |
| }, |
| }, |
| }; |
| |
| static const char *lcc_mi2s_parents[] = { |
| "mi2s_osr_src", |
| }; |
| |
| static struct clk_branch mi2s_osr_clk = { |
| .halt_reg = 0x50, |
| .halt_bit = 1, |
| .halt_check = BRANCH_HALT_ENABLE, |
| .clkr = { |
| .enable_reg = 0x48, |
| .enable_mask = BIT(17), |
| .hw.init = &(struct clk_init_data){ |
| .name = "mi2s_osr_clk", |
| .parent_names = lcc_mi2s_parents, |
| .num_parents = 1, |
| .ops = &clk_branch_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_regmap_div mi2s_div_clk = { |
| .reg = 0x48, |
| .shift = 10, |
| .width = 4, |
| .clkr = { |
| .enable_reg = 0x48, |
| .enable_mask = BIT(15), |
| .hw.init = &(struct clk_init_data){ |
| .name = "mi2s_div_clk", |
| .parent_names = lcc_mi2s_parents, |
| .num_parents = 1, |
| .ops = &clk_regmap_div_ops, |
| }, |
| }, |
| }; |
| |
| static struct clk_branch mi2s_bit_div_clk = { |
| .halt_reg = 0x50, |
| .halt_bit = 0, |
| .halt_check = BRANCH_HALT_ENABLE, |
| .clkr = { |
| .enable_reg = 0x48, |
| .enable_mask = BIT(15), |
| .hw.init = &(struct clk_init_data){ |
| .name = "mi2s_bit_div_clk", |
| .parent_names = (const char *[]){ "mi2s_div_clk" }, |
| .num_parents = 1, |
| .ops = &clk_branch_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_regmap_mux mi2s_bit_clk = { |
| .reg = 0x48, |
| .shift = 14, |
| .width = 1, |
| .clkr = { |
| .hw.init = &(struct clk_init_data){ |
| .name = "mi2s_bit_clk", |
| .parent_names = (const char *[]){ |
| "mi2s_bit_div_clk", |
| "mi2s_codec_clk", |
| }, |
| .num_parents = 2, |
| .ops = &clk_regmap_mux_closest_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| #define CLK_AIF_OSR_DIV(prefix, _ns, _md, hr) \ |
| static struct clk_rcg prefix##_osr_src = { \ |
| .ns_reg = _ns, \ |
| .md_reg = _md, \ |
| .mn = { \ |
| .mnctr_en_bit = 8, \ |
| .mnctr_reset_bit = 7, \ |
| .mnctr_mode_shift = 5, \ |
| .n_val_shift = 24, \ |
| .m_val_shift = 8, \ |
| .width = 8, \ |
| }, \ |
| .p = { \ |
| .pre_div_shift = 3, \ |
| .pre_div_width = 2, \ |
| }, \ |
| .s = { \ |
| .src_sel_shift = 0, \ |
| .parent_map = lcc_pxo_pll4_map, \ |
| }, \ |
| .freq_tbl = clk_tbl_aif_osr_393, \ |
| .clkr = { \ |
| .enable_reg = _ns, \ |
| .enable_mask = BIT(9), \ |
| .hw.init = &(struct clk_init_data){ \ |
| .name = #prefix "_osr_src", \ |
| .parent_names = lcc_pxo_pll4, \ |
| .num_parents = 2, \ |
| .ops = &clk_rcg_ops, \ |
| .flags = CLK_SET_RATE_GATE, \ |
| }, \ |
| }, \ |
| }; \ |
| \ |
| static const char *lcc_##prefix##_parents[] = { \ |
| #prefix "_osr_src", \ |
| }; \ |
| \ |
| static struct clk_branch prefix##_osr_clk = { \ |
| .halt_reg = hr, \ |
| .halt_bit = 1, \ |
| .halt_check = BRANCH_HALT_ENABLE, \ |
| .clkr = { \ |
| .enable_reg = _ns, \ |
| .enable_mask = BIT(21), \ |
| .hw.init = &(struct clk_init_data){ \ |
| .name = #prefix "_osr_clk", \ |
| .parent_names = lcc_##prefix##_parents, \ |
| .num_parents = 1, \ |
| .ops = &clk_branch_ops, \ |
| .flags = CLK_SET_RATE_PARENT, \ |
| }, \ |
| }, \ |
| }; \ |
| \ |
| static struct clk_regmap_div prefix##_div_clk = { \ |
| .reg = _ns, \ |
| .shift = 10, \ |
| .width = 8, \ |
| .clkr = { \ |
| .hw.init = &(struct clk_init_data){ \ |
| .name = #prefix "_div_clk", \ |
| .parent_names = lcc_##prefix##_parents, \ |
| .num_parents = 1, \ |
| .ops = &clk_regmap_div_ops, \ |
| }, \ |
| }, \ |
| }; \ |
| \ |
| static struct clk_branch prefix##_bit_div_clk = { \ |
| .halt_reg = hr, \ |
| .halt_bit = 0, \ |
| .halt_check = BRANCH_HALT_ENABLE, \ |
| .clkr = { \ |
| .enable_reg = _ns, \ |
| .enable_mask = BIT(19), \ |
| .hw.init = &(struct clk_init_data){ \ |
| .name = #prefix "_bit_div_clk", \ |
| .parent_names = (const char *[]){ \ |
| #prefix "_div_clk" \ |
| }, \ |
| .num_parents = 1, \ |
| .ops = &clk_branch_ops, \ |
| .flags = CLK_SET_RATE_PARENT, \ |
| }, \ |
| }, \ |
| }; \ |
| \ |
| static struct clk_regmap_mux prefix##_bit_clk = { \ |
| .reg = _ns, \ |
| .shift = 18, \ |
| .width = 1, \ |
| .clkr = { \ |
| .hw.init = &(struct clk_init_data){ \ |
| .name = #prefix "_bit_clk", \ |
| .parent_names = (const char *[]){ \ |
| #prefix "_bit_div_clk", \ |
| #prefix "_codec_clk", \ |
| }, \ |
| .num_parents = 2, \ |
| .ops = &clk_regmap_mux_closest_ops, \ |
| .flags = CLK_SET_RATE_PARENT, \ |
| }, \ |
| }, \ |
| } |
| |
| CLK_AIF_OSR_DIV(codec_i2s_mic, 0x60, 0x64, 0x68); |
| CLK_AIF_OSR_DIV(spare_i2s_mic, 0x78, 0x7c, 0x80); |
| CLK_AIF_OSR_DIV(codec_i2s_spkr, 0x6c, 0x70, 0x74); |
| CLK_AIF_OSR_DIV(spare_i2s_spkr, 0x84, 0x88, 0x8c); |
| |
| static struct freq_tbl clk_tbl_pcm_492[] = { |
| { 256000, P_PLL4, 4, 1, 480 }, |
| { 512000, P_PLL4, 4, 1, 240 }, |
| { 768000, P_PLL4, 4, 1, 160 }, |
| { 1024000, P_PLL4, 4, 1, 120 }, |
| { 1536000, P_PLL4, 4, 1, 80 }, |
| { 2048000, P_PLL4, 4, 1, 60 }, |
| { 3072000, P_PLL4, 4, 1, 40 }, |
| { 4096000, P_PLL4, 4, 1, 30 }, |
| { 6144000, P_PLL4, 4, 1, 20 }, |
| { 8192000, P_PLL4, 4, 1, 15 }, |
| { 12288000, P_PLL4, 4, 1, 10 }, |
| { 24576000, P_PLL4, 4, 1, 5 }, |
| { 27000000, P_PXO, 1, 0, 0 }, |
| { } |
| }; |
| |
| static struct freq_tbl clk_tbl_pcm_393[] = { |
| { 256000, P_PLL4, 4, 1, 384 }, |
| { 512000, P_PLL4, 4, 1, 192 }, |
| { 768000, P_PLL4, 4, 1, 128 }, |
| { 1024000, P_PLL4, 4, 1, 96 }, |
| { 1536000, P_PLL4, 4, 1, 64 }, |
| { 2048000, P_PLL4, 4, 1, 48 }, |
| { 3072000, P_PLL4, 4, 1, 32 }, |
| { 4096000, P_PLL4, 4, 1, 24 }, |
| { 6144000, P_PLL4, 4, 1, 16 }, |
| { 8192000, P_PLL4, 4, 1, 12 }, |
| { 12288000, P_PLL4, 4, 1, 8 }, |
| { 24576000, P_PLL4, 4, 1, 4 }, |
| { 27000000, P_PXO, 1, 0, 0 }, |
| { } |
| }; |
| |
| static struct clk_rcg pcm_src = { |
| .ns_reg = 0x54, |
| .md_reg = 0x58, |
| .mn = { |
| .mnctr_en_bit = 8, |
| .mnctr_reset_bit = 7, |
| .mnctr_mode_shift = 5, |
| .n_val_shift = 16, |
| .m_val_shift = 16, |
| .width = 16, |
| }, |
| .p = { |
| .pre_div_shift = 3, |
| .pre_div_width = 2, |
| }, |
| .s = { |
| .src_sel_shift = 0, |
| .parent_map = lcc_pxo_pll4_map, |
| }, |
| .freq_tbl = clk_tbl_pcm_393, |
| .clkr = { |
| .enable_reg = 0x54, |
| .enable_mask = BIT(9), |
| .hw.init = &(struct clk_init_data){ |
| .name = "pcm_src", |
| .parent_names = lcc_pxo_pll4, |
| .num_parents = 2, |
| .ops = &clk_rcg_ops, |
| .flags = CLK_SET_RATE_GATE, |
| }, |
| }, |
| }; |
| |
| static struct clk_branch pcm_clk_out = { |
| .halt_reg = 0x5c, |
| .halt_bit = 0, |
| .halt_check = BRANCH_HALT_ENABLE, |
| .clkr = { |
| .enable_reg = 0x54, |
| .enable_mask = BIT(11), |
| .hw.init = &(struct clk_init_data){ |
| .name = "pcm_clk_out", |
| .parent_names = (const char *[]){ "pcm_src" }, |
| .num_parents = 1, |
| .ops = &clk_branch_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_regmap_mux pcm_clk = { |
| .reg = 0x54, |
| .shift = 10, |
| .width = 1, |
| .clkr = { |
| .hw.init = &(struct clk_init_data){ |
| .name = "pcm_clk", |
| .parent_names = (const char *[]){ |
| "pcm_clk_out", |
| "pcm_codec_clk", |
| }, |
| .num_parents = 2, |
| .ops = &clk_regmap_mux_closest_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_rcg slimbus_src = { |
| .ns_reg = 0xcc, |
| .md_reg = 0xd0, |
| .mn = { |
| .mnctr_en_bit = 8, |
| .mnctr_reset_bit = 7, |
| .mnctr_mode_shift = 5, |
| .n_val_shift = 24, |
| .m_val_shift = 8, |
| .width = 8, |
| }, |
| .p = { |
| .pre_div_shift = 3, |
| .pre_div_width = 2, |
| }, |
| .s = { |
| .src_sel_shift = 0, |
| .parent_map = lcc_pxo_pll4_map, |
| }, |
| .freq_tbl = clk_tbl_aif_osr_393, |
| .clkr = { |
| .enable_reg = 0xcc, |
| .enable_mask = BIT(9), |
| .hw.init = &(struct clk_init_data){ |
| .name = "slimbus_src", |
| .parent_names = lcc_pxo_pll4, |
| .num_parents = 2, |
| .ops = &clk_rcg_ops, |
| .flags = CLK_SET_RATE_GATE, |
| }, |
| }, |
| }; |
| |
| static const char *lcc_slimbus_parents[] = { |
| "slimbus_src", |
| }; |
| |
| static struct clk_branch audio_slimbus_clk = { |
| .halt_reg = 0xd4, |
| .halt_bit = 0, |
| .halt_check = BRANCH_HALT_ENABLE, |
| .clkr = { |
| .enable_reg = 0xcc, |
| .enable_mask = BIT(10), |
| .hw.init = &(struct clk_init_data){ |
| .name = "audio_slimbus_clk", |
| .parent_names = lcc_slimbus_parents, |
| .num_parents = 1, |
| .ops = &clk_branch_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_branch sps_slimbus_clk = { |
| .halt_reg = 0xd4, |
| .halt_bit = 1, |
| .halt_check = BRANCH_HALT_ENABLE, |
| .clkr = { |
| .enable_reg = 0xcc, |
| .enable_mask = BIT(12), |
| .hw.init = &(struct clk_init_data){ |
| .name = "sps_slimbus_clk", |
| .parent_names = lcc_slimbus_parents, |
| .num_parents = 1, |
| .ops = &clk_branch_ops, |
| .flags = CLK_SET_RATE_PARENT, |
| }, |
| }, |
| }; |
| |
| static struct clk_regmap *lcc_msm8960_clks[] = { |
| [PLL4] = &pll4.clkr, |
| [MI2S_OSR_SRC] = &mi2s_osr_src.clkr, |
| [MI2S_OSR_CLK] = &mi2s_osr_clk.clkr, |
| [MI2S_DIV_CLK] = &mi2s_div_clk.clkr, |
| [MI2S_BIT_DIV_CLK] = &mi2s_bit_div_clk.clkr, |
| [MI2S_BIT_CLK] = &mi2s_bit_clk.clkr, |
| [PCM_SRC] = &pcm_src.clkr, |
| [PCM_CLK_OUT] = &pcm_clk_out.clkr, |
| [PCM_CLK] = &pcm_clk.clkr, |
| [SLIMBUS_SRC] = &slimbus_src.clkr, |
| [AUDIO_SLIMBUS_CLK] = &audio_slimbus_clk.clkr, |
| [SPS_SLIMBUS_CLK] = &sps_slimbus_clk.clkr, |
| [CODEC_I2S_MIC_OSR_SRC] = &codec_i2s_mic_osr_src.clkr, |
| [CODEC_I2S_MIC_OSR_CLK] = &codec_i2s_mic_osr_clk.clkr, |
| [CODEC_I2S_MIC_DIV_CLK] = &codec_i2s_mic_div_clk.clkr, |
| [CODEC_I2S_MIC_BIT_DIV_CLK] = &codec_i2s_mic_bit_div_clk.clkr, |
| [CODEC_I2S_MIC_BIT_CLK] = &codec_i2s_mic_bit_clk.clkr, |
| [SPARE_I2S_MIC_OSR_SRC] = &spare_i2s_mic_osr_src.clkr, |
| [SPARE_I2S_MIC_OSR_CLK] = &spare_i2s_mic_osr_clk.clkr, |
| [SPARE_I2S_MIC_DIV_CLK] = &spare_i2s_mic_div_clk.clkr, |
| [SPARE_I2S_MIC_BIT_DIV_CLK] = &spare_i2s_mic_bit_div_clk.clkr, |
| [SPARE_I2S_MIC_BIT_CLK] = &spare_i2s_mic_bit_clk.clkr, |
| [CODEC_I2S_SPKR_OSR_SRC] = &codec_i2s_spkr_osr_src.clkr, |
| [CODEC_I2S_SPKR_OSR_CLK] = &codec_i2s_spkr_osr_clk.clkr, |
| [CODEC_I2S_SPKR_DIV_CLK] = &codec_i2s_spkr_div_clk.clkr, |
| [CODEC_I2S_SPKR_BIT_DIV_CLK] = &codec_i2s_spkr_bit_div_clk.clkr, |
| [CODEC_I2S_SPKR_BIT_CLK] = &codec_i2s_spkr_bit_clk.clkr, |
| [SPARE_I2S_SPKR_OSR_SRC] = &spare_i2s_spkr_osr_src.clkr, |
| [SPARE_I2S_SPKR_OSR_CLK] = &spare_i2s_spkr_osr_clk.clkr, |
| [SPARE_I2S_SPKR_DIV_CLK] = &spare_i2s_spkr_div_clk.clkr, |
| [SPARE_I2S_SPKR_BIT_DIV_CLK] = &spare_i2s_spkr_bit_div_clk.clkr, |
| [SPARE_I2S_SPKR_BIT_CLK] = &spare_i2s_spkr_bit_clk.clkr, |
| }; |
| |
| static const struct regmap_config lcc_msm8960_regmap_config = { |
| .reg_bits = 32, |
| .reg_stride = 4, |
| .val_bits = 32, |
| .max_register = 0xfc, |
| .fast_io = true, |
| }; |
| |
| static const struct qcom_cc_desc lcc_msm8960_desc = { |
| .config = &lcc_msm8960_regmap_config, |
| .clks = lcc_msm8960_clks, |
| .num_clks = ARRAY_SIZE(lcc_msm8960_clks), |
| }; |
| |
| static const struct of_device_id lcc_msm8960_match_table[] = { |
| { .compatible = "qcom,lcc-msm8960" }, |
| { .compatible = "qcom,lcc-apq8064" }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(of, lcc_msm8960_match_table); |
| |
| static int lcc_msm8960_probe(struct platform_device *pdev) |
| { |
| u32 val; |
| struct regmap *regmap; |
| |
| regmap = qcom_cc_map(pdev, &lcc_msm8960_desc); |
| if (IS_ERR(regmap)) |
| return PTR_ERR(regmap); |
| |
| /* Use the correct frequency plan depending on speed of PLL4 */ |
| regmap_read(regmap, 0x4, &val); |
| if (val == 0x12) { |
| slimbus_src.freq_tbl = clk_tbl_aif_osr_492; |
| mi2s_osr_src.freq_tbl = clk_tbl_aif_osr_492; |
| codec_i2s_mic_osr_src.freq_tbl = clk_tbl_aif_osr_492; |
| spare_i2s_mic_osr_src.freq_tbl = clk_tbl_aif_osr_492; |
| codec_i2s_spkr_osr_src.freq_tbl = clk_tbl_aif_osr_492; |
| spare_i2s_spkr_osr_src.freq_tbl = clk_tbl_aif_osr_492; |
| pcm_src.freq_tbl = clk_tbl_pcm_492; |
| } |
| /* Enable PLL4 source on the LPASS Primary PLL Mux */ |
| regmap_write(regmap, 0xc4, 0x1); |
| |
| return qcom_cc_really_probe(pdev, &lcc_msm8960_desc, regmap); |
| } |
| |
| static int lcc_msm8960_remove(struct platform_device *pdev) |
| { |
| qcom_cc_remove(pdev); |
| return 0; |
| } |
| |
| static struct platform_driver lcc_msm8960_driver = { |
| .probe = lcc_msm8960_probe, |
| .remove = lcc_msm8960_remove, |
| .driver = { |
| .name = "lcc-msm8960", |
| .of_match_table = lcc_msm8960_match_table, |
| }, |
| }; |
| module_platform_driver(lcc_msm8960_driver); |
| |
| MODULE_DESCRIPTION("QCOM LCC MSM8960 Driver"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_ALIAS("platform:lcc-msm8960"); |