18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * poll_state.c - Polling idle state
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/cpuidle.h>
78c2ecf20Sopenharmony_ci#include <linux/sched.h>
88c2ecf20Sopenharmony_ci#include <linux/sched/clock.h>
98c2ecf20Sopenharmony_ci#include <linux/sched/idle.h>
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ci#define POLL_IDLE_RELAX_COUNT	200
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_cistatic int __cpuidle poll_idle(struct cpuidle_device *dev,
148c2ecf20Sopenharmony_ci			       struct cpuidle_driver *drv, int index)
158c2ecf20Sopenharmony_ci{
168c2ecf20Sopenharmony_ci	u64 time_start = local_clock();
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci	dev->poll_time_limit = false;
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci	local_irq_enable();
218c2ecf20Sopenharmony_ci	if (!current_set_polling_and_test()) {
228c2ecf20Sopenharmony_ci		unsigned int loop_count = 0;
238c2ecf20Sopenharmony_ci		u64 limit;
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci		limit = cpuidle_poll_time(drv, dev);
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci		while (!need_resched()) {
288c2ecf20Sopenharmony_ci			cpu_relax();
298c2ecf20Sopenharmony_ci			if (loop_count++ < POLL_IDLE_RELAX_COUNT)
308c2ecf20Sopenharmony_ci				continue;
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci			loop_count = 0;
338c2ecf20Sopenharmony_ci			if (local_clock() - time_start > limit) {
348c2ecf20Sopenharmony_ci				dev->poll_time_limit = true;
358c2ecf20Sopenharmony_ci				break;
368c2ecf20Sopenharmony_ci			}
378c2ecf20Sopenharmony_ci		}
388c2ecf20Sopenharmony_ci	}
398c2ecf20Sopenharmony_ci	current_clr_polling();
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci	return index;
428c2ecf20Sopenharmony_ci}
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_civoid cpuidle_poll_state_init(struct cpuidle_driver *drv)
458c2ecf20Sopenharmony_ci{
468c2ecf20Sopenharmony_ci	struct cpuidle_state *state = &drv->states[0];
478c2ecf20Sopenharmony_ci
488c2ecf20Sopenharmony_ci	snprintf(state->name, CPUIDLE_NAME_LEN, "POLL");
498c2ecf20Sopenharmony_ci	snprintf(state->desc, CPUIDLE_DESC_LEN, "CPUIDLE CORE POLL IDLE");
508c2ecf20Sopenharmony_ci	state->exit_latency = 0;
518c2ecf20Sopenharmony_ci	state->target_residency = 0;
528c2ecf20Sopenharmony_ci	state->exit_latency_ns = 0;
538c2ecf20Sopenharmony_ci	state->target_residency_ns = 0;
548c2ecf20Sopenharmony_ci	state->power_usage = -1;
558c2ecf20Sopenharmony_ci	state->enter = poll_idle;
568c2ecf20Sopenharmony_ci	state->flags = CPUIDLE_FLAG_POLLING;
578c2ecf20Sopenharmony_ci}
588c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(cpuidle_poll_state_init);
59