blob: d53982f633e57f87d24259fb64daeecbb02deaf6 [file] [log] [blame]
// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (c) 2018 BayLibre, SAS
* Author: Neil Armstrong <narmstrong@baylibre.com>
* Author: Jian Hu <jian.hu@amlogic.com>
*/
#include <linux/of_address.h>
#include <linux/platform_device.h>
#include <linux/bitfield.h>
#include <linux/seq_file.h>
#include <linux/debugfs.h>
#include <linux/regmap.h>
#include <linux/amlogic/clk_measure.h>
#define MSR_DURATION GENMASK(15, 0)
#define MSR_ENABLE BIT(16)
#define MSR_CONT BIT(17) /* continuous measurement */
#define MSR_INTR BIT(18) /* interrupts */
#define MSR_RUN BIT(19)
#define MSR_CLK_SRC GENMASK(26, 20)
#define MSR_BUSY BIT(31)
#define MSR_VAL_MASK GENMASK(15, 0)
#define DIV_MIN 32
#define DIV_STEP 32
#define DIV_MAX 640
/*
* According to Datasheet, The max clk measure num
* is 256, not 128, remove it
*/
struct meson_msr_id {
struct meson_msr *priv;
unsigned int id;
const char *name;
};
struct meson_msr_data {
struct meson_msr_id *msr_table;
unsigned int table_size;
unsigned int duty_offset;
unsigned int reg0_offset;
unsigned int reg1_offset;
unsigned int reg2_offset;
};
struct meson_msr {
struct regmap *regmap;
struct meson_msr_data *data;
};
#define CLK_MSR_ID(__id, __name) \
[__id] = {.id = __id, .name = __name,}
static struct meson_msr *glo_meson_msr;
static unsigned int measure_num;
static struct meson_msr_id clk_msr_m8[] __initdata = {
CLK_MSR_ID(0, "ring_osc_out_ee0"),
CLK_MSR_ID(1, "ring_osc_out_ee1"),
CLK_MSR_ID(2, "ring_osc_out_ee2"),
CLK_MSR_ID(3, "a9_ring_osck"),
CLK_MSR_ID(6, "vid_pll"),
CLK_MSR_ID(7, "clk81"),
CLK_MSR_ID(8, "encp"),
CLK_MSR_ID(9, "encl"),
CLK_MSR_ID(11, "eth_rmii"),
CLK_MSR_ID(13, "amclk"),
CLK_MSR_ID(14, "fec_clk_0"),
CLK_MSR_ID(15, "fec_clk_1"),
CLK_MSR_ID(16, "fec_clk_2"),
CLK_MSR_ID(18, "a9_clk_div16"),
CLK_MSR_ID(19, "hdmi_sys"),
CLK_MSR_ID(20, "rtc_osc_clk_out"),
CLK_MSR_ID(21, "i2s_clk_in_src0"),
CLK_MSR_ID(22, "clk_rmii_from_pad"),
CLK_MSR_ID(23, "hdmi_ch0_tmds"),
CLK_MSR_ID(24, "lvds_fifo"),
CLK_MSR_ID(26, "sc_clk_int"),
CLK_MSR_ID(28, "sar_adc"),
CLK_MSR_ID(30, "mpll_clk_test_out"),
CLK_MSR_ID(31, "audac_clkpi"),
CLK_MSR_ID(32, "vdac"),
CLK_MSR_ID(33, "sdhc_rx"),
CLK_MSR_ID(34, "sdhc_sd"),
CLK_MSR_ID(35, "mali"),
CLK_MSR_ID(36, "hdmi_tx_pixel"),
CLK_MSR_ID(38, "vdin_meas"),
CLK_MSR_ID(39, "pcm_sclk"),
CLK_MSR_ID(40, "pcm_mclk"),
CLK_MSR_ID(41, "eth_rx_tx"),
CLK_MSR_ID(42, "pwm_d"),
CLK_MSR_ID(43, "pwm_c"),
CLK_MSR_ID(44, "pwm_b"),
CLK_MSR_ID(45, "pwm_a"),
CLK_MSR_ID(46, "pcm2_sclk"),
CLK_MSR_ID(47, "ddr_dpll_pt"),
CLK_MSR_ID(48, "pwm_f"),
CLK_MSR_ID(49, "pwm_e"),
CLK_MSR_ID(59, "hcodec"),
CLK_MSR_ID(60, "usb_32k_alt"),
CLK_MSR_ID(61, "gpio"),
CLK_MSR_ID(62, "vid2_pll"),
CLK_MSR_ID(63, "mipi_csi_cfg"),
};
static struct meson_msr_id clk_msr_gx[] __initdata = {
CLK_MSR_ID(0, "ring_osc_out_ee_0"),
CLK_MSR_ID(1, "ring_osc_out_ee_1"),
CLK_MSR_ID(2, "ring_osc_out_ee_2"),
CLK_MSR_ID(3, "a53_ring_osc"),
CLK_MSR_ID(4, "gp0_pll"),
CLK_MSR_ID(6, "enci"),
CLK_MSR_ID(7, "clk81"),
CLK_MSR_ID(8, "encp"),
CLK_MSR_ID(9, "encl"),
CLK_MSR_ID(10, "vdac"),
CLK_MSR_ID(11, "rgmii_tx"),
CLK_MSR_ID(12, "pdm"),
CLK_MSR_ID(13, "amclk"),
CLK_MSR_ID(14, "fec_0"),
CLK_MSR_ID(15, "fec_1"),
CLK_MSR_ID(16, "fec_2"),
CLK_MSR_ID(17, "sys_pll_div16"),
CLK_MSR_ID(18, "sys_cpu_div16"),
CLK_MSR_ID(19, "hdmitx_sys"),
CLK_MSR_ID(20, "rtc_osc_out"),
CLK_MSR_ID(21, "i2s_in_src0"),
CLK_MSR_ID(22, "eth_phy_ref"),
CLK_MSR_ID(23, "hdmi_todig"),
CLK_MSR_ID(26, "sc_int"),
CLK_MSR_ID(28, "sar_adc"),
CLK_MSR_ID(31, "mpll_test_out"),
CLK_MSR_ID(32, "vdec"),
CLK_MSR_ID(35, "mali"),
CLK_MSR_ID(36, "hdmi_tx_pixel"),
CLK_MSR_ID(37, "i958"),
CLK_MSR_ID(38, "vdin_meas"),
CLK_MSR_ID(39, "pcm_sclk"),
CLK_MSR_ID(40, "pcm_mclk"),
CLK_MSR_ID(41, "eth_rx_or_rmii"),
CLK_MSR_ID(42, "mp0_out"),
CLK_MSR_ID(43, "fclk_div5"),
CLK_MSR_ID(44, "pwm_b"),
CLK_MSR_ID(45, "pwm_a"),
CLK_MSR_ID(46, "vpu"),
CLK_MSR_ID(47, "ddr_dpll_pt"),
CLK_MSR_ID(48, "mp1_out"),
CLK_MSR_ID(49, "mp2_out"),
CLK_MSR_ID(50, "mp3_out"),
CLK_MSR_ID(51, "nand_core"),
CLK_MSR_ID(52, "sd_emmc_b"),
CLK_MSR_ID(53, "sd_emmc_a"),
CLK_MSR_ID(55, "vid_pll_div_out"),
CLK_MSR_ID(56, "cci"),
CLK_MSR_ID(57, "wave420l_c"),
CLK_MSR_ID(58, "wave420l_b"),
CLK_MSR_ID(59, "hcodec"),
CLK_MSR_ID(60, "alt_32k"),
CLK_MSR_ID(61, "gpio_msr"),
CLK_MSR_ID(62, "hevc"),
CLK_MSR_ID(66, "vid_lock"),
CLK_MSR_ID(70, "pwm_f"),
CLK_MSR_ID(71, "pwm_e"),
CLK_MSR_ID(72, "pwm_d"),
CLK_MSR_ID(73, "pwm_c"),
CLK_MSR_ID(75, "aoclkx2_int"),
CLK_MSR_ID(76, "aoclk_int"),
CLK_MSR_ID(77, "rng_ring_osc_0"),
CLK_MSR_ID(78, "rng_ring_osc_1"),
CLK_MSR_ID(79, "rng_ring_osc_2"),
CLK_MSR_ID(80, "rng_ring_osc_3"),
CLK_MSR_ID(81, "vapb"),
CLK_MSR_ID(82, "ge2d"),
};
static struct meson_msr_id clk_msr_g12a[] __initdata = {
CLK_MSR_ID(0, "ring_osc_out_ee_0"),
CLK_MSR_ID(1, "ring_osc_out_ee_1"),
CLK_MSR_ID(2, "ring_osc_out_ee_2"),
CLK_MSR_ID(3, "a53_ring_osc"),
CLK_MSR_ID(4, "gp0_pll"),
CLK_MSR_ID(6, "enci"),
CLK_MSR_ID(7, "clk81"),
CLK_MSR_ID(8, "encp"),
CLK_MSR_ID(9, "encl"),
CLK_MSR_ID(10, "vdac"),
CLK_MSR_ID(11, "mac_eth_tx"),
CLK_MSR_ID(12, "hifi_pll"),
CLK_MSR_ID(13, "mod_tcon"),
CLK_MSR_ID(14, "fec_0"),
CLK_MSR_ID(15, "fec_1"),
CLK_MSR_ID(16, "fec_2"),
CLK_MSR_ID(17, "sys_pll_div16"),
CLK_MSR_ID(18, "sys_cpu_div16"),
CLK_MSR_ID(19, "lcd_an_ph2"),
CLK_MSR_ID(20, "rtc_osc_out"),
CLK_MSR_ID(21, "lcd_an_ph3"),
CLK_MSR_ID(22, "eth_phy_ref"),
CLK_MSR_ID(23, "mpll_clk_50m"),
CLK_MSR_ID(24, "cts_eth_clk125Mhz"),
CLK_MSR_ID(25, "cts_eth_clk_rmii"),
CLK_MSR_ID(26, "sc_int"),
CLK_MSR_ID(27, "co_clkin_to_mac"),
CLK_MSR_ID(28, "sar_adc"),
CLK_MSR_ID(29, "pcie_clk_inp"),
CLK_MSR_ID(30, "pcie_clk_inn"),
CLK_MSR_ID(31, "mpll_test_out"),
CLK_MSR_ID(32, "vdec"),
CLK_MSR_ID(33, "sys_cpu_ring_osc_clk[1]"),
CLK_MSR_ID(34, "eth_mppll_50m_ckout[1]"),
CLK_MSR_ID(35, "mali"),
CLK_MSR_ID(36, "hdmi_tx_pixel"),
CLK_MSR_ID(37, "cdac_clk_c"),
CLK_MSR_ID(38, "vdin_meas"),
CLK_MSR_ID(39, "bt656_clk0"),
CLK_MSR_ID(41, "mac_eth_rx_clk_rmii"),
CLK_MSR_ID(42, "mp0_clk_out"),
CLK_MSR_ID(43, "fclk_div5"),
CLK_MSR_ID(44, "pwm_b"),
CLK_MSR_ID(45, "pwm_a"),
CLK_MSR_ID(46, "vpu"),
CLK_MSR_ID(47, "ddr_dpll_pt"),
CLK_MSR_ID(48, "mp1_clk_out"),
CLK_MSR_ID(49, "mp2_clk_out"),
CLK_MSR_ID(50, "mp3_clk_out"),
CLK_MSR_ID(50, "mp3_clk_out"),
CLK_MSR_ID(51, "mp3_clk_out"),
CLK_MSR_ID(51, "sd_emmc_c"),
CLK_MSR_ID(52, "sd_emmc_b"),
CLK_MSR_ID(53, "sd_emmc_a"),
CLK_MSR_ID(54, "cts_vpu_clkc"),
CLK_MSR_ID(55, "vid_pll_div_out"),
CLK_MSR_ID(56, "wave420l_a"),
CLK_MSR_ID(57, "wave420l_c"),
CLK_MSR_ID(58, "wave420l_b"),
CLK_MSR_ID(59, "hcodec"),
CLK_MSR_ID(61, "gpio_msr"),
CLK_MSR_ID(62, "hevcb"),
CLK_MSR_ID(63, "dsi_meas"),
CLK_MSR_ID(64, "spicc_1"),
CLK_MSR_ID(65, "spicc_0"),
CLK_MSR_ID(66, "vid_lock"),
CLK_MSR_ID(67, "dsi_phy"),
CLK_MSR_ID(68, "hdcp22_esmclk"),
CLK_MSR_ID(69, "hdcp22_skpclk"),
CLK_MSR_ID(70, "pwm_f"),
CLK_MSR_ID(71, "pwm_e"),
CLK_MSR_ID(72, "pwm_d"),
CLK_MSR_ID(73, "pwm_c"),
CLK_MSR_ID(75, "hevcf"),
CLK_MSR_ID(77, "rng_ring_osc_0"),
CLK_MSR_ID(78, "rng_ring_osc_1"),
CLK_MSR_ID(79, "rng_ring_osc_2"),
CLK_MSR_ID(80, "rng_ring_osc_3"),
CLK_MSR_ID(81, "vapb"),
CLK_MSR_ID(82, "ge2d"),
CLK_MSR_ID(83, "co_rx"),
CLK_MSR_ID(84, "co_tx"),
CLK_MSR_ID(89, "hdmi_clk_todig"),
CLK_MSR_ID(90, "hdmitx_sys"),
CLK_MSR_ID(94, "eth_phy_rxclk"),
CLK_MSR_ID(95, "eth_phy_plltxclk"),
CLK_MSR_ID(96, "cts_vpu_clkb"),
CLK_MSR_ID(97, "cts_vpu_clkb_tmp"),
CLK_MSR_ID(98, "cts_ts_clk"),
CLK_MSR_ID(99, "am_ring_osc_clk_out_ee_3"),
CLK_MSR_ID(100, "am_ring_osc_clk_out_ee_4"),
CLK_MSR_ID(101, "am_ring_osc_clk_out_ee_5"),
CLK_MSR_ID(102, "am_ring_osc_clk_out_ee_6"),
CLK_MSR_ID(103, "am_ring_osc_clk_out_ee_7"),
CLK_MSR_ID(104, "am_ring_osc_clk_out_ee_8"),
CLK_MSR_ID(105, "am_ring_osc_clk_out_ee_9"),
CLK_MSR_ID(106, "ephy_test_clk"),
CLK_MSR_ID(107, "au_dac_clk_g128x"),
CLK_MSR_ID(108, "c_alocker_in_clk"),
CLK_MSR_ID(109, "c_alocker_out_clk"),
CLK_MSR_ID(110, "audio_tdmout_c_sclk"),
CLK_MSR_ID(111, "audio_tdmout_b_sclk"),
CLK_MSR_ID(111, "audio_tdmout_b_sclk"),
CLK_MSR_ID(112, "audio_tdmout_a_sclk"),
CLK_MSR_ID(113, "audio_tdmin_lb_sclk"),
CLK_MSR_ID(114, "audio_tdmin_c_sclk"),
CLK_MSR_ID(115, "audio_tdmin_b_sclk"),
CLK_MSR_ID(116, "audio_tdmin_a_sclk"),
CLK_MSR_ID(117, "audio_resample_clk"),
CLK_MSR_ID(118, "audio_pdm_sysclk"),
CLK_MSR_ID(119, "audio_spdifout_b_mst_clk"),
CLK_MSR_ID(120, "audio_spdifout_mst_clk"),
CLK_MSR_ID(121, "audio_spdifin_mst_clk"),
CLK_MSR_ID(122, "mod_audio_pdm_dclk_o"),
};
static struct meson_msr_id clk_msr_sm1[] __initdata = {
CLK_MSR_ID(0, "ring_osc_out_ee_0"),
CLK_MSR_ID(1, "ring_osc_out_ee_1"),
CLK_MSR_ID(2, "ring_osc_out_ee_2"),
CLK_MSR_ID(3, "ring_osc_out_ee_2"),
CLK_MSR_ID(4, "gp0_pll"),
CLK_MSR_ID(5, "gp1_pll"),
CLK_MSR_ID(6, "enci"),
CLK_MSR_ID(7, "clk81"),
CLK_MSR_ID(8, "encp"),
CLK_MSR_ID(9, "encl"),
CLK_MSR_ID(10, "vdac"),
CLK_MSR_ID(11, "mac_eth_tx"),
CLK_MSR_ID(12, "hifi_pll"),
CLK_MSR_ID(13, "mod_tcon"),
CLK_MSR_ID(14, "fec_0"),
CLK_MSR_ID(15, "fec_1"),
CLK_MSR_ID(16, "fec_2"),
CLK_MSR_ID(17, "sys_pll_div16"),
CLK_MSR_ID(18, "sys_cpu_div16"),
CLK_MSR_ID(19, "lcd_an_ph2"),
CLK_MSR_ID(20, "rtc_osc_out"),
CLK_MSR_ID(21, "lcd_an_ph3"),
CLK_MSR_ID(22, "eth_phy_ref"),
CLK_MSR_ID(23, "mpll_clk_50m"),
CLK_MSR_ID(24, "cts_eth_clk125Mhz"),
CLK_MSR_ID(25, "cts_eth_clk_rmii"),
CLK_MSR_ID(26, "sc_int"),
CLK_MSR_ID(27, "co_clkin_to_mac"),
CLK_MSR_ID(28, "sar_adc"),
CLK_MSR_ID(29, "pcie_clk_inp"),
CLK_MSR_ID(30, "pcie_clk_inn"),
CLK_MSR_ID(31, "mpll_test_out"),
CLK_MSR_ID(32, "vdec"),
CLK_MSR_ID(34, "eth_mppll_50m_ckout[1]"),
CLK_MSR_ID(35, "mali"),
CLK_MSR_ID(36, "hdmi_tx_pixel"),
CLK_MSR_ID(37, "cdac_clk_c"),
CLK_MSR_ID(38, "vdin_meas"),
CLK_MSR_ID(39, "bt656_clk0"),
CLK_MSR_ID(40, "am_ring_osc_clk_out_4"),
CLK_MSR_ID(41, "mac_eth_rx_clk_rmii"),
CLK_MSR_ID(42, "mp0_clk_out"),
CLK_MSR_ID(43, "fclk_div5"),
CLK_MSR_ID(44, "pwm_b"),
CLK_MSR_ID(45, "pwm_a"),
CLK_MSR_ID(46, "vpu"),
CLK_MSR_ID(47, "ddr_dpll_pt"),
CLK_MSR_ID(48, "mp1_clk_out"),
CLK_MSR_ID(49, "mp2_clk_out"),
CLK_MSR_ID(50, "mp3_clk_out"),
CLK_MSR_ID(50, "mp3_clk_out"),
CLK_MSR_ID(51, "mp3_clk_out"),
CLK_MSR_ID(51, "sd_emmc_c"),
CLK_MSR_ID(52, "sd_emmc_b"),
CLK_MSR_ID(53, "sd_emmc_a"),
CLK_MSR_ID(54, "cts_vpu_clkc"),
CLK_MSR_ID(55, "vid_pll_div_out"),
CLK_MSR_ID(56, "wave420l_a"),
CLK_MSR_ID(57, "wave420l_c"),
CLK_MSR_ID(58, "wave420l_b"),
CLK_MSR_ID(59, "hcodec"),
CLK_MSR_ID(60, "am_ring_osc_clk_out_5"),
CLK_MSR_ID(61, "gpio_msr"),
CLK_MSR_ID(62, "hevcb"),
CLK_MSR_ID(63, "dsi_meas"),
CLK_MSR_ID(64, "spicc_1"),
CLK_MSR_ID(65, "spicc_0"),
CLK_MSR_ID(66, "vid_lock"),
CLK_MSR_ID(67, "dsi_phy"),
CLK_MSR_ID(68, "hdcp22_esmclk"),
CLK_MSR_ID(69, "hdcp22_skpclk"),
CLK_MSR_ID(70, "pwm_f"),
CLK_MSR_ID(71, "pwm_e"),
CLK_MSR_ID(72, "pwm_d"),
CLK_MSR_ID(73, "pwm_c"),
CLK_MSR_ID(74, "am_ring_osc_clk_out_6"),
CLK_MSR_ID(75, "hevcf"),
CLK_MSR_ID(76, "am_ring_osc_clk_out_7"),
CLK_MSR_ID(77, "rng_ring_osc_0"),
CLK_MSR_ID(78, "rng_ring_osc_1"),
CLK_MSR_ID(79, "rng_ring_osc_2"),
CLK_MSR_ID(80, "rng_ring_osc_3"),
CLK_MSR_ID(81, "vapb"),
CLK_MSR_ID(82, "ge2d"),
CLK_MSR_ID(83, "co_rx"),
CLK_MSR_ID(84, "co_tx"),
CLK_MSR_ID(85, "am_ring_osc_clk_out_8"),
CLK_MSR_ID(86, "am_ring_osc_clk_out_9"),
CLK_MSR_ID(87, "mipi_csi_phy_clk"),
CLK_MSR_ID(88, "csi_adapt_clk"),
CLK_MSR_ID(89, "hdmi_clk_todig"),
CLK_MSR_ID(90, "hdmitx_sys"),
CLK_MSR_ID(91, "nna_core_clk"),
CLK_MSR_ID(92, "nna_axi_clk"),
CLK_MSR_ID(93, "vad_clk"),
CLK_MSR_ID(94, "eth_phy_rxclk"),
CLK_MSR_ID(95, "eth_phy_plltxclk"),
CLK_MSR_ID(96, "cts_vpu_clkb"),
CLK_MSR_ID(97, "cts_vpu_clkb_tmp"),
CLK_MSR_ID(98, "cts_ts_clk"),
CLK_MSR_ID(99, "am_ring_osc_clk_out_ee_10"),
CLK_MSR_ID(100, "am_ring_osc_clk_out_ee_11"),
CLK_MSR_ID(101, "am_ring_osc_clk_out_ee_12"),
CLK_MSR_ID(102, "am_ring_osc_clk_out_ee_13"),
CLK_MSR_ID(103, "am_ring_osc_clk_out_ee_14"),
CLK_MSR_ID(104, "am_ring_osc_clk_out_ee_15"),
CLK_MSR_ID(105, "am_ring_osc_clk_out_ee_16"),
CLK_MSR_ID(106, "ephy_test_clk"),
CLK_MSR_ID(107, "au_dac_clk_g128x"),
CLK_MSR_ID(108, "c_alocker_in_clk"),
CLK_MSR_ID(109, "c_alocker_out_clk"),
CLK_MSR_ID(110, "audio_tdmout_c_sclk"),
CLK_MSR_ID(111, "audio_tdmout_b_sclk"),
CLK_MSR_ID(111, "audio_tdmout_b_sclk"),
CLK_MSR_ID(112, "audio_tdmout_a_sclk"),
CLK_MSR_ID(113, "audio_tdmin_lb_sclk"),
CLK_MSR_ID(114, "audio_tdmin_c_sclk"),
CLK_MSR_ID(115, "audio_tdmin_b_sclk"),
CLK_MSR_ID(116, "audio_tdmin_a_sclk"),
CLK_MSR_ID(117, "audio_resampleA_clk"),
CLK_MSR_ID(118, "audio_pdm_sysclk"),
CLK_MSR_ID(119, "audio_spdifout_b_mst_clk"),
CLK_MSR_ID(120, "audio_spdifout_mst_clk"),
CLK_MSR_ID(121, "audio_spdifin_mst_clk"),
CLK_MSR_ID(122, "mod_audio_pdm_dclk_o"),
CLK_MSR_ID(123, "audio_resampleb_clk"),
CLK_MSR_ID(124, "earcrx_pll_dmac_clk"),
CLK_MSR_ID(125, "earcrx_pll_test_clk"),
CLK_MSR_ID(126, "csi_phy0_clk_out"),
CLK_MSR_ID(127, "clk_csi2_data"),
};
static struct meson_msr_id clk_msr_a1[] __initdata = {
CLK_MSR_ID(0, "tdmout_b_sclk"),
CLK_MSR_ID(1, "tdmout_a_sclk"),
CLK_MSR_ID(2, "tdmin_lb_sclk"),
CLK_MSR_ID(3, "tdmin_b_sclk"),
CLK_MSR_ID(4, "tdmin_a_sclk"),
CLK_MSR_ID(5, "vad_clk"),
CLK_MSR_ID(6, "resampleA_clk"),
CLK_MSR_ID(7, "pdm_sysclk"),
CLK_MSR_ID(8, "pdm_dclk"),
CLK_MSR_ID(9, "locker_out_clk"),
CLK_MSR_ID(10, "locker_in_clk"),
CLK_MSR_ID(11, "spdifin_clk"),
CLK_MSR_ID(12, "tdmin_vad_clk"),
CLK_MSR_ID(13, "au_adc_clk"),
CLK_MSR_ID(14, "au_dac_clk"),
CLK_MSR_ID(16, "spicc_a_clk"),
CLK_MSR_ID(17, "spifc_clk"),
CLK_MSR_ID(18, "sd_emmc_a_clk"),
CLK_MSR_ID(19, "dmcx4_clk"),
CLK_MSR_ID(20, "dmc_clk"),
CLK_MSR_ID(21, "psram_clk"),
CLK_MSR_ID(22, "cecb_clk"),
CLK_MSR_ID(23, "ceca_clk"),
CLK_MSR_ID(24, "ts_clk"),
CLK_MSR_ID(25, "pwm_f_clk"),
CLK_MSR_ID(26, "pwm_e_clk"),
CLK_MSR_ID(27, "pwm_d_clk"),
CLK_MSR_ID(28, "pwm_c_clk"),
CLK_MSR_ID(29, "pwm_b_clk"),
CLK_MSR_ID(30, "pwm_a_clk"),
CLK_MSR_ID(31, "saradc_clk"),
CLK_MSR_ID(32, "usb_bus"),
CLK_MSR_ID(33, "dsp_b_clk"),
CLK_MSR_ID(34, "dsp_a_clk"),
CLK_MSR_ID(35, "axi_clk"),
CLK_MSR_ID(36, "sys_clk"),
CLK_MSR_ID(40, "rng_ring_osc0"),
CLK_MSR_ID(41, "rng_ring_osc1"),
CLK_MSR_ID(42, "rng_ring_osc2"),
CLK_MSR_ID(43, "rng_ring_osc3"),
CLK_MSR_ID(44, "dds_out"),
CLK_MSR_ID(45, "cpu_clk_div16"),
CLK_MSR_ID(46, "gpio_msr"),
CLK_MSR_ID(50, "osc_ring_cpu0"),
CLK_MSR_ID(51, "osc_ring_cpu1"),
CLK_MSR_ID(54, "osc_ring_top0"),
CLK_MSR_ID(55, "osc_ring_top1"),
CLK_MSR_ID(56, "osc_ring_ddr"),
CLK_MSR_ID(57, "osc_ring_dmc"),
CLK_MSR_ID(58, "osc_ring_dspa"),
CLK_MSR_ID(59, "osc_ring_dspb"),
CLK_MSR_ID(60, "osc_ring_rama"),
CLK_MSR_ID(61, "osc_ring_ramb"),
};
static struct meson_msr_id clk_msr_c1[] __initdata = {
CLK_MSR_ID(0, "tdmout_b_sclk"),
CLK_MSR_ID(1, "tdmout_a_sclk"),
CLK_MSR_ID(2, "tdmin_lb_sclk"),
CLK_MSR_ID(3, "tdmin_b_sclk"),
CLK_MSR_ID(4, "tdmin_a_sclk"),
CLK_MSR_ID(5, "vad_clk"),
CLK_MSR_ID(6, "resampleA_clk"),
CLK_MSR_ID(7, "pdm_sysclk"),
CLK_MSR_ID(8, "pdm_dclk"),
CLK_MSR_ID(9, "locker_out_clk"),
CLK_MSR_ID(10, "locker_in_clk"),
CLK_MSR_ID(12, "tdmin_vad_clk"),
CLK_MSR_ID(13, "au_adc_clk"),
CLK_MSR_ID(14, "au_dac_clk"),
CLK_MSR_ID(16, "spicc_a_clk"),
CLK_MSR_ID(17, "spifc_clk"),
CLK_MSR_ID(18, "sd_emmc_a_clk"),
CLK_MSR_ID(19, "spicc_b_clk"),
CLK_MSR_ID(24, "ts_clk"),
CLK_MSR_ID(25, "pwm_f_clk"),
CLK_MSR_ID(26, "pwm_e_clk"),
CLK_MSR_ID(27, "pwm_d_clk"),
CLK_MSR_ID(28, "pwm_c_clk"),
CLK_MSR_ID(29, "pwm_b_clk"),
CLK_MSR_ID(30, "pwm_a_clk"),
CLK_MSR_ID(31, "saradc_clk"),
CLK_MSR_ID(32, "usb_bus"),
CLK_MSR_ID(33, "dsp_b_clk"),
CLK_MSR_ID(34, "dsp_a_clk"),
CLK_MSR_ID(35, "axi_clk"),
CLK_MSR_ID(36, "sys_clk"),
CLK_MSR_ID(39, "gpio_msr"),
CLK_MSR_ID(40, "rng_ring_osc0"),
CLK_MSR_ID(41, "rng_ring_osc1"),
CLK_MSR_ID(42, "rng_ring_osc2"),
CLK_MSR_ID(43, "rng_ring_osc3"),
CLK_MSR_ID(44, "dds_out"),
CLK_MSR_ID(45, "cpu_clk_div16"),
CLK_MSR_ID(46, "osc_ring_cpu0"),
CLK_MSR_ID(47, "osc_ring_cpu1"),
CLK_MSR_ID(48, "osc_ring_cpu2"),
CLK_MSR_ID(49, "osc_ring_cpu3"),
CLK_MSR_ID(50, "osc_ring_ddr"),
CLK_MSR_ID(51, "osc_ring_dmc"),
CLK_MSR_ID(52, "osc_ring_dspa"),
CLK_MSR_ID(53, "osc_ring_dspb"),
CLK_MSR_ID(54, "osc_ring_rama"),
CLK_MSR_ID(55, "osc_ring_ramb"),
CLK_MSR_ID(56, "osc_ring_ramc"),
CLK_MSR_ID(57, "osc_ring_dos0"),
CLK_MSR_ID(58, "osc_ring_dos1"),
CLK_MSR_ID(59, "osc_ring_dos2"),
CLK_MSR_ID(60, "osc_ring_dos3"),
CLK_MSR_ID(62, "eth_mppll_50m"),
CLK_MSR_ID(63, "co_clkin_to_mac"),
CLK_MSR_ID(64, "eth_phy_plltxclk"),
CLK_MSR_ID(65, "eth_phy_rxclk"),
CLK_MSR_ID(66, "co_tx_clk"),
CLK_MSR_ID(67, "co_rx_clk"),
CLK_MSR_ID(68, "cts_mipi_isp_clk"),
CLK_MSR_ID(69, "cts_mipi_csi_phy_clk"),
CLK_MSR_ID(70, "cts_nna_axi_clk"),
CLK_MSR_ID(71, "cts_nna_core_clk"),
CLK_MSR_ID(72, "cts_eth_clk_rmii"),
CLK_MSR_ID(73, "cts_eth_clk125Mhz"),
CLK_MSR_ID(74, "cts_jpeg_enc_clk "),
CLK_MSR_ID(75, "cts_rtc_clk"),
CLK_MSR_ID(76, "cts_rtc_clk"),
CLK_MSR_ID(77, "cts_gdc_axi_clk"),
CLK_MSR_ID(78, "cts_gdc_core_clk"),
CLK_MSR_ID(79, "cts_pwm_j_clk"),
CLK_MSR_ID(80, "cts_pwm_i_clk"),
CLK_MSR_ID(81, "cts_pwm_h_clk"),
CLK_MSR_ID(82, "cts_pwm_g_clk"),
CLK_MSR_ID(83, "cts_wave_cclk"),
CLK_MSR_ID(84, "cts_wave_bclk"),
CLK_MSR_ID(85, "cts_wave_aclk"),
CLK_MSR_ID(86, "cts_sd_emmc_C_clk"),
CLK_MSR_ID(87, "cts_sd_emmc_B_clk"),
CLK_MSR_ID(88, "ephy_test_clk"),
CLK_MSR_ID(89, "mipi_csi_phy0_clk"),
CLK_MSR_ID(90, "mipi_csi_phy1_clk"),
CLK_MSR_ID(91, "mod_eth_phy_ref_clk"),
CLK_MSR_ID(92, "ddr_dpll_pt_clk"),
};
static struct meson_msr_id clk_msr_c2[] __initdata = {
CLK_MSR_ID(0, "tdmout_b_sclk"),
CLK_MSR_ID(1, "tdmout_a_sclk"),
CLK_MSR_ID(2, "tdmin_lb_sclk"),
CLK_MSR_ID(3, "tdmin_b_sclk"),
CLK_MSR_ID(4, "tdmin_a_sclk"),
CLK_MSR_ID(5, "vad_clk"),
CLK_MSR_ID(6, "resampleA_clk"),
CLK_MSR_ID(7, "pdm_sysclk"),
CLK_MSR_ID(8, "pdm_dclk"),
CLK_MSR_ID(9, "locker_out_clk"),
CLK_MSR_ID(10, "locker_in_clk"),
CLK_MSR_ID(12, "mst_sclk_vad"),
CLK_MSR_ID(13, "au_adc_clk"),
CLK_MSR_ID(14, "au_dac_clk"),
CLK_MSR_ID(15, "resampleb_clk"),
CLK_MSR_ID(16, "spicc_a_clk"),
CLK_MSR_ID(17, "spifc_clk"),
CLK_MSR_ID(18, "sd_emmc_a_clk"),
CLK_MSR_ID(19, "spicc_b_clk"),
CLK_MSR_ID(20, "axi_clk_frcpu"),
CLK_MSR_ID(21, "deskew_pll_clk"),
CLK_MSR_ID(24, "ts_clk"),
CLK_MSR_ID(25, "pwm_f_clk"),
CLK_MSR_ID(26, "pwm_e_clk"),
CLK_MSR_ID(27, "pwm_d_clk"),
CLK_MSR_ID(28, "pwm_c_clk"),
CLK_MSR_ID(29, "pwm_b_clk"),
CLK_MSR_ID(30, "pwm_a_clk"),
CLK_MSR_ID(31, "cts_saradc_clk"),
CLK_MSR_ID(32, "usb_bus"),
CLK_MSR_ID(34, "dsp_a_clk"),
CLK_MSR_ID(35, "axi_clk_nic"),
CLK_MSR_ID(36, "sys_clk_nic"),
CLK_MSR_ID(37, "gp_pll_ckout2"),
CLK_MSR_ID(38, "gp_pll_ckout1"),
CLK_MSR_ID(39, "gpio_msr"),
CLK_MSR_ID(40, "rng_ring_osc0"),
CLK_MSR_ID(41, "rng_ring_osc1"),
CLK_MSR_ID(42, "rng_ring_osc2"),
CLK_MSR_ID(43, "rng_ring_osc3"),
CLK_MSR_ID(45, "sys_cpu_clk_div16"),
CLK_MSR_ID(64, "usb_pll_out"),
CLK_MSR_ID(65, "sar_adc_clk"),
CLK_MSR_ID(66, "mod_crt_clk25"),
CLK_MSR_ID(67, "mod_crt_clk12_24"),
CLK_MSR_ID(68, "cts_mipi_isp_clk"),
CLK_MSR_ID(69, "cts_mipi_csi_phy_clk"),
CLK_MSR_ID(70, "cts_nna_axi_clk"),
CLK_MSR_ID(71, "cts_nna_core_clk"),
CLK_MSR_ID(73, "cts_secpu_clk"),
CLK_MSR_ID(74, "cts_jpeg_enc_clk "),
CLK_MSR_ID(75, "cts_rtc_clk"),
CLK_MSR_ID(76, "cts_ge2d_clk"),
CLK_MSR_ID(77, "cts_gdc_axi_clk"),
CLK_MSR_ID(78, "cts_gdc_core_clk"),
CLK_MSR_ID(79, "cts_pwm_j_clk"),
CLK_MSR_ID(80, "cts_pwm_i_clk"),
CLK_MSR_ID(81, "cts_pwm_h_clk"),
CLK_MSR_ID(82, "cts_pwm_g_clk"),
CLK_MSR_ID(83, "cts_wave_cclk"),
CLK_MSR_ID(84, "cts_wave_bclk"),
CLK_MSR_ID(85, "cts_wave_aclk"),
CLK_MSR_ID(86, "cts_sd_emmc_C_clk"),
CLK_MSR_ID(87, "cts_sd_emmc_B_clk"),
CLK_MSR_ID(89, "mipi_csi_phy0_clk"),
CLK_MSR_ID(90, "mipi_csi_phy1_clk"),
CLK_MSR_ID(91, "mod_eth_phy_ref_clk"),
CLK_MSR_ID(92, "ddr_dpll_pt_clk"),
CLK_MSR_ID(93, "osc_ring_cpu0"),
CLK_MSR_ID(94, "osc_ring_cpu0"),
CLK_MSR_ID(95, "osc_ring_cpu0"),
};
static int meson_measure_id(struct meson_msr_id *clk_msr_id,
unsigned int duration)
{
struct meson_msr *priv = clk_msr_id->priv;
unsigned int val;
int ret;
regmap_write(priv->regmap, priv->data->reg0_offset, 0);
/* Set measurement duration */
regmap_update_bits(priv->regmap, priv->data->reg0_offset, MSR_DURATION,
FIELD_PREP(MSR_DURATION, duration - 1));
/* Set ID */
regmap_update_bits(priv->regmap, priv->data->reg0_offset, MSR_CLK_SRC,
FIELD_PREP(MSR_CLK_SRC, clk_msr_id->id));
/* Enable & Start */
regmap_update_bits(priv->regmap, priv->data->reg0_offset,
MSR_RUN | MSR_ENABLE,
MSR_RUN | MSR_ENABLE);
ret = regmap_read_poll_timeout(priv->regmap, priv->data->reg0_offset,
val, !(val & MSR_BUSY), 10, 10000);
if (ret)
return ret;
/* Disable */
regmap_update_bits(priv->regmap, priv->data->reg0_offset,
MSR_ENABLE, 0);
/* Get the value in multiple of gate time counts */
regmap_read(priv->regmap, priv->data->reg2_offset, &val);
if (val >= MSR_VAL_MASK)
return -EINVAL;
return DIV_ROUND_CLOSEST_ULL((val & MSR_VAL_MASK) * 1000000ULL,
duration);
}
int meson_clk_measure(unsigned int id)
{
struct meson_msr_id *clk_msr_id = NULL;
clk_msr_id = glo_meson_msr->data->msr_table;
clk_msr_id->priv = glo_meson_msr;
clk_msr_id->id = id;
return meson_measure_id(clk_msr_id, DIV_MAX);
}
EXPORT_SYMBOL_GPL(meson_clk_measure);
static int meson_measure_best_id(struct meson_msr_id *clk_msr_id,
unsigned int *precision)
{
unsigned int duration = DIV_MAX;
int ret;
/* Start from max duration and down to min duration */
do {
ret = meson_measure_id(clk_msr_id, duration);
if (ret >= 0)
*precision = (2 * 1000000) / duration;
else
duration -= DIV_STEP;
} while (duration >= DIV_MIN && ret == -EINVAL);
return ret;
}
static int clk_msr_show(struct seq_file *s, void *data)
{
struct meson_msr_id *clk_msr_id = s->private;
unsigned int precision = 0;
int val;
val = meson_measure_best_id(clk_msr_id, &precision);
if (val < 0)
return val;
seq_printf(s, "%d\t+/-%dHz\n", val, precision);
return 0;
}
DEFINE_SHOW_ATTRIBUTE(clk_msr);
static int clk_msr_summary_show(struct seq_file *s, void *data)
{
struct meson_msr_id *msr_table = s->private;
unsigned int precision = 0;
int val, i;
seq_puts(s, " clock rate precision\n");
seq_puts(s, "---------------------------------------------\n");
for (i = 0 ; i < measure_num; ++i) {
if (!msr_table[i].name)
continue;
val = meson_measure_best_id(&msr_table[i], &precision);
if (val < 0)
return val;
seq_printf(s, " %-20s %10d +/-%dHz\n",
msr_table[i].name, val, precision);
}
return 0;
}
DEFINE_SHOW_ATTRIBUTE(clk_msr_summary);
static struct regmap_config meson_clk_msr_regmap_config = {
.reg_bits = 32,
.val_bits = 32,
.reg_stride = 4,
};
static int meson_msr_probe(struct platform_device *pdev)
{
struct meson_msr *priv;
struct resource *res;
struct dentry *root, *clks;
void __iomem *base;
struct meson_msr_id *table;
int i;
struct meson_msr_data *msr_data;
priv = devm_kzalloc(&pdev->dev, sizeof(struct meson_msr),
GFP_KERNEL);
if (!priv)
return -ENOMEM;
priv->data = (struct meson_msr_data *)device_get_match_data(&pdev->dev);
if (!priv->data) {
dev_err(&pdev->dev, "failed to get match data\n");
return -ENODEV;
}
table = devm_kzalloc(&pdev->dev,
priv->data->table_size * sizeof(*table),
GFP_KERNEL);
if (!table)
return -ENOMEM;
memcpy(table, priv->data->msr_table,
priv->data->table_size * sizeof(*table));
priv->data->msr_table = table;
measure_num = priv->data->table_size;
/* alloc space for measure data, store the platform data */
msr_data = devm_kzalloc(&pdev->dev, sizeof(struct meson_msr_data),
GFP_KERNEL);
if (!msr_data)
return -ENOMEM;
memcpy(msr_data, priv->data, sizeof(struct meson_msr_data));
priv->data = msr_data;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
base = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(base)) {
dev_err(&pdev->dev, "io resource mapping failed\n");
return PTR_ERR(base);
}
meson_clk_msr_regmap_config.max_register = priv->data->reg2_offset;
priv->regmap = devm_regmap_init_mmio(&pdev->dev, base,
&meson_clk_msr_regmap_config);
if (IS_ERR(priv->regmap))
return PTR_ERR(priv->regmap);
root = debugfs_create_dir("aml_clkmsr", NULL);
clks = debugfs_create_dir("clks", root);
debugfs_create_file("clkmsr", 0444, root,
priv->data->msr_table, &clk_msr_summary_fops);
glo_meson_msr = priv;
for (i = 0 ; i < measure_num; ++i) {
if (!priv->data->msr_table[i].name)
continue;
priv->data->msr_table[i].priv = priv;
debugfs_create_file(priv->data->msr_table[i].name, 0444, clks,
&priv->data->msr_table[i], &clk_msr_fops);
}
return 0;
}
static struct meson_msr_data meson_gx_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_gx,
.table_size = ARRAY_SIZE(clk_msr_gx),
.duty_offset = 0x0,
.reg0_offset = 0x4,
.reg1_offset = 0x8,
.reg2_offset = 0xc,
};
static struct meson_msr_data meson_m8_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_m8,
.table_size = ARRAY_SIZE(clk_msr_m8),
.duty_offset = 0x0,
.reg0_offset = 0x4,
.reg1_offset = 0x8,
.reg2_offset = 0xc,
};
static struct meson_msr_data meson_g12a_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_g12a,
.table_size = ARRAY_SIZE(clk_msr_g12a),
.duty_offset = 0x0,
.reg0_offset = 0x4,
.reg1_offset = 0x8,
.reg2_offset = 0xc,
};
static struct meson_msr_data meson_sm1_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_sm1,
.table_size = ARRAY_SIZE(clk_msr_sm1),
.duty_offset = 0x0,
.reg0_offset = 0x4,
.reg1_offset = 0x8,
.reg2_offset = 0xc,
};
static struct meson_msr_data meson_a1_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_a1,
.table_size = ARRAY_SIZE(clk_msr_a1),
.duty_offset = (0x4 * 6),
.reg0_offset = 0x0,
.reg1_offset = 0x4,
.reg2_offset = 0x8,
};
static struct meson_msr_data meson_c1_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_c1,
.table_size = ARRAY_SIZE(clk_msr_c1),
.duty_offset = (0x4 * 6),
.reg0_offset = 0x0,
.reg1_offset = 0x4,
.reg2_offset = 0x8,
};
static struct meson_msr_data meson_c2_data __initdata = {
.msr_table = (struct meson_msr_id *)&clk_msr_c2,
.table_size = ARRAY_SIZE(clk_msr_c2),
.duty_offset = (0x4 * 6),
.reg0_offset = 0x0,
.reg1_offset = 0x4,
.reg2_offset = 0x8,
};
static const struct of_device_id meson_msr_match_table[] = {
{
.compatible = "amlogic,meson-gx-clk-measure",
.data = &meson_gx_data,
},
{
.compatible = "amlogic,meson8-clk-measure",
.data = &meson_m8_data,
},
{
.compatible = "amlogic,meson8b-clk-measure",
.data = &meson_m8_data,
},
{
.compatible = "amlogic,g12a-clk-measure",
.data = &meson_g12a_data,
},
{
.compatible = "amlogic,sm1-clk-measure",
.data = &meson_sm1_data,
},
{
.compatible = "amlogic,a1-clk-measure",
.data = &meson_a1_data,
},
{
.compatible = "amlogic,c1-clk-measure",
.data = &meson_c1_data,
},
{
.compatible = "amlogic,c2-clk-measure",
.data = &meson_c2_data,
},
{ /* sentinel */ }
};
static struct platform_driver meson_msr_driver = {
.probe = meson_msr_probe,
.driver = {
.name = "meson_msr",
.of_match_table = meson_msr_match_table,
},
};
builtin_platform_driver(meson_msr_driver);