Quelle  lcc-msm8960.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2014, The Linux Foundation. All rights reserved.
 */

#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/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_parent_data pxo_parent_data = {
 .fw_name = "pxo", .name = "pxo_board",
};

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_data = &pxo_parent_data,
  .num_parents = 1,
  .ops = &clk_pll_ops,
 },
};

enum {
 P_PXO,
 P_PLL4,
};

static const struct parent_map lcc_pxo_pll4_map[] = {
 { P_PXO, 0 },
 { P_PLL4, 2 }
};

static struct clk_parent_data lcc_pxo_pll4[] = {
 { .fw_name = "pxo", .name = "pxo_board" },
 { .fw_name = "pll4_vote", .name = "pll4_vote" },
};

static const 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 const 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 },
 { }
};

#define CLK_AIF_OSR_SRC(prefix, _ns, _md)   \
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_data = lcc_pxo_pll4,  \
   .num_parents = ARRAY_SIZE(lcc_pxo_pll4), \
   .ops = &clk_rcg_ops,   \
   .flags = CLK_SET_RATE_GATE,  \
  },      \
 },       \
};        \

#define CLK_AIF_OSR_CLK(prefix, _ns, hr, en_bit)  \
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(en_bit),   \
  .hw.init = &(struct clk_init_data){  \
   .name = #prefix "_osr_clk",  \
   .parent_hws = (const struct clk_hw*[]){ \
    &prefix##_osr_src.clkr.hw, \
   },     \
   .num_parents = 1,   \
   .ops = &clk_branch_ops,   \
   .flags = CLK_SET_RATE_PARENT,  \
  },      \
 },       \
};        \

#define CLK_AIF_OSR_DIV_CLK(prefix, _ns, _width)  \
static struct clk_regmap_div prefix##_div_clk = {  \
 .reg = _ns,      \
 .shift = 10,      \
 .width = _width,     \
 .clkr = {      \
  .hw.init = &(struct clk_init_data){  \
   .name = #prefix "_div_clk",  \
   .parent_hws = (const struct clk_hw*[]){ \
    &prefix##_osr_src.clkr.hw, \
   },     \
   .num_parents = 1,   \
   .ops = &clk_regmap_div_ops,  \
  },      \
 },       \
};        \

#define CLK_AIF_OSR_BIT_DIV_CLK(prefix, _ns, hr, en_bit) \
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(en_bit),   \
  .hw.init = &(struct clk_init_data){  \
   .name = #prefix "_bit_div_clk",  \
   .parent_hws = (const struct clk_hw*[]){ \
    &prefix##_div_clk.clkr.hw, \
   },     \
   .num_parents = 1,   \
   .ops = &clk_branch_ops,   \
   .flags = CLK_SET_RATE_PARENT,  \
  },      \
 },       \
};        \

#define CLK_AIF_OSR_BIT_CLK(prefix, _ns, _shift)  \
static struct clk_regmap_mux prefix##_bit_clk = {  \
 .reg = _ns,      \
 .shift = _shift,     \
 .width = 1,      \
 .clkr = {      \
  .hw.init = &(struct clk_init_data){  \
   .name = #prefix "_bit_clk",  \
   .parent_data = (const struct clk_parent_data[]){ \
    { .hw = &prefix##_bit_div_clk.clkr.hw, }, \
    { .fw_name = #prefix "_codec_clk", \
      .name = #prefix "_codec_clk", }, \
   },     \
   .num_parents = 2,   \
   .ops = &clk_regmap_mux_closest_ops, \
   .flags = CLK_SET_RATE_PARENT,  \
  },      \
 },       \
};

CLK_AIF_OSR_SRC(mi2s, 0x48, 0x4c)
CLK_AIF_OSR_CLK(mi2s, 0x48, 0x50, 17)
CLK_AIF_OSR_DIV_CLK(mi2s, 0x48, 4)
CLK_AIF_OSR_BIT_DIV_CLK(mi2s, 0x48, 0x50, 15)
CLK_AIF_OSR_BIT_CLK(mi2s, 0x48, 14)

#define CLK_AIF_OSR_DIV(prefix, _ns, _md, hr)   \
 CLK_AIF_OSR_SRC(prefix, _ns, _md)   \
 CLK_AIF_OSR_CLK(prefix, _ns, hr, 21)   \
 CLK_AIF_OSR_DIV_CLK(prefix, _ns, 8)   \
 CLK_AIF_OSR_BIT_DIV_CLK(prefix, _ns, hr, 19)  \
 CLK_AIF_OSR_BIT_CLK(prefix, _ns, 18)

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 const 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 const 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_data = lcc_pxo_pll4,
   .num_parents = ARRAY_SIZE(lcc_pxo_pll4),
   .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_hws = (const struct clk_hw*[]){
    &pcm_src.clkr.hw
   },
   .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_data = (const struct clk_parent_data[]){
    { .hw = &pcm_clk_out.clkr.hw },
    { .fw_name = "pcm_codec_clk", .name = "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_data = lcc_pxo_pll4,
   .num_parents = ARRAY_SIZE(lcc_pxo_pll4),
   .ops = &clk_rcg_ops,
   .flags = CLK_SET_RATE_GATE,
  },
 },
};

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_hws = (const struct clk_hw*[]){
    &slimbus_src.clkr.hw,
   },
   .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_hws = (const struct clk_hw*[]){
    &slimbus_src.clkr.hw,
   },
   .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" },
 { .compatible = "qcom,lcc-mdm9615" },
 { }
};
MODULE_DEVICE_TABLE(of, lcc_msm8960_match_table);

static int lcc_msm8960_probe(struct platform_device *pdev)
{
 u32 val;
 struct regmap *regmap;

 /* patch for the cxo <-> pxo difference */
 if (of_device_is_compatible(pdev->dev.of_node, "qcom,lcc-mdm9615")) {
  pxo_parent_data.fw_name = "cxo";
  pxo_parent_data.name = "cxo_board";
  lcc_pxo_pll4[0].fw_name = "cxo";
  lcc_pxo_pll4[0].name = "cxo_board";
 }

 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->dev, &lcc_msm8960_desc, regmap);
}

static struct platform_driver lcc_msm8960_driver = {
 .probe  = lcc_msm8960_probe,
 .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");