// SPDX-License-Identifier: BSD-3-Clause
/* Copyright (c) 2022, Linaro Limited */
#include <sys/mman.h>
#include <err.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include "debugcc.h"

static struct gcc_mux gcc = {
	.mux = {
		.phys =	0x100000,
		.size = 0x1f0000,

		.measure = measure_gcc,

		.enable_reg = 0x62004,
		.enable_mask = BIT(0),

		.mux_reg = 0x62008,
		.mux_mask = 0x3ff,

		.div_reg = 0x62000,
		.div_mask = 0xf,
		.div_val = 4,
	},

	.xo_div4_reg = 0x43008,
	.debug_ctl_reg = 0x62024,
	.debug_status_reg = 0x62028,
};

static struct debug_mux gpu_cc = {
	.phys = 0x5090000,
	.size = 0x9000,
	.block_name = "gpu",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0x144,

	.enable_reg = 0x1100,
	.enable_mask = BIT(0),

	.mux_reg = 0x1568,
	.mux_mask = 0xff,

	.div_reg = 0x10fc,
	.div_mask = 0x3,
	.div_val = 2,
};

static struct debug_mux mc_cc = {
	.phys = 0x90b0000,
	.size = 0x1000,
	.block_name = "mc",

	.measure = measure_mccc,
};

static struct debug_mux npu_cc = {
	.phys = 0x9980000,
	.size = 0x10000,
	.block_name = "npu",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0x16f,

	.enable_reg = 0x3008,
	.enable_mask = BIT(0),

	.mux_reg = 0x3000,
	.mux_mask = 0xff,

	.div_reg = 0x3004,
	.div_mask = 0x3,
	.div_val = 2,
};

static struct debug_mux video_cc = {
	.phys = 0xab00000,
	.size = 0x10000,
	.block_name = "video",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0x48,

	.enable_reg = 0x940,
	.enable_mask = BIT(0),

	.mux_reg = 0xacc,
	.mux_mask = 0x3f,

	.div_reg = 0x938,
	.div_mask = 0x7,
	.div_val = 5,
};

static struct debug_mux cam_cc = {
	.phys = 0xad00000,
	.size = 0x10000,
	.block_name = "cam",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0x46,

	.enable_reg = 0xc008,
	.enable_mask = BIT(0),

	.mux_reg = 0xd000,
	.mux_mask = 0xff,
	.div_val = 2,

	.div_reg = 0xc004,
	.div_mask = 0x3,
};

static struct debug_mux disp_cc = {
	.phys = 0xaf00000,
	.size = 0x10000,
	.block_name = "disp",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0x47,

	.enable_reg = 0x500c,
	.enable_mask = BIT(0),

	.mux_reg = 0x7000,
	.mux_mask = 0xff,

	.div_reg = 0x5008,
	.div_mask = 0x3,
	.div_val = 4,
};

static struct debug_mux cpu_cc = {
	.phys = 0x182a0000,
	.size = 4096,
	.block_name = "cpu",

	.measure = measure_leaf,
	.parent = &gcc.mux,
	.parent_mux_val = 0xd6,

	.enable_reg = 0x18,
	.enable_mask = BIT(0),

	.mux_reg = 0x18,
	.mux_mask = 0x7f << 4,
	.mux_shift = 4,

	.div_reg = 0x18,
	.div_mask = 0xf << 11,
	.div_shift = 11,
	.div_val = 1,
};

static struct measure_clk sc7180_clocks[] = {
	/* CPU_CC */
	{ "l3_clk", &cpu_cc, 0x46, 16 },
	{ "pwrcl_clk", &cpu_cc, 0x44, 16 },
	{ "perfcl_clk", &cpu_cc, 0x45, 16 },

