[PATCH 3/4] drm/amdgpu: add get_gpu_clock_counter to smuio v14_0_3

[Alex Deucher <alexander.deucher@amd.com>]

From: Alex Sierra <alex.sierra@amd.com>

Function get_gpu_clock_counter missing for smuio v14_0_3

Signed-off-by: Alex Sierra <alex.sierra@amd.com>
Reviewed-by: Mukul Joshi <mukul.joshi@amd.com>
Signed-off-by: Alex Deucher <alexander.deucher@amd.com>
---
 drivers/gpu/drm/amd/amdgpu/smuio_v14_0_3.c | 20 ++++++++++++++++++++
 1 file changed, 20 insertions(+)

diff --git a/drivers/gpu/drm/amd/amdgpu/smuio_v14_0_3.c b/drivers/gpu/drm/amd/amdgpu/smuio_v14_0_3.c
index 804b7458b0661..f48ef572d9b41 100644
--- a/drivers/gpu/drm/amd/amdgpu/smuio_v14_0_3.c
+++ b/drivers/gpu/drm/amd/amdgpu/smuio_v14_0_3.c
@@ -44,6 +44,25 @@ static void smuio_v14_0_3_update_rom_clock_gating(struct amdgpu_device *adev, bo
 	return;
 }
 
+static u64 smuio_v14_0_3_get_gpu_clock_counter(struct amdgpu_device *adev)
+{
+	u64 clock;
+	u64 clock_counter_lo, clock_counter_hi_pre, clock_counter_hi_after;
+
+	preempt_disable();
+	clock_counter_hi_pre = (u64)RREG32_SOC15(SMUIO, 0, regGOLDEN_TSC_COUNT_UPPER);
+	clock_counter_lo = (u64)RREG32_SOC15(SMUIO, 0, regGOLDEN_TSC_COUNT_LOWER);
+	/* the clock counter may be udpated during polling the counters */
+	clock_counter_hi_after = (u64)RREG32_SOC15(SMUIO, 0, regGOLDEN_TSC_COUNT_UPPER);
+	if (clock_counter_hi_pre != clock_counter_hi_after)
+		clock_counter_lo = (u64)RREG32_SOC15(SMUIO, 0, regGOLDEN_TSC_COUNT_LOWER);
+	preempt_enable();
+
+	clock = clock_counter_lo | (clock_counter_hi_after << 32ULL);
+
+	return clock;
+}
+
 static void smuio_v14_0_3_get_clock_gating_state(struct amdgpu_device *adev, u64 *flags)
 {
 	u32 data;
@@ -184,6 +203,7 @@ static bool smuio_v14_0_3_is_custom_hbm_supported(struct amdgpu_device *adev)
 const struct amdgpu_smuio_funcs smuio_v14_0_3_funcs = {
 	.get_rom_index_offset = smuio_v14_0_3_get_rom_index_offset,
 	.get_rom_data_offset = smuio_v14_0_3_get_rom_data_offset,
+	.get_gpu_clock_counter = smuio_v14_0_3_get_gpu_clock_counter,
 	.get_die_id = smuio_v14_0_3_get_die_id,
 	.get_socket_id = smuio_v14_0_3_get_socket_id,
 	.is_host_gpu_xgmi_supported = smuio_v14_0_3_is_host_gpu_xgmi_supported,
-- 
2.51.0