123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224 |
- /*
- * DT idle states parsing code.
- *
- * Copyright (C) 2014 ARM Ltd.
- * Author: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com>
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- */
- #define pr_fmt(fmt) "DT idle-states: " fmt
- #include <linux/cpuidle.h>
- #include <linux/cpumask.h>
- #include <linux/errno.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/of_device.h>
- #include "dt_idle_states.h"
- static int init_state_node(struct cpuidle_state *idle_state,
- const struct of_device_id *matches,
- struct device_node *state_node)
- {
- int err;
- const struct of_device_id *match_id;
- const char *desc;
- match_id = of_match_node(matches, state_node);
- if (!match_id)
- return -ENODEV;
- /*
- * CPUidle drivers are expected to initialize the const void *data
- * pointer of the passed in struct of_device_id array to the idle
- * state enter function.
- */
- idle_state->enter = match_id->data;
- err = of_property_read_u32(state_node, "wakeup-latency-us",
- &idle_state->exit_latency);
- if (err) {
- u32 entry_latency, exit_latency;
- err = of_property_read_u32(state_node, "entry-latency-us",
- &entry_latency);
- if (err) {
- pr_debug(" * %s missing entry-latency-us property\n",
- state_node->full_name);
- return -EINVAL;
- }
- err = of_property_read_u32(state_node, "exit-latency-us",
- &exit_latency);
- if (err) {
- pr_debug(" * %s missing exit-latency-us property\n",
- state_node->full_name);
- return -EINVAL;
- }
- /*
- * If wakeup-latency-us is missing, default to entry+exit
- * latencies as defined in idle states bindings
- */
- idle_state->exit_latency = entry_latency + exit_latency;
- }
- err = of_property_read_u32(state_node, "min-residency-us",
- &idle_state->target_residency);
- if (err) {
- pr_debug(" * %s missing min-residency-us property\n",
- state_node->full_name);
- return -EINVAL;
- }
- err = of_property_read_string(state_node, "idle-state-name", &desc);
- if (err)
- desc = state_node->name;
- idle_state->flags = 0;
- if (of_property_read_bool(state_node, "local-timer-stop"))
- idle_state->flags |= CPUIDLE_FLAG_TIMER_STOP;
- /*
- * TODO:
- * replace with kstrdup and pointer assignment when name
- * and desc become string pointers
- */
- strncpy(idle_state->name, state_node->name, CPUIDLE_NAME_LEN - 1);
- strncpy(idle_state->desc, desc, CPUIDLE_DESC_LEN - 1);
- return 0;
- }
- /*
- * Check that the idle state is uniform across all CPUs in the CPUidle driver
- * cpumask
- */
- static bool idle_state_valid(struct device_node *state_node, unsigned int idx,
- const cpumask_t *cpumask)
- {
- int cpu;
- struct device_node *cpu_node, *curr_state_node;
- bool valid = true;
- /*
- * Compare idle state phandles for index idx on all CPUs in the
- * CPUidle driver cpumask. Start from next logical cpu following
- * cpumask_first(cpumask) since that's the CPU state_node was
- * retrieved from. If a mismatch is found bail out straight
- * away since we certainly hit a firmware misconfiguration.
- */
- for (cpu = cpumask_next(cpumask_first(cpumask), cpumask);
- cpu < nr_cpu_ids; cpu = cpumask_next(cpu, cpumask)) {
- cpu_node = of_cpu_device_node_get(cpu);
- curr_state_node = of_parse_phandle(cpu_node, "cpu-idle-states",
- idx);
- if (state_node != curr_state_node)
- valid = false;
- of_node_put(curr_state_node);
- of_node_put(cpu_node);
- if (!valid)
- break;
- }
- return valid;
- }
- /**
- * dt_init_idle_driver() - Parse the DT idle states and initialize the
- * idle driver states array
- * @drv: Pointer to CPU idle driver to be initialized
- * @matches: Array of of_device_id match structures to search in for
- * compatible idle state nodes. The data pointer for each valid
- * struct of_device_id entry in the matches array must point to
- * a function with the following signature, that corresponds to
- * the CPUidle state enter function signature:
- *
- * int (*)(struct cpuidle_device *dev,
- * struct cpuidle_driver *drv,
- * int index);
- *
- * @start_idx: First idle state index to be initialized
- *
- * If DT idle states are detected and are valid the state count and states
- * array entries in the cpuidle driver are initialized accordingly starting
- * from index start_idx.
- *
- * Return: number of valid DT idle states parsed, <0 on failure
- */
- int dt_init_idle_driver(struct cpuidle_driver *drv,
- const struct of_device_id *matches,
- unsigned int start_idx)
- {
- struct cpuidle_state *idle_state;
- struct device_node *state_node, *cpu_node;
- int i, err = 0;
- const cpumask_t *cpumask;
- unsigned int state_idx = start_idx;
- if (state_idx >= CPUIDLE_STATE_MAX)
- return -EINVAL;
- /*
- * We get the idle states for the first logical cpu in the
- * driver mask (or cpu_possible_mask if the driver cpumask is not set)
- * and we check through idle_state_valid() if they are uniform
- * across CPUs, otherwise we hit a firmware misconfiguration.
- */
- cpumask = drv->cpumask ? : cpu_possible_mask;
- cpu_node = of_cpu_device_node_get(cpumask_first(cpumask));
- for (i = 0; ; i++) {
- state_node = of_parse_phandle(cpu_node, "cpu-idle-states", i);
- if (!state_node)
- break;
- if (!of_device_is_available(state_node)) {
- of_node_put(state_node);
- continue;
- }
- if (!idle_state_valid(state_node, i, cpumask)) {
- pr_warn("%s idle state not valid, bailing out\n",
- state_node->full_name);
- err = -EINVAL;
- break;
- }
- if (state_idx == CPUIDLE_STATE_MAX) {
- pr_warn("State index reached static CPU idle driver states array size\n");
- break;
- }
- idle_state = &drv->states[state_idx++];
- err = init_state_node(idle_state, matches, state_node);
- if (err) {
- pr_err("Parsing idle state node %s failed with err %d\n",
- state_node->full_name, err);
- err = -EINVAL;
- break;
- }
- of_node_put(state_node);
- }
- of_node_put(state_node);
- of_node_put(cpu_node);
- if (err)
- return err;
- /*
- * Update the driver state count only if some valid DT idle states
- * were detected
- */
- if (i)
- drv->state_count = state_idx;
- /*
- * Return the number of present and valid DT idle states, which can
- * also be 0 on platforms with missing DT idle states or legacy DT
- * configuration predating the DT idle states bindings.
- */
- return i;
- }
- EXPORT_SYMBOL_GPL(dt_init_idle_driver);
|