	/* DISP_CC */
	{ "disp_cc_mdss_ahb_clk", &disp_cc, 0x14 },
	{ "disp_cc_mdss_byte0_clk", &disp_cc, 0xc },
	{ "disp_cc_mdss_byte0_intf_clk", &disp_cc, 0xd },
	{ "disp_cc_mdss_dp_aux_clk", &disp_cc, 0x13 },
	{ "disp_cc_mdss_dp_crypto_clk", &disp_cc, 0x11 },
	{ "disp_cc_mdss_dp_link_clk", &disp_cc, 0xf },
	{ "disp_cc_mdss_dp_link_intf_clk", &disp_cc, 0x10 },
	{ "disp_cc_mdss_dp_pixel_clk", &disp_cc, 0x12 },
	{ "disp_cc_mdss_esc0_clk", &disp_cc, 0xe },
	{ "disp_cc_mdss_mdp_clk", &disp_cc, 0x8 },
	{ "disp_cc_mdss_mdp_lut_clk", &disp_cc, 0xa },
	{ "disp_cc_mdss_non_gdsc_ahb_clk", &disp_cc, 0x15 },
	{ "disp_cc_mdss_pclk0_clk", &disp_cc, 0x7 },
	{ "disp_cc_mdss_rot_clk", &disp_cc, 0x9 },
	{ "disp_cc_mdss_rscc_ahb_clk", &disp_cc, 0x17 },
	{ "disp_cc_mdss_rscc_vsync_clk", &disp_cc, 0x16 },
	{ "disp_cc_mdss_vsync_clk", &disp_cc, 0xb },
	{ "disp_cc_sleep_clk", &disp_cc, 0x1e },
	{ "disp_cc_xo_clk", &disp_cc, 0x1d },

