// SPDX-License-Identifier: MIT
/*
 * Copyright © 2022 Intel Corporation
 */

#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>

#include "i915/gem.h"
#include "igt.h"
#include "igt_sysfs.h"
/**
 * TEST: i915 pm freq mult
 * Description: Tests for sysfs controls (or multipliers) for IP blocks which
 *		run at frequencies different from the main GT frequency.
 * Category: Core
 * Mega feature: Power management
 * Sub-category: Power management tests
 * Functionality: freg multipliers
 * Test category: i915
 *
 * SUBTEST: media-freq
 * Description: Tests for media frequency factor sysfs
 */

IGT_TEST_DESCRIPTION(
	"Tests for sysfs controls (or multipliers) for IP blocks which run at "
	"frequencies different from the main GT frequency."
);

#define FREQ_SCALE_FACTOR	0.00390625f	/* 1.0f / 256 */

/*
 * Firmware interfaces are not completely synchronous, a delay is needed
 * before the requested freq is actually set.
 * Media ratio read back after set will mismatch if this value is too small
 */
#define wait_freq_set()	usleep(100000)

static int i915 = -1;
const intel_ctx_t *ctx;
uint64_t ahnd;

static void spin_all(void)
{
	igt_spin_t *spin = igt_spin_new(i915, .ahnd = ahnd, .ctx = ctx, .engine = ALL_ENGINES,
					.flags = IGT_SPIN_POLL_RUN);

	/* Wait till at least one spinner starts */
	igt_spin_busywait_until_started(spin);
}

static void restore_rps_defaults(int dir)
{
	int def;
	uint32_t min = 0, max = 0;

	/* Read from gt/gtN/.defaults/ write to gt/gtN/ */
	def = openat(dir, ".defaults", O_RDONLY);
	if (def < 0)
		return;

	__igt_sysfs_get_u32(def, "rps_max_freq_mhz", &max);
	__igt_sysfs_set_u32(dir, "rps_max_freq_mhz", max);

	__igt_sysfs_get_u32(def, "rps_min_freq_mhz", &min);
	__igt_sysfs_set_u32(dir, "rps_min_freq_mhz", min);

	close(def);
}

static void setup_freq(int gt, int dir)
{
	uint32_t rp0 = 0, rp1 = 0, rpn = 0, min = 0, max = 0, act = 0, media = 0;

	ctx = intel_ctx_create_all_physical(i915);
	ahnd = get_reloc_ahnd(i915, ctx->id);

	/* Reset to known state */
	restore_rps_defaults(dir);

	/* Spin on all engines to jack freq up to max */
	spin_all();
	wait_freq_set();

	/* Print some debug information */
	rp0 = __igt_sysfs_get_u32(dir, "rps_RP0_freq_mhz", &rp0);
	rp1 = __igt_sysfs_get_u32(dir, "rps_RP1_freq_mhz", &rp1);
	rpn = __igt_sysfs_get_u32(dir, "rps_RPn_freq_mhz", &rpn);
	min = __igt_sysfs_get_u32(dir, "rps_min_freq_mhz", &min);
	max = __igt_sysfs_get_u32(dir, "rps_max_freq_mhz", &max);
	act = __igt_sysfs_get_u32(dir, "rps_act_freq_mhz", &act);

	igt_debug("RP0 MHz: %u, RP1 MHz: %u, RPn MHz: %u, min MHz: %u, max MHz: %u, act MHz: %u\n",
		  rp0, rp1, rpn, min, max, act);

	if (igt_sysfs_has_attr(dir, "media_freq_factor")) {
		__igt_sysfs_get_u32(dir, "media_freq_factor", &media);
		igt_debug("media ratio: %.2f\n", media * FREQ_SCALE_FACTOR);
	}
}

static void cleanup(int dir)
{
	igt_free_spins(i915);
	put_ahnd(ahnd);
	intel_ctx_destroy(i915, ctx);
	restore_rps_defaults(dir);
	gem_quiescent_gpu(i915);
}

static void media_freq(int gt, int dir)
{
	float scale;
	uint32_t rp0 = 0, rpn = 0;

	igt_require(igt_sysfs_has_attr(dir, "media_freq_factor"));

	igt_sysfs_scanf(dir, "media_freq_factor.scale", "%g", &scale);
	igt_assert_eq_double(scale, FREQ_SCALE_FACTOR);

	setup_freq(gt, dir);

	__igt_sysfs_get_u32(dir, "media_RP0_freq_mhz", &rp0);
	__igt_sysfs_get_u32(dir, "media_RPn_freq_mhz", &rpn);
	igt_debug("media RP0 MHz: %u, media RPn MHz: %u\n", rp0, rpn);
	igt_debug("media ratio value 0.0 represents dynamic mode\n");

	/*
	 * Media freq ratio modes supported are: dynamic (0), 1:2 (128) and
	 * 1:1 (256). Setting dynamic (0) can return any of the three
	 * modes. Fixed ratio modes should return the same value.
	 */
	for (int v = 256; v >= 0; v -= 64) {
		int ret;
		uint32_t getv = 0;

		/*
		 * Check that we can set the mode. Ratios other than 1:2
		 * and 1:1 are not supported.
		 */
		ret = igt_sysfs_printf(dir, "media_freq_factor", "%u", v);
		if (ret <= 0) {
			igt_debug("Media ratio %.2f is not supported\n", v * scale);
			continue;
		}

		wait_freq_set();

		__igt_sysfs_get_u32(dir, "media_freq_factor", &getv);

		igt_debug("media ratio set: %.2f, media ratio get: %.2f\n",
			  v * scale, getv * scale);

		/*
		 * Skip validation in dynamic mode since the returned media
		 * ratio and freq are platform dependent and not clearly defined
		 */
		if (v)
			igt_assert_eq(getv, v);
	}

	cleanup(dir);
}

igt_main
{
	int dir, gt;

	igt_fixture {
		i915 = drm_open_driver(DRIVER_INTEL);

		/* Frequency multipliers are not simulated. */
		igt_require(!igt_run_in_simulation());
	}

	igt_describe("Tests for media frequency factor sysfs");
	igt_subtest_with_dynamic("media-freq") {
		for_each_sysfs_gt_dirfd(i915, dir, gt) {
			igt_dynamic_f("gt%d", gt)
				media_freq(gt, dir);
		}
	}

	igt_fixture {
		drm_close_driver(i915);
	}
}