1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (c) 2018 BayLibre, SAS 4 * Author: Neil Armstrong <narmstrong@baylibre.com> 5 */ 6 7 #include <linux/of_address.h> 8 #include <linux/platform_device.h> 9 #include <linux/bitfield.h> 10 #include <linux/seq_file.h> 11 #include <linux/debugfs.h> 12 #include <linux/regmap.h> 13 #include <linux/module.h> 14 15 static DEFINE_MUTEX(measure_lock); 16 17 #define MSR_CLK_DUTY 0x0 18 #define MSR_CLK_REG0 0x4 19 #define MSR_CLK_REG1 0x8 20 #define MSR_CLK_REG2 0xc 21 22 #define MSR_DURATION GENMASK(15, 0) 23 #define MSR_ENABLE BIT(16) 24 #define MSR_CONT BIT(17) /* continuous measurement */ 25 #define MSR_INTR BIT(18) /* interrupts */ 26 #define MSR_RUN BIT(19) 27 #define MSR_CLK_SRC GENMASK(26, 20) 28 #define MSR_BUSY BIT(31) 29 30 #define MSR_VAL_MASK GENMASK(15, 0) 31 32 #define DIV_MIN 32 33 #define DIV_STEP 32 34 #define DIV_MAX 640 35 36 #define CLK_MSR_MAX 128 37 38 struct meson_msr_id { 39 struct meson_msr *priv; 40 unsigned int id; 41 const char *name; 42 }; 43 44 struct meson_msr { 45 struct regmap *regmap; 46 struct meson_msr_id msr_table[CLK_MSR_MAX]; 47 }; 48 49 #define CLK_MSR_ID(__id, __name) \ 50 [__id] = {.id = __id, .name = __name,} 51 52 static struct meson_msr_id clk_msr_m8[CLK_MSR_MAX] = { 53 CLK_MSR_ID(0, "ring_osc_out_ee0"), 54 CLK_MSR_ID(1, "ring_osc_out_ee1"), 55 CLK_MSR_ID(2, "ring_osc_out_ee2"), 56 CLK_MSR_ID(3, "a9_ring_osck"), 57 CLK_MSR_ID(6, "vid_pll"), 58 CLK_MSR_ID(7, "clk81"), 59 CLK_MSR_ID(8, "encp"), 60 CLK_MSR_ID(9, "encl"), 61 CLK_MSR_ID(11, "eth_rmii"), 62 CLK_MSR_ID(13, "amclk"), 63 CLK_MSR_ID(14, "fec_clk_0"), 64 CLK_MSR_ID(15, "fec_clk_1"), 65 CLK_MSR_ID(16, "fec_clk_2"), 66 CLK_MSR_ID(18, "a9_clk_div16"), 67 CLK_MSR_ID(19, "hdmi_sys"), 68 CLK_MSR_ID(20, "rtc_osc_clk_out"), 69 CLK_MSR_ID(21, "i2s_clk_in_src0"), 70 CLK_MSR_ID(22, "clk_rmii_from_pad"), 71 CLK_MSR_ID(23, "hdmi_ch0_tmds"), 72 CLK_MSR_ID(24, "lvds_fifo"), 73 CLK_MSR_ID(26, "sc_clk_int"), 74 CLK_MSR_ID(28, "sar_adc"), 75 CLK_MSR_ID(30, "mpll_clk_test_out"), 76 CLK_MSR_ID(31, "audac_clkpi"), 77 CLK_MSR_ID(32, "vdac"), 78 CLK_MSR_ID(33, "sdhc_rx"), 79 CLK_MSR_ID(34, "sdhc_sd"), 80 CLK_MSR_ID(35, "mali"), 81 CLK_MSR_ID(36, "hdmi_tx_pixel"), 82 CLK_MSR_ID(38, "vdin_meas"), 83 CLK_MSR_ID(39, "pcm_sclk"), 84 CLK_MSR_ID(40, "pcm_mclk"), 85 CLK_MSR_ID(41, "eth_rx_tx"), 86 CLK_MSR_ID(42, "pwm_d"), 87 CLK_MSR_ID(43, "pwm_c"), 88 CLK_MSR_ID(44, "pwm_b"), 89 CLK_MSR_ID(45, "pwm_a"), 90 CLK_MSR_ID(46, "pcm2_sclk"), 91 CLK_MSR_ID(47, "ddr_dpll_pt"), 92 CLK_MSR_ID(48, "pwm_f"), 93 CLK_MSR_ID(49, "pwm_e"), 94 CLK_MSR_ID(59, "hcodec"), 95 CLK_MSR_ID(60, "usb_32k_alt"), 96 CLK_MSR_ID(61, "gpio"), 97 CLK_MSR_ID(62, "vid2_pll"), 98 CLK_MSR_ID(63, "mipi_csi_cfg"), 99 }; 100 101 static struct meson_msr_id clk_msr_gx[CLK_MSR_MAX] = { 102 CLK_MSR_ID(0, "ring_osc_out_ee_0"), 103 CLK_MSR_ID(1, "ring_osc_out_ee_1"), 104 CLK_MSR_ID(2, "ring_osc_out_ee_2"), 105 CLK_MSR_ID(3, "a53_ring_osc"), 106 CLK_MSR_ID(4, "gp0_pll"), 107 CLK_MSR_ID(6, "enci"), 108 CLK_MSR_ID(7, "clk81"), 109 CLK_MSR_ID(8, "encp"), 110 CLK_MSR_ID(9, "encl"), 111 CLK_MSR_ID(10, "vdac"), 112 CLK_MSR_ID(11, "rgmii_tx"), 113 CLK_MSR_ID(12, "pdm"), 114 CLK_MSR_ID(13, "amclk"), 115 CLK_MSR_ID(14, "fec_0"), 116 CLK_MSR_ID(15, "fec_1"), 117 CLK_MSR_ID(16, "fec_2"), 118 CLK_MSR_ID(17, "sys_pll_div16"), 119 CLK_MSR_ID(18, "sys_cpu_div16"), 120 CLK_MSR_ID(19, "hdmitx_sys"), 121 CLK_MSR_ID(20, "rtc_osc_out"), 122 CLK_MSR_ID(21, "i2s_in_src0"), 123 CLK_MSR_ID(22, "eth_phy_ref"), 124 CLK_MSR_ID(23, "hdmi_todig"), 125 CLK_MSR_ID(26, "sc_int"), 126 CLK_MSR_ID(28, "sar_adc"), 127 CLK_MSR_ID(31, "mpll_test_out"), 128 CLK_MSR_ID(32, "vdec"), 129 CLK_MSR_ID(35, "mali"), 130 CLK_MSR_ID(36, "hdmi_tx_pixel"), 131 CLK_MSR_ID(37, "i958"), 132 CLK_MSR_ID(38, "vdin_meas"), 133 CLK_MSR_ID(39, "pcm_sclk"), 134 CLK_MSR_ID(40, "pcm_mclk"), 135 CLK_MSR_ID(41, "eth_rx_or_rmii"), 136 CLK_MSR_ID(42, "mp0_out"), 137 CLK_MSR_ID(43, "fclk_div5"), 138 CLK_MSR_ID(44, "pwm_b"), 139 CLK_MSR_ID(45, "pwm_a"), 140 CLK_MSR_ID(46, "vpu"), 141 CLK_MSR_ID(47, "ddr_dpll_pt"), 142 CLK_MSR_ID(48, "mp1_out"), 143 CLK_MSR_ID(49, "mp2_out"), 144 CLK_MSR_ID(50, "mp3_out"), 145 CLK_MSR_ID(51, "nand_core"), 146 CLK_MSR_ID(52, "sd_emmc_b"), 147 CLK_MSR_ID(53, "sd_emmc_a"), 148 CLK_MSR_ID(55, "vid_pll_div_out"), 149 CLK_MSR_ID(56, "cci"), 150 CLK_MSR_ID(57, "wave420l_c"), 151 CLK_MSR_ID(58, "wave420l_b"), 152 CLK_MSR_ID(59, "hcodec"), 153 CLK_MSR_ID(60, "alt_32k"), 154 CLK_MSR_ID(61, "gpio_msr"), 155 CLK_MSR_ID(62, "hevc"), 156 CLK_MSR_ID(66, "vid_lock"), 157 CLK_MSR_ID(70, "pwm_f"), 158 CLK_MSR_ID(71, "pwm_e"), 159 CLK_MSR_ID(72, "pwm_d"), 160 CLK_MSR_ID(73, "pwm_c"), 161 CLK_MSR_ID(75, "aoclkx2_int"), 162 CLK_MSR_ID(76, "aoclk_int"), 163 CLK_MSR_ID(77, "rng_ring_osc_0"), 164 CLK_MSR_ID(78, "rng_ring_osc_1"), 165 CLK_MSR_ID(79, "rng_ring_osc_2"), 166 CLK_MSR_ID(80, "rng_ring_osc_3"), 167 CLK_MSR_ID(81, "vapb"), 168 CLK_MSR_ID(82, "ge2d"), 169 }; 170 171 static struct meson_msr_id clk_msr_axg[CLK_MSR_MAX] = { 172 CLK_MSR_ID(0, "ring_osc_out_ee_0"), 173 CLK_MSR_ID(1, "ring_osc_out_ee_1"), 174 CLK_MSR_ID(2, "ring_osc_out_ee_2"), 175 CLK_MSR_ID(3, "a53_ring_osc"), 176 CLK_MSR_ID(4, "gp0_pll"), 177 CLK_MSR_ID(5, "gp1_pll"), 178 CLK_MSR_ID(7, "clk81"), 179 CLK_MSR_ID(9, "encl"), 180 CLK_MSR_ID(17, "sys_pll_div16"), 181 CLK_MSR_ID(18, "sys_cpu_div16"), 182 CLK_MSR_ID(20, "rtc_osc_out"), 183 CLK_MSR_ID(23, "mmc_clk"), 184 CLK_MSR_ID(28, "sar_adc"), 185 CLK_MSR_ID(31, "mpll_test_out"), 186 CLK_MSR_ID(40, "mod_eth_tx_clk"), 187 CLK_MSR_ID(41, "mod_eth_rx_clk_rmii"), 188 CLK_MSR_ID(42, "mp0_out"), 189 CLK_MSR_ID(43, "fclk_div5"), 190 CLK_MSR_ID(44, "pwm_b"), 191 CLK_MSR_ID(45, "pwm_a"), 192 CLK_MSR_ID(46, "vpu"), 193 CLK_MSR_ID(47, "ddr_dpll_pt"), 194 CLK_MSR_ID(48, "mp1_out"), 195 CLK_MSR_ID(49, "mp2_out"), 196 CLK_MSR_ID(50, "mp3_out"), 197 CLK_MSR_ID(51, "sd_emmm_c"), 198 CLK_MSR_ID(52, "sd_emmc_b"), 199 CLK_MSR_ID(61, "gpio_msr"), 200 CLK_MSR_ID(66, "audio_slv_lrclk_c"), 201 CLK_MSR_ID(67, "audio_slv_lrclk_b"), 202 CLK_MSR_ID(68, "audio_slv_lrclk_a"), 203 CLK_MSR_ID(69, "audio_slv_sclk_c"), 204 CLK_MSR_ID(70, "audio_slv_sclk_b"), 205 CLK_MSR_ID(71, "audio_slv_sclk_a"), 206 CLK_MSR_ID(72, "pwm_d"), 207 CLK_MSR_ID(73, "pwm_c"), 208 CLK_MSR_ID(74, "wifi_beacon"), 209 CLK_MSR_ID(75, "tdmin_lb_lrcl"), 210 CLK_MSR_ID(76, "tdmin_lb_sclk"), 211 CLK_MSR_ID(77, "rng_ring_osc_0"), 212 CLK_MSR_ID(78, "rng_ring_osc_1"), 213 CLK_MSR_ID(79, "rng_ring_osc_2"), 214 CLK_MSR_ID(80, "rng_ring_osc_3"), 215 CLK_MSR_ID(81, "vapb"), 216 CLK_MSR_ID(82, "ge2d"), 217 CLK_MSR_ID(84, "audio_resample"), 218 CLK_MSR_ID(85, "audio_pdm_sys"), 219 CLK_MSR_ID(86, "audio_spdifout"), 220 CLK_MSR_ID(87, "audio_spdifin"), 221 CLK_MSR_ID(88, "audio_lrclk_f"), 222 CLK_MSR_ID(89, "audio_lrclk_e"), 223 CLK_MSR_ID(90, "audio_lrclk_d"), 224 CLK_MSR_ID(91, "audio_lrclk_c"), 225 CLK_MSR_ID(92, "audio_lrclk_b"), 226 CLK_MSR_ID(93, "audio_lrclk_a"), 227 CLK_MSR_ID(94, "audio_sclk_f"), 228 CLK_MSR_ID(95, "audio_sclk_e"), 229 CLK_MSR_ID(96, "audio_sclk_d"), 230 CLK_MSR_ID(97, "audio_sclk_c"), 231 CLK_MSR_ID(98, "audio_sclk_b"), 232 CLK_MSR_ID(99, "audio_sclk_a"), 233 CLK_MSR_ID(100, "audio_mclk_f"), 234 CLK_MSR_ID(101, "audio_mclk_e"), 235 CLK_MSR_ID(102, "audio_mclk_d"), 236 CLK_MSR_ID(103, "audio_mclk_c"), 237 CLK_MSR_ID(104, "audio_mclk_b"), 238 CLK_MSR_ID(105, "audio_mclk_a"), 239 CLK_MSR_ID(106, "pcie_refclk_n"), 240 CLK_MSR_ID(107, "pcie_refclk_p"), 241 CLK_MSR_ID(108, "audio_locker_out"), 242 CLK_MSR_ID(109, "audio_locker_in"), 243 }; 244 245 static struct meson_msr_id clk_msr_g12a[CLK_MSR_MAX] = { 246 CLK_MSR_ID(0, "ring_osc_out_ee_0"), 247 CLK_MSR_ID(1, "ring_osc_out_ee_1"), 248 CLK_MSR_ID(2, "ring_osc_out_ee_2"), 249 CLK_MSR_ID(3, "sys_cpu_ring_osc"), 250 CLK_MSR_ID(4, "gp0_pll"), 251 CLK_MSR_ID(6, "enci"), 252 CLK_MSR_ID(7, "clk81"), 253 CLK_MSR_ID(8, "encp"), 254 CLK_MSR_ID(9, "encl"), 255 CLK_MSR_ID(10, "vdac"), 256 CLK_MSR_ID(11, "eth_tx"), 257 CLK_MSR_ID(12, "hifi_pll"), 258 CLK_MSR_ID(13, "mod_tcon"), 259 CLK_MSR_ID(14, "fec_0"), 260 CLK_MSR_ID(15, "fec_1"), 261 CLK_MSR_ID(16, "fec_2"), 262 CLK_MSR_ID(17, "sys_pll_div16"), 263 CLK_MSR_ID(18, "sys_cpu_div16"), 264 CLK_MSR_ID(19, "lcd_an_ph2"), 265 CLK_MSR_ID(20, "rtc_osc_out"), 266 CLK_MSR_ID(21, "lcd_an_ph3"), 267 CLK_MSR_ID(22, "eth_phy_ref"), 268 CLK_MSR_ID(23, "mpll_50m"), 269 CLK_MSR_ID(24, "eth_125m"), 270 CLK_MSR_ID(25, "eth_rmii"), 271 CLK_MSR_ID(26, "sc_int"), 272 CLK_MSR_ID(27, "in_mac"), 273 CLK_MSR_ID(28, "sar_adc"), 274 CLK_MSR_ID(29, "pcie_inp"), 275 CLK_MSR_ID(30, "pcie_inn"), 276 CLK_MSR_ID(31, "mpll_test_out"), 277 CLK_MSR_ID(32, "vdec"), 278 CLK_MSR_ID(33, "sys_cpu_ring_osc_1"), 279 CLK_MSR_ID(34, "eth_mpll_50m"), 280 CLK_MSR_ID(35, "mali"), 281 CLK_MSR_ID(36, "hdmi_tx_pixel"), 282 CLK_MSR_ID(37, "cdac"), 283 CLK_MSR_ID(38, "vdin_meas"), 284 CLK_MSR_ID(39, "bt656"), 285 CLK_MSR_ID(41, "eth_rx_or_rmii"), 286 CLK_MSR_ID(42, "mp0_out"), 287 CLK_MSR_ID(43, "fclk_div5"), 288 CLK_MSR_ID(44, "pwm_b"), 289 CLK_MSR_ID(45, "pwm_a"), 290 CLK_MSR_ID(46, "vpu"), 291 CLK_MSR_ID(47, "ddr_dpll_pt"), 292 CLK_MSR_ID(48, "mp1_out"), 293 CLK_MSR_ID(49, "mp2_out"), 294 CLK_MSR_ID(50, "mp3_out"), 295 CLK_MSR_ID(51, "sd_emmc_c"), 296 CLK_MSR_ID(52, "sd_emmc_b"), 297 CLK_MSR_ID(53, "sd_emmc_a"), 298 CLK_MSR_ID(54, "vpu_clkc"), 299 CLK_MSR_ID(55, "vid_pll_div_out"), 300 CLK_MSR_ID(56, "wave420l_a"), 301 CLK_MSR_ID(57, "wave420l_c"), 302 CLK_MSR_ID(58, "wave420l_b"), 303 CLK_MSR_ID(59, "hcodec"), 304 CLK_MSR_ID(61, "gpio_msr"), 305 CLK_MSR_ID(62, "hevcb"), 306 CLK_MSR_ID(63, "dsi_meas"), 307 CLK_MSR_ID(64, "spicc_1"), 308 CLK_MSR_ID(65, "spicc_0"), 309 CLK_MSR_ID(66, "vid_lock"), 310 CLK_MSR_ID(67, "dsi_phy"), 311 CLK_MSR_ID(68, "hdcp22_esm"), 312 CLK_MSR_ID(69, "hdcp22_skp"), 313 CLK_MSR_ID(70, "pwm_f"), 314 CLK_MSR_ID(71, "pwm_e"), 315 CLK_MSR_ID(72, "pwm_d"), 316 CLK_MSR_ID(73, "pwm_c"), 317 CLK_MSR_ID(75, "hevcf"), 318 CLK_MSR_ID(77, "rng_ring_osc_0"), 319 CLK_MSR_ID(78, "rng_ring_osc_1"), 320 CLK_MSR_ID(79, "rng_ring_osc_2"), 321 CLK_MSR_ID(80, "rng_ring_osc_3"), 322 CLK_MSR_ID(81, "vapb"), 323 CLK_MSR_ID(82, "ge2d"), 324 CLK_MSR_ID(83, "co_rx"), 325 CLK_MSR_ID(84, "co_tx"), 326 CLK_MSR_ID(89, "hdmi_todig"), 327 CLK_MSR_ID(90, "hdmitx_sys"), 328 CLK_MSR_ID(91, "sys_cpub_div16"), 329 CLK_MSR_ID(92, "sys_pll_cpub_div16"), 330 CLK_MSR_ID(94, "eth_phy_rx"), 331 CLK_MSR_ID(95, "eth_phy_pll"), 332 CLK_MSR_ID(96, "vpu_b"), 333 CLK_MSR_ID(97, "cpu_b_tmp"), 334 CLK_MSR_ID(98, "ts"), 335 CLK_MSR_ID(99, "ring_osc_out_ee_3"), 336 CLK_MSR_ID(100, "ring_osc_out_ee_4"), 337 CLK_MSR_ID(101, "ring_osc_out_ee_5"), 338 CLK_MSR_ID(102, "ring_osc_out_ee_6"), 339 CLK_MSR_ID(103, "ring_osc_out_ee_7"), 340 CLK_MSR_ID(104, "ring_osc_out_ee_8"), 341 CLK_MSR_ID(105, "ring_osc_out_ee_9"), 342 CLK_MSR_ID(106, "ephy_test"), 343 CLK_MSR_ID(107, "au_dac_g128x"), 344 CLK_MSR_ID(108, "audio_locker_out"), 345 CLK_MSR_ID(109, "audio_locker_in"), 346 CLK_MSR_ID(110, "audio_tdmout_c_sclk"), 347 CLK_MSR_ID(111, "audio_tdmout_b_sclk"), 348 CLK_MSR_ID(112, "audio_tdmout_a_sclk"), 349 CLK_MSR_ID(113, "audio_tdmin_lb_sclk"), 350 CLK_MSR_ID(114, "audio_tdmin_c_sclk"), 351 CLK_MSR_ID(115, "audio_tdmin_b_sclk"), 352 CLK_MSR_ID(116, "audio_tdmin_a_sclk"), 353 CLK_MSR_ID(117, "audio_resample"), 354 CLK_MSR_ID(118, "audio_pdm_sys"), 355 CLK_MSR_ID(119, "audio_spdifout_b"), 356 CLK_MSR_ID(120, "audio_spdifout"), 357 CLK_MSR_ID(121, "audio_spdifin"), 358 CLK_MSR_ID(122, "audio_pdm_dclk"), 359 }; 360 361 static struct meson_msr_id clk_msr_sm1[CLK_MSR_MAX] = { 362 CLK_MSR_ID(0, "ring_osc_out_ee_0"), 363 CLK_MSR_ID(1, "ring_osc_out_ee_1"), 364 CLK_MSR_ID(2, "ring_osc_out_ee_2"), 365 CLK_MSR_ID(3, "ring_osc_out_ee_3"), 366 CLK_MSR_ID(4, "gp0_pll"), 367 CLK_MSR_ID(5, "gp1_pll"), 368 CLK_MSR_ID(6, "enci"), 369 CLK_MSR_ID(7, "clk81"), 370 CLK_MSR_ID(8, "encp"), 371 CLK_MSR_ID(9, "encl"), 372 CLK_MSR_ID(10, "vdac"), 373 CLK_MSR_ID(11, "eth_tx"), 374 CLK_MSR_ID(12, "hifi_pll"), 375 CLK_MSR_ID(13, "mod_tcon"), 376 CLK_MSR_ID(14, "fec_0"), 377 CLK_MSR_ID(15, "fec_1"), 378 CLK_MSR_ID(16, "fec_2"), 379 CLK_MSR_ID(17, "sys_pll_div16"), 380 CLK_MSR_ID(18, "sys_cpu_div16"), 381 CLK_MSR_ID(19, "lcd_an_ph2"), 382 CLK_MSR_ID(20, "rtc_osc_out"), 383 CLK_MSR_ID(21, "lcd_an_ph3"), 384 CLK_MSR_ID(22, "eth_phy_ref"), 385 CLK_MSR_ID(23, "mpll_50m"), 386 CLK_MSR_ID(24, "eth_125m"), 387 CLK_MSR_ID(25, "eth_rmii"), 388 CLK_MSR_ID(26, "sc_int"), 389 CLK_MSR_ID(27, "in_mac"), 390 CLK_MSR_ID(28, "sar_adc"), 391 CLK_MSR_ID(29, "pcie_inp"), 392 CLK_MSR_ID(30, "pcie_inn"), 393 CLK_MSR_ID(31, "mpll_test_out"), 394 CLK_MSR_ID(32, "vdec"), 395 CLK_MSR_ID(34, "eth_mpll_50m"), 396 CLK_MSR_ID(35, "mali"), 397 CLK_MSR_ID(36, "hdmi_tx_pixel"), 398 CLK_MSR_ID(37, "cdac"), 399 CLK_MSR_ID(38, "vdin_meas"), 400 CLK_MSR_ID(39, "bt656"), 401 CLK_MSR_ID(40, "arm_ring_osc_out_4"), 402 CLK_MSR_ID(41, "eth_rx_or_rmii"), 403 CLK_MSR_ID(42, "mp0_out"), 404 CLK_MSR_ID(43, "fclk_div5"), 405 CLK_MSR_ID(44, "pwm_b"), 406 CLK_MSR_ID(45, "pwm_a"), 407 CLK_MSR_ID(46, "vpu"), 408 CLK_MSR_ID(47, "ddr_dpll_pt"), 409 CLK_MSR_ID(48, "mp1_out"), 410 CLK_MSR_ID(49, "mp2_out"), 411 CLK_MSR_ID(50, "mp3_out"), 412 CLK_MSR_ID(51, "sd_emmc_c"), 413 CLK_MSR_ID(52, "sd_emmc_b"), 414 CLK_MSR_ID(53, "sd_emmc_a"), 415 CLK_MSR_ID(54, "vpu_clkc"), 416 CLK_MSR_ID(55, "vid_pll_div_out"), 417 CLK_MSR_ID(56, "wave420l_a"), 418 CLK_MSR_ID(57, "wave420l_c"), 419 CLK_MSR_ID(58, "wave420l_b"), 420 CLK_MSR_ID(59, "hcodec"), 421 CLK_MSR_ID(60, "arm_ring_osc_out_5"), 422 CLK_MSR_ID(61, "gpio_msr"), 423 CLK_MSR_ID(62, "hevcb"), 424 CLK_MSR_ID(63, "dsi_meas"), 425 CLK_MSR_ID(64, "spicc_1"), 426 CLK_MSR_ID(65, "spicc_0"), 427 CLK_MSR_ID(66, "vid_lock"), 428 CLK_MSR_ID(67, "dsi_phy"), 429 CLK_MSR_ID(68, "hdcp22_esm"), 430 CLK_MSR_ID(69, "hdcp22_skp"), 431 CLK_MSR_ID(70, "pwm_f"), 432 CLK_MSR_ID(71, "pwm_e"), 433 CLK_MSR_ID(72, "pwm_d"), 434 CLK_MSR_ID(73, "pwm_c"), 435 CLK_MSR_ID(74, "arm_ring_osc_out_6"), 436 CLK_MSR_ID(75, "hevcf"), 437 CLK_MSR_ID(76, "arm_ring_osc_out_7"), 438 CLK_MSR_ID(77, "rng_ring_osc_0"), 439 CLK_MSR_ID(78, "rng_ring_osc_1"), 440 CLK_MSR_ID(79, "rng_ring_osc_2"), 441 CLK_MSR_ID(80, "rng_ring_osc_3"), 442 CLK_MSR_ID(81, "vapb"), 443 CLK_MSR_ID(82, "ge2d"), 444 CLK_MSR_ID(83, "co_rx"), 445 CLK_MSR_ID(84, "co_tx"), 446 CLK_MSR_ID(85, "arm_ring_osc_out_8"), 447 CLK_MSR_ID(86, "arm_ring_osc_out_9"), 448 CLK_MSR_ID(87, "mipi_dsi_phy"), 449 CLK_MSR_ID(88, "cis2_adapt"), 450 CLK_MSR_ID(89, "hdmi_todig"), 451 CLK_MSR_ID(90, "hdmitx_sys"), 452 CLK_MSR_ID(91, "nna_core"), 453 CLK_MSR_ID(92, "nna_axi"), 454 CLK_MSR_ID(93, "vad"), 455 CLK_MSR_ID(94, "eth_phy_rx"), 456 CLK_MSR_ID(95, "eth_phy_pll"), 457 CLK_MSR_ID(96, "vpu_b"), 458 CLK_MSR_ID(97, "cpu_b_tmp"), 459 CLK_MSR_ID(98, "ts"), 460 CLK_MSR_ID(99, "arm_ring_osc_out_10"), 461 CLK_MSR_ID(100, "arm_ring_osc_out_11"), 462 CLK_MSR_ID(101, "arm_ring_osc_out_12"), 463 CLK_MSR_ID(102, "arm_ring_osc_out_13"), 464 CLK_MSR_ID(103, "arm_ring_osc_out_14"), 465 CLK_MSR_ID(104, "arm_ring_osc_out_15"), 466 CLK_MSR_ID(105, "arm_ring_osc_out_16"), 467 CLK_MSR_ID(106, "ephy_test"), 468 CLK_MSR_ID(107, "au_dac_g128x"), 469 CLK_MSR_ID(108, "audio_locker_out"), 470 CLK_MSR_ID(109, "audio_locker_in"), 471 CLK_MSR_ID(110, "audio_tdmout_c_sclk"), 472 CLK_MSR_ID(111, "audio_tdmout_b_sclk"), 473 CLK_MSR_ID(112, "audio_tdmout_a_sclk"), 474 CLK_MSR_ID(113, "audio_tdmin_lb_sclk"), 475 CLK_MSR_ID(114, "audio_tdmin_c_sclk"), 476 CLK_MSR_ID(115, "audio_tdmin_b_sclk"), 477 CLK_MSR_ID(116, "audio_tdmin_a_sclk"), 478 CLK_MSR_ID(117, "audio_resample"), 479 CLK_MSR_ID(118, "audio_pdm_sys"), 480 CLK_MSR_ID(119, "audio_spdifout_b"), 481 CLK_MSR_ID(120, "audio_spdifout"), 482 CLK_MSR_ID(121, "audio_spdifin"), 483 CLK_MSR_ID(122, "audio_pdm_dclk"), 484 CLK_MSR_ID(123, "audio_resampled"), 485 CLK_MSR_ID(124, "earcrx_pll"), 486 CLK_MSR_ID(125, "earcrx_pll_test"), 487 CLK_MSR_ID(126, "csi_phy0"), 488 CLK_MSR_ID(127, "csi2_data"), 489 }; 490 491 static int meson_measure_id(struct meson_msr_id *clk_msr_id, 492 unsigned int duration) 493 { 494 struct meson_msr *priv = clk_msr_id->priv; 495 unsigned int val; 496 int ret; 497 498 ret = mutex_lock_interruptible(&measure_lock); 499 if (ret) 500 return ret; 501 502 regmap_write(priv->regmap, MSR_CLK_REG0, 0); 503 504 /* Set measurement duration */ 505 regmap_update_bits(priv->regmap, MSR_CLK_REG0, MSR_DURATION, 506 FIELD_PREP(MSR_DURATION, duration - 1)); 507 508 /* Set ID */ 509 regmap_update_bits(priv->regmap, MSR_CLK_REG0, MSR_CLK_SRC, 510 FIELD_PREP(MSR_CLK_SRC, clk_msr_id->id)); 511 512 /* Enable & Start */ 513 regmap_update_bits(priv->regmap, MSR_CLK_REG0, 514 MSR_RUN | MSR_ENABLE, 515 MSR_RUN | MSR_ENABLE); 516 517 ret = regmap_read_poll_timeout(priv->regmap, MSR_CLK_REG0, 518 val, !(val & MSR_BUSY), 10, 10000); 519 if (ret) { 520 mutex_unlock(&measure_lock); 521 return ret; 522 } 523 524 /* Disable */ 525 regmap_update_bits(priv->regmap, MSR_CLK_REG0, MSR_ENABLE, 0); 526 527 /* Get the value in multiple of gate time counts */ 528 regmap_read(priv->regmap, MSR_CLK_REG2, &val); 529 530 mutex_unlock(&measure_lock); 531 532 if (val >= MSR_VAL_MASK) 533 return -EINVAL; 534 535 return DIV_ROUND_CLOSEST_ULL((val & MSR_VAL_MASK) * 1000000ULL, 536 duration); 537 } 538 539 static int meson_measure_best_id(struct meson_msr_id *clk_msr_id, 540 unsigned int *precision) 541 { 542 unsigned int duration = DIV_MAX; 543 int ret; 544 545 /* Start from max duration and down to min duration */ 546 do { 547 ret = meson_measure_id(clk_msr_id, duration); 548 if (ret >= 0) 549 *precision = (2 * 1000000) / duration; 550 else 551 duration -= DIV_STEP; 552 } while (duration >= DIV_MIN && ret == -EINVAL); 553 554 return ret; 555 } 556 557 static int clk_msr_show(struct seq_file *s, void *data) 558 { 559 struct meson_msr_id *clk_msr_id = s->private; 560 unsigned int precision = 0; 561 int val; 562 563 val = meson_measure_best_id(clk_msr_id, &precision); 564 if (val < 0) 565 return val; 566 567 seq_printf(s, "%d\t+/-%dHz\n", val, precision); 568 569 return 0; 570 } 571 DEFINE_SHOW_ATTRIBUTE(clk_msr); 572 573 static int clk_msr_summary_show(struct seq_file *s, void *data) 574 { 575 struct meson_msr_id *msr_table = s->private; 576 unsigned int precision = 0; 577 int val, i; 578 579 seq_puts(s, " clock rate precision\n"); 580 seq_puts(s, "---------------------------------------------\n"); 581 582 for (i = 0 ; i < CLK_MSR_MAX ; ++i) { 583 if (!msr_table[i].name) 584 continue; 585 586 val = meson_measure_best_id(&msr_table[i], &precision); 587 if (val < 0) 588 return val; 589 590 seq_printf(s, " %-20s %10d +/-%dHz\n", 591 msr_table[i].name, val, precision); 592 } 593 594 return 0; 595 } 596 DEFINE_SHOW_ATTRIBUTE(clk_msr_summary); 597 598 static const struct regmap_config meson_clk_msr_regmap_config = { 599 .reg_bits = 32, 600 .val_bits = 32, 601 .reg_stride = 4, 602 .max_register = MSR_CLK_REG2, 603 }; 604 605 static int meson_msr_probe(struct platform_device *pdev) 606 { 607 const struct meson_msr_id *match_data; 608 struct meson_msr *priv; 609 struct resource *res; 610 struct dentry *root, *clks; 611 void __iomem *base; 612 int i; 613 614 priv = devm_kzalloc(&pdev->dev, sizeof(struct meson_msr), 615 GFP_KERNEL); 616 if (!priv) 617 return -ENOMEM; 618 619 match_data = device_get_match_data(&pdev->dev); 620 if (!match_data) { 621 dev_err(&pdev->dev, "failed to get match data\n"); 622 return -ENODEV; 623 } 624 625 memcpy(priv->msr_table, match_data, sizeof(priv->msr_table)); 626 627 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 628 base = devm_ioremap_resource(&pdev->dev, res); 629 if (IS_ERR(base)) { 630 dev_err(&pdev->dev, "io resource mapping failed\n"); 631 return PTR_ERR(base); 632 } 633 634 priv->regmap = devm_regmap_init_mmio(&pdev->dev, base, 635 &meson_clk_msr_regmap_config); 636 if (IS_ERR(priv->regmap)) 637 return PTR_ERR(priv->regmap); 638 639 root = debugfs_create_dir("meson-clk-msr", NULL); 640 clks = debugfs_create_dir("clks", root); 641 642 debugfs_create_file("measure_summary", 0444, root, 643 priv->msr_table, &clk_msr_summary_fops); 644 645 for (i = 0 ; i < CLK_MSR_MAX ; ++i) { 646 if (!priv->msr_table[i].name) 647 continue; 648 649 priv->msr_table[i].priv = priv; 650 651 debugfs_create_file(priv->msr_table[i].name, 0444, clks, 652 &priv->msr_table[i], &clk_msr_fops); 653 } 654 655 return 0; 656 } 657 658 static const struct of_device_id meson_msr_match_table[] = { 659 { 660 .compatible = "amlogic,meson-gx-clk-measure", 661 .data = (void *)clk_msr_gx, 662 }, 663 { 664 .compatible = "amlogic,meson8-clk-measure", 665 .data = (void *)clk_msr_m8, 666 }, 667 { 668 .compatible = "amlogic,meson8b-clk-measure", 669 .data = (void *)clk_msr_m8, 670 }, 671 { 672 .compatible = "amlogic,meson-axg-clk-measure", 673 .data = (void *)clk_msr_axg, 674 }, 675 { 676 .compatible = "amlogic,meson-g12a-clk-measure", 677 .data = (void *)clk_msr_g12a, 678 }, 679 { 680 .compatible = "amlogic,meson-sm1-clk-measure", 681 .data = (void *)clk_msr_sm1, 682 }, 683 { /* sentinel */ } 684 }; 685 MODULE_DEVICE_TABLE(of, meson_msr_match_table); 686 687 static struct platform_driver meson_msr_driver = { 688 .probe = meson_msr_probe, 689 .driver = { 690 .name = "meson_msr", 691 .of_match_table = meson_msr_match_table, 692 }, 693 }; 694 module_platform_driver(meson_msr_driver); 695 MODULE_LICENSE("GPL v2"); 696