	/* GCC */
	{ "gcc_aggre_ufs_phy_axi_clk", &gcc.mux, 0x11d },
	{ "gcc_aggre_usb3_prim_axi_clk", &gcc.mux, 0x11b },
	{ "gcc_boot_rom_ahb_clk", &gcc.mux, 0x94 },
	{ "gcc_camera_ahb_clk", &gcc.mux, 0x3a },
	{ "gcc_camera_hf_axi_clk", &gcc.mux, 0x40 },
	{ "gcc_camera_throttle_hf_axi_clk", &gcc.mux, 0x1aa },
	{ "gcc_camera_xo_clk", &gcc.mux, 0x43 },
	{ "gcc_ce1_ahb_clk", &gcc.mux, 0xa9 },
	{ "gcc_ce1_axi_clk", &gcc.mux, 0xa8 },
	{ "gcc_ce1_clk", &gcc.mux, 0xa7 },
	{ "gcc_cfg_noc_usb3_prim_axi_clk", &gcc.mux, 0x1d },
	{ "gcc_cpuss_ahb_clk", &gcc.mux, 0xce },
	{ "gcc_cpuss_gnoc_clk", &gcc.mux, 0xcf },
	{ "gcc_cpuss_rbcpr_clk", &gcc.mux, 0xd0 },
	{ "gcc_ddrss_gpu_axi_clk", &gcc.mux, 0xbb },
	{ "gcc_disp_ahb_clk", &gcc.mux, 0x3b },
	{ "gcc_disp_gpll0_clk_src", &gcc.mux, 0x4c },
	{ "gcc_disp_gpll0_div_clk_src", &gcc.mux, 0x4d },
	{ "gcc_disp_hf_axi_clk", &gcc.mux, 0x41 },
	{ "gcc_disp_throttle_hf_axi_clk", &gcc.mux, 0x1ab },
	{ "gcc_disp_xo_clk", &gcc.mux, 0x44 },
	{ "gcc_gp1_clk", &gcc.mux, 0xde },
	{ "gcc_gp2_clk", &gcc.mux, 0xdf },
	{ "gcc_gp3_clk", &gcc.mux, 0xe0 },
	{ "gcc_gpu_cfg_ahb_clk", &gcc.mux, 0x142 },
	{ "gcc_gpu_gpll0_clk_src", &gcc.mux, 0x148 },
	{ "gcc_gpu_gpll0_div_clk_src", &gcc.mux, 0x149 },
	{ "gcc_gpu_memnoc_gfx_clk", &gcc.mux, 0x145 },
	{ "gcc_gpu_snoc_dvm_gfx_clk", &gcc.mux, 0x147 },
	{ "gcc_npu_axi_clk", &gcc.mux, 0x16a },
	{ "gcc_npu_bwmon_axi_clk", &gcc.mux, 0x182 },
	{ "gcc_npu_bwmon_dma_cfg_ahb_clk", &gcc.mux, 0x7e },
	{ "gcc_npu_bwmon_dsp_cfg_ahb_clk", &gcc.mux, 0x7f },
	{ "gcc_npu_cfg_ahb_clk", &gcc.mux, 0x169 },
	{ "gcc_npu_dma_clk", &gcc.mux, 0x185 },
	{ "gcc_npu_gpll0_clk_src", &gcc.mux, 0x16d },
	{ "gcc_npu_gpll0_div_clk_src", &gcc.mux, 0x16e },
	{ "gcc_pdm2_clk", &gcc.mux, 0x8e },
	{ "gcc_pdm_ahb_clk", &gcc.mux, 0x8c },
	{ "gcc_pdm_xo4_clk", &gcc.mux, 0x8d },
	{ "gcc_prng_ahb_clk", &gcc.mux, 0x8f },
	{ "gcc_qspi_cnoc_periph_ahb_clk", &gcc.mux, 0x1b0 },
	{ "gcc_qspi_core_clk", &gcc.mux, 0x1b1 },
	{ "gcc_qupv3_wrap0_core_2x_clk", &gcc.mux, 0x77 },
	{ "gcc_qupv3_wrap0_core_clk", &gcc.mux, 0x76 },
	{ "gcc_qupv3_wrap0_s0_clk", &gcc.mux, 0x78 },
	{ "gcc_qupv3_wrap0_s1_clk", &gcc.mux, 0x79 },
	{ "gcc_qupv3_wrap0_s2_clk", &gcc.mux, 0x7a },
	{ "gcc_qupv3_wrap0_s3_clk", &gcc.mux, 0x7b },
	{ "gcc_qupv3_wrap0_s4_clk", &gcc.mux, 0x7c },
	{ "gcc_qupv3_wrap0_s5_clk", &gcc.mux, 0x7d },
	{ "gcc_qupv3_wrap1_core_2x_clk", &gcc.mux, 0x80 },
	{ "gcc_qupv3_wrap1_core_clk", &gcc.mux, 0x81 },
	{ "gcc_qupv3_wrap1_s0_clk", &gcc.mux, 0x84 },
	{ "gcc_qupv3_wrap1_s1_clk", &gcc.mux, 0x85 },
	{ "gcc_qupv3_wrap1_s2_clk", &gcc.mux, 0x86 },
	{ "gcc_qupv3_wrap1_s3_clk", &gcc.mux, 0x87 },
	{ "gcc_qupv3_wrap1_s4_clk", &gcc.mux, 0x88 },
	{ "gcc_qupv3_wrap1_s5_clk", &gcc.mux, 0x89 },
	{ "gcc_qupv3_wrap_0_m_ahb_clk", &gcc.mux, 0x74 },
	{ "gcc_qupv3_wrap_0_s_ahb_clk", &gcc.mux, 0x75 },
	{ "gcc_qupv3_wrap_1_m_ahb_clk", &gcc.mux, 0x82 },
	{ "gcc_qupv3_wrap_1_s_ahb_clk", &gcc.mux, 0x83 },
	{ "gcc_sdcc1_ahb_clk", &gcc.mux, 0x15c },
	{ "gcc_sdcc1_apps_clk", &gcc.mux, 0x15b },
	{ "gcc_sdcc1_ice_core_clk", &gcc.mux, 0x15d },
	{ "gcc_sdcc2_ahb_clk", &gcc.mux, 0x71 },
	{ "gcc_sdcc2_apps_clk", &gcc.mux, 0x70 },
	{ "gcc_sys_noc_cpuss_ahb_clk", &gcc.mux, 0xc },
	{ "gcc_ufs_phy_ahb_clk", &gcc.mux, 0xfc },
	{ "gcc_ufs_phy_axi_clk", &gcc.mux, 0xfb },
	{ "gcc_ufs_phy_ice_core_clk", &gcc.mux, 0x102 },
	{ "gcc_ufs_phy_phy_aux_clk", &gcc.mux, 0x103 },
	{ "gcc_ufs_phy_rx_symbol_0_clk", &gcc.mux, 0xfe },
	{ "gcc_ufs_phy_tx_symbol_0_clk", &gcc.mux, 0xfd },
	{ "gcc_ufs_phy_unipro_core_clk", &gcc.mux, 0x101 },
	{ "gcc_usb30_prim_master_clk", &gcc.mux, 0x5f },
	{ "gcc_usb30_prim_mock_utmi_clk", &gcc.mux, 0x61 },
	{ "gcc_usb30_prim_sleep_clk", &gcc.mux, 0x60 },
	{ "gcc_usb3_prim_phy_aux_clk", &gcc.mux, 0x62 },
	{ "gcc_usb3_prim_phy_com_aux_clk", &gcc.mux, 0x63 },
	{ "gcc_usb3_prim_phy_pipe_clk", &gcc.mux, 0x64 },
	{ "gcc_usb_phy_cfg_ahb2phy_clk", &gcc.mux, 0x6f },
	{ "gcc_video_ahb_clk", &gcc.mux, 0x39 },
	{ "gcc_video_axi_clk", &gcc.mux, 0x3f },
	{ "gcc_video_gpll0_div_clk_src", &gcc.mux, 0x18a },
	{ "gcc_video_throttle_axi_clk", &gcc.mux, 0x1a9 },
	{ "gcc_video_xo_clk", &gcc.mux, 0x42 },

