18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * haltpoll.c - haltpoll idle governor
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright 2019 Red Hat, Inc. and/or its affiliates.
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * This work is licensed under the terms of the GNU GPL, version 2.  See
88c2ecf20Sopenharmony_ci * the COPYING file in the top-level directory.
98c2ecf20Sopenharmony_ci *
108c2ecf20Sopenharmony_ci * Authors: Marcelo Tosatti <mtosatti@redhat.com>
118c2ecf20Sopenharmony_ci */
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_ci#include <linux/kernel.h>
148c2ecf20Sopenharmony_ci#include <linux/cpuidle.h>
158c2ecf20Sopenharmony_ci#include <linux/time.h>
168c2ecf20Sopenharmony_ci#include <linux/ktime.h>
178c2ecf20Sopenharmony_ci#include <linux/hrtimer.h>
188c2ecf20Sopenharmony_ci#include <linux/tick.h>
198c2ecf20Sopenharmony_ci#include <linux/sched.h>
208c2ecf20Sopenharmony_ci#include <linux/module.h>
218c2ecf20Sopenharmony_ci#include <linux/kvm_para.h>
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_cistatic unsigned int guest_halt_poll_ns __read_mostly = 200000;
248c2ecf20Sopenharmony_cimodule_param(guest_halt_poll_ns, uint, 0644);
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci/* division factor to shrink halt_poll_ns */
278c2ecf20Sopenharmony_cistatic unsigned int guest_halt_poll_shrink __read_mostly = 2;
288c2ecf20Sopenharmony_cimodule_param(guest_halt_poll_shrink, uint, 0644);
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci/* multiplication factor to grow per-cpu poll_limit_ns */
318c2ecf20Sopenharmony_cistatic unsigned int guest_halt_poll_grow __read_mostly = 2;
328c2ecf20Sopenharmony_cimodule_param(guest_halt_poll_grow, uint, 0644);
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci/* value in us to start growing per-cpu halt_poll_ns */
358c2ecf20Sopenharmony_cistatic unsigned int guest_halt_poll_grow_start __read_mostly = 50000;
368c2ecf20Sopenharmony_cimodule_param(guest_halt_poll_grow_start, uint, 0644);
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci/* allow shrinking guest halt poll */
398c2ecf20Sopenharmony_cistatic bool guest_halt_poll_allow_shrink __read_mostly = true;
408c2ecf20Sopenharmony_cimodule_param(guest_halt_poll_allow_shrink, bool, 0644);
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci/**
438c2ecf20Sopenharmony_ci * haltpoll_select - selects the next idle state to enter
448c2ecf20Sopenharmony_ci * @drv: cpuidle driver containing state data
458c2ecf20Sopenharmony_ci * @dev: the CPU
468c2ecf20Sopenharmony_ci * @stop_tick: indication on whether or not to stop the tick
478c2ecf20Sopenharmony_ci */
488c2ecf20Sopenharmony_cistatic int haltpoll_select(struct cpuidle_driver *drv,
498c2ecf20Sopenharmony_ci			   struct cpuidle_device *dev,
508c2ecf20Sopenharmony_ci			   bool *stop_tick)
518c2ecf20Sopenharmony_ci{
528c2ecf20Sopenharmony_ci	s64 latency_req = cpuidle_governor_latency_req(dev->cpu);
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci	if (!drv->state_count || latency_req == 0) {
558c2ecf20Sopenharmony_ci		*stop_tick = false;
568c2ecf20Sopenharmony_ci		return 0;
578c2ecf20Sopenharmony_ci	}
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci	if (dev->poll_limit_ns == 0)
608c2ecf20Sopenharmony_ci		return 1;
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	/* Last state was poll? */
638c2ecf20Sopenharmony_ci	if (dev->last_state_idx == 0) {
648c2ecf20Sopenharmony_ci		/* Halt if no event occurred on poll window */
658c2ecf20Sopenharmony_ci		if (dev->poll_time_limit == true)
668c2ecf20Sopenharmony_ci			return 1;
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_ci		*stop_tick = false;
698c2ecf20Sopenharmony_ci		/* Otherwise, poll again */
708c2ecf20Sopenharmony_ci		return 0;
718c2ecf20Sopenharmony_ci	}
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci	*stop_tick = false;
748c2ecf20Sopenharmony_ci	/* Last state was halt: poll */
758c2ecf20Sopenharmony_ci	return 0;
768c2ecf20Sopenharmony_ci}
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_cistatic void adjust_poll_limit(struct cpuidle_device *dev, u64 block_ns)
798c2ecf20Sopenharmony_ci{
808c2ecf20Sopenharmony_ci	unsigned int val;
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci	/* Grow cpu_halt_poll_us if
838c2ecf20Sopenharmony_ci	 * cpu_halt_poll_us < block_ns < guest_halt_poll_us
848c2ecf20Sopenharmony_ci	 */
858c2ecf20Sopenharmony_ci	if (block_ns > dev->poll_limit_ns && block_ns <= guest_halt_poll_ns) {
868c2ecf20Sopenharmony_ci		val = dev->poll_limit_ns * guest_halt_poll_grow;
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci		if (val < guest_halt_poll_grow_start)
898c2ecf20Sopenharmony_ci			val = guest_halt_poll_grow_start;
908c2ecf20Sopenharmony_ci		if (val > guest_halt_poll_ns)
918c2ecf20Sopenharmony_ci			val = guest_halt_poll_ns;
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci		dev->poll_limit_ns = val;
948c2ecf20Sopenharmony_ci	} else if (block_ns > guest_halt_poll_ns &&
958c2ecf20Sopenharmony_ci		   guest_halt_poll_allow_shrink) {
968c2ecf20Sopenharmony_ci		unsigned int shrink = guest_halt_poll_shrink;
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci		val = dev->poll_limit_ns;
998c2ecf20Sopenharmony_ci		if (shrink == 0)
1008c2ecf20Sopenharmony_ci			val = 0;
1018c2ecf20Sopenharmony_ci		else
1028c2ecf20Sopenharmony_ci			val /= shrink;
1038c2ecf20Sopenharmony_ci		dev->poll_limit_ns = val;
1048c2ecf20Sopenharmony_ci	}
1058c2ecf20Sopenharmony_ci}
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci/**
1088c2ecf20Sopenharmony_ci * haltpoll_reflect - update variables and update poll time
1098c2ecf20Sopenharmony_ci * @dev: the CPU
1108c2ecf20Sopenharmony_ci * @index: the index of actual entered state
1118c2ecf20Sopenharmony_ci */
1128c2ecf20Sopenharmony_cistatic void haltpoll_reflect(struct cpuidle_device *dev, int index)
1138c2ecf20Sopenharmony_ci{
1148c2ecf20Sopenharmony_ci	dev->last_state_idx = index;
1158c2ecf20Sopenharmony_ci
1168c2ecf20Sopenharmony_ci	if (index != 0)
1178c2ecf20Sopenharmony_ci		adjust_poll_limit(dev, dev->last_residency_ns);
1188c2ecf20Sopenharmony_ci}
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_ci/**
1218c2ecf20Sopenharmony_ci * haltpoll_enable_device - scans a CPU's states and does setup
1228c2ecf20Sopenharmony_ci * @drv: cpuidle driver
1238c2ecf20Sopenharmony_ci * @dev: the CPU
1248c2ecf20Sopenharmony_ci */
1258c2ecf20Sopenharmony_cistatic int haltpoll_enable_device(struct cpuidle_driver *drv,
1268c2ecf20Sopenharmony_ci				  struct cpuidle_device *dev)
1278c2ecf20Sopenharmony_ci{
1288c2ecf20Sopenharmony_ci	dev->poll_limit_ns = 0;
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ci	return 0;
1318c2ecf20Sopenharmony_ci}
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_cistatic struct cpuidle_governor haltpoll_governor = {
1348c2ecf20Sopenharmony_ci	.name =			"haltpoll",
1358c2ecf20Sopenharmony_ci	.rating =		9,
1368c2ecf20Sopenharmony_ci	.enable =		haltpoll_enable_device,
1378c2ecf20Sopenharmony_ci	.select =		haltpoll_select,
1388c2ecf20Sopenharmony_ci	.reflect =		haltpoll_reflect,
1398c2ecf20Sopenharmony_ci};
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_cistatic int __init init_haltpoll(void)
1428c2ecf20Sopenharmony_ci{
1438c2ecf20Sopenharmony_ci	if (kvm_para_available())
1448c2ecf20Sopenharmony_ci		return cpuidle_register_governor(&haltpoll_governor);
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci	return 0;
1478c2ecf20Sopenharmony_ci}
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_cipostcore_initcall(init_haltpoll);
150