	/* GPU_CC */
	{ "gpu_cc_acd_ahb_clk", &gpu_cc, 0x24 },
	{ "gpu_cc_acd_cxo_clk", &gpu_cc, 0x1f },
	{ "gpu_cc_ahb_clk", &gpu_cc, 0x11 },
	{ "gpu_cc_crc_ahb_clk", &gpu_cc, 0x12 },
	{ "gpu_cc_cx_apb_clk", &gpu_cc, 0x15 },
	{ "gpu_cc_cx_gfx3d_clk", &gpu_cc, 0x1a },
	{ "gpu_cc_cx_gfx3d_slv_clk", &gpu_cc, 0x1b },
	{ "gpu_cc_cx_gmu_clk", &gpu_cc, 0x19 },
	{ "gpu_cc_cx_qdss_at_clk", &gpu_cc, 0x13 },
	{ "gpu_cc_cx_qdss_trig_clk", &gpu_cc, 0x18 },
	{ "gpu_cc_cx_qdss_tsctr_clk", &gpu_cc, 0x14 },
	{ "gpu_cc_cx_snoc_dvm_clk", &gpu_cc, 0x16 },
	{ "gpu_cc_cxo_aon_clk", &gpu_cc, 0xb },
	{ "gpu_cc_cxo_clk", &gpu_cc, 0xa },
	{ "gpu_cc_gx_cxo_clk", &gpu_cc, 0xf },
	{ "gpu_cc_gx_gfx3d_clk", &gpu_cc, 0xc },
	{ "gpu_cc_gx_gmu_clk", &gpu_cc, 0x10 },
	{ "gpu_cc_gx_qdss_tsctr_clk", &gpu_cc, 0xe },
	{ "gpu_cc_gx_vsense_clk", &gpu_cc, 0xd },
	{ "gpu_cc_rbcpr_ahb_clk", &gpu_cc, 0x1d },
	{ "gpu_cc_rbcpr_clk", &gpu_cc, 0x1c },
	{ "gpu_cc_sleep_clk", &gpu_cc, 0x17 },

	/* Bus clocks */
	{ "measure_only_mccc_clk", &mc_cc, 0x50 },
	{ "measure_only_cnoc_clk", &gcc.mux, 0x15 },
	{ "measure_only_ipa_2x_clk", &gcc.mux, 0x128 },
	{ "measure_only_snoc_clk", &gcc.mux, 0x7 },

	/* NPU_CC */
	{ "npu_cc_atb_clk", &npu_cc, 0x17 },
	{ "npu_cc_bto_core_clk", &npu_cc, 0x19 },
	{ "npu_cc_bwmon_clk", &npu_cc, 0x18 },
	{ "npu_cc_cal_hm0_cdc_clk", &npu_cc, 0xb },
	{ "npu_cc_cal_hm0_clk", &npu_cc, 0x2 },
	{ "npu_cc_cal_hm0_perf_cnt_clk", &npu_cc, 0xd },
	{ "npu_cc_core_clk", &npu_cc, 0x4 },
	{ "npu_cc_dsp_ahbm_clk", &npu_cc, 0x1c },
	{ "npu_cc_dsp_ahbs_clk", &npu_cc, 0x1b },
	{ "npu_cc_dsp_axi_clk", &npu_cc, 0x1e },
	{ "npu_cc_noc_ahb_clk", &npu_cc, 0x13 },
	{ "npu_cc_noc_axi_clk", &npu_cc, 0x12 },
	{ "npu_cc_noc_dma_clk", &npu_cc, 0x11 },
	{ "npu_cc_rsc_xo_clk", &npu_cc, 0x1a },
	{ "npu_cc_s2p_clk", &npu_cc, 0x16 },
	{ "npu_cc_xo_clk", &npu_cc, 0x1 },

	/* VIDEO_CC */
	{ "video_cc_apb_clk", &video_cc, 0xa },
	{ "video_cc_at_clk", &video_cc, 0xd },
	{ "video_cc_qdss_trig_clk", &video_cc, 0x9 },
	{ "video_cc_qdss_tsctr_div8_clk", &video_cc, 0xc },
	{ "video_cc_sleep_clk", &video_cc, 0x6 },
	{ "video_cc_vcodec0_axi_clk", &video_cc, 0x8 },
	{ "video_cc_vcodec0_core_clk", &video_cc, 0x3 },
	{ "video_cc_venus_ahb_clk", &video_cc, 0xb },
	{ "video_cc_venus_ctl_axi_clk", &video_cc, 0x7 },
	{ "video_cc_venus_ctl_core_clk", &video_cc, 0x1 },
	{ "video_cc_xo_clk", &video_cc, 0x5 },

	/* CAM_CC */
	{ "cam_cc_bps_ahb_clk", &cam_cc, 0xe },
	{ "cam_cc_bps_areg_clk", &cam_cc, 0xd },
	{ "cam_cc_bps_axi_clk", &cam_cc, 0xc },
	{ "cam_cc_bps_clk", &cam_cc, 0xb },
	{ "cam_cc_camnoc_atb_clk", &cam_cc, 0x34 },
	{ "cam_cc_camnoc_axi_clk", &cam_cc, 0x2d },
	{ "cam_cc_cci_0_clk", &cam_cc, 0x2a },
	{ "cam_cc_cci_1_clk", &cam_cc, 0x3b },
	{ "cam_cc_core_ahb_clk", &cam_cc, 0x3a },
	{ "cam_cc_cpas_ahb_clk", &cam_cc, 0x2c },
	{ "cam_cc_csi0phytimer_clk", &cam_cc, 0x5 },
	{ "cam_cc_csi1phytimer_clk", &cam_cc, 0x7 },
	{ "cam_cc_csi2phytimer_clk", &cam_cc, 0x9 },
	{ "cam_cc_csi3phytimer_clk", &cam_cc, 0x13 },
	{ "cam_cc_csiphy0_clk", &cam_cc, 0x6 },
	{ "cam_cc_csiphy1_clk", &cam_cc, 0x8 },
	{ "cam_cc_csiphy2_clk", &cam_cc, 0xa },
	{ "cam_cc_csiphy3_clk", &cam_cc, 0x14 },
	{ "cam_cc_icp_apb_clk", &cam_cc, 0x32 },
	{ "cam_cc_icp_atb_clk", &cam_cc, 0x2f },
	{ "cam_cc_icp_clk", &cam_cc, 0x26 },
	{ "cam_cc_icp_cti_clk", &cam_cc, 0x30 },
	{ "cam_cc_icp_ts_clk", &cam_cc, 0x31 },
	{ "cam_cc_ife_0_axi_clk", &cam_cc, 0x1b },
	{ "cam_cc_ife_0_clk", &cam_cc, 0x17 },
	{ "cam_cc_ife_0_cphy_rx_clk", &cam_cc, 0x1a },
	{ "cam_cc_ife_0_csid_clk", &cam_cc, 0x19 },
	{ "cam_cc_ife_0_dsp_clk", &cam_cc, 0x18 },
	{ "cam_cc_ife_1_axi_clk", &cam_cc, 0x21 },
	{ "cam_cc_ife_1_clk", &cam_cc, 0x1d },
	{ "cam_cc_ife_1_cphy_rx_clk", &cam_cc, 0x20 },
	{ "cam_cc_ife_1_csid_clk", &cam_cc, 0x1f },
	{ "cam_cc_ife_1_dsp_clk", &cam_cc, 0x1e },
	{ "cam_cc_ife_lite_clk", &cam_cc, 0x22 },
	{ "cam_cc_ife_lite_cphy_rx_clk", &cam_cc, 0x24 },
	{ "cam_cc_ife_lite_csid_clk", &cam_cc, 0x23 },
	{ "cam_cc_ipe_0_ahb_clk", &cam_cc, 0x12 },
	{ "cam_cc_ipe_0_areg_clk", &cam_cc, 0x11 },
	{ "cam_cc_ipe_0_axi_clk", &cam_cc, 0x10 },
	{ "cam_cc_ipe_0_clk", &cam_cc, 0xf },
	{ "cam_cc_jpeg_clk", &cam_cc, 0x25 },
	{ "cam_cc_lrme_clk", &cam_cc, 0x2b },
	{ "cam_cc_mclk0_clk", &cam_cc, 0x1 },
	{ "cam_cc_mclk1_clk", &cam_cc, 0x2 },
	{ "cam_cc_mclk2_clk", &cam_cc, 0x3 },
	{ "cam_cc_mclk3_clk", &cam_cc, 0x4 },
	{ "cam_cc_mclk4_clk", &cam_cc, 0x15 },
	{ "cam_cc_soc_ahb_clk", &cam_cc, 0x2e },
	{ "cam_cc_sys_tmr_clk", &cam_cc, 0x33 },

	{}
};

struct debugcc_platform sc7180_debugcc = {
	"sc7180",
	sc7180_clocks,
};