driver.c 2.5 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * driver.c - driver support
 *
 * (C) 2006-2007 Venkatesh Pallipadi <venkatesh.pallipadi@intel.com>
 *               Shaohua Li <shaohua.li@intel.com>
 *               Adam Belay <abelay@novell.com>
 *
 * This code is licenced under the GPL.
 */

#include <linux/mutex.h>
#include <linux/module.h>
#include <linux/cpuidle.h>

#include "cpuidle.h"

17
static struct cpuidle_driver *cpuidle_curr_driver;
18 19
DEFINE_SPINLOCK(cpuidle_driver_lock);

20
static void set_power_states(struct cpuidle_driver *drv)
21 22
{
	int i;
23

24 25 26 27 28 29 30 31 32 33 34 35 36 37
	/*
	 * cpuidle driver should set the drv->power_specified bit
	 * before registering if the driver provides
	 * power_usage numbers.
	 *
	 * If power_specified is not set,
	 * we fill in power_usage with decreasing values as the
	 * cpuidle code has an implicit assumption that state Cn
	 * uses less power than C(n-1).
	 *
	 * With CONFIG_ARCH_HAS_CPU_RELAX, C0 is already assigned
	 * an power value of -1.  So we use -2, -3, etc, for other
	 * c-states.
	 */
38 39
	for (i = CPUIDLE_DRIVER_STATE_START; i < drv->state_count; i++)
		drv->states[i].power_usage = -1 - i;
40 41
}

42 43 44 45 46 47
/**
 * cpuidle_register_driver - registers a driver
 * @drv: the driver
 */
int cpuidle_register_driver(struct cpuidle_driver *drv)
{
48
	if (!drv || !drv->state_count)
49 50
		return -EINVAL;

51 52 53
	if (cpuidle_disabled())
		return -ENODEV;

54 55 56 57 58
	spin_lock(&cpuidle_driver_lock);
	if (cpuidle_curr_driver) {
		spin_unlock(&cpuidle_driver_lock);
		return -EBUSY;
	}
59 60 61 62

	if (!drv->power_specified)
		set_power_states(drv);

63 64
	drv->refcnt = 0;

65
	cpuidle_curr_driver = drv;
66

67 68 69 70 71 72
	spin_unlock(&cpuidle_driver_lock);

	return 0;
}
EXPORT_SYMBOL_GPL(cpuidle_register_driver);

73 74 75 76 77 78 79 80 81
/**
 * cpuidle_get_driver - return the current driver
 */
struct cpuidle_driver *cpuidle_get_driver(void)
{
	return cpuidle_curr_driver;
}
EXPORT_SYMBOL_GPL(cpuidle_get_driver);

82 83 84 85 86 87 88
/**
 * cpuidle_unregister_driver - unregisters a driver
 * @drv: the driver
 */
void cpuidle_unregister_driver(struct cpuidle_driver *drv)
{
	spin_lock(&cpuidle_driver_lock);
89
	if (drv == cpuidle_curr_driver && !WARN_ON(drv->refcnt > 0))
90
		cpuidle_curr_driver = NULL;
91 92 93
	spin_unlock(&cpuidle_driver_lock);
}
EXPORT_SYMBOL_GPL(cpuidle_unregister_driver);
94 95 96 97 98 99 100 101

struct cpuidle_driver *cpuidle_driver_ref(void)
{
	struct cpuidle_driver *drv;

	spin_lock(&cpuidle_driver_lock);

	drv = cpuidle_curr_driver;
102
	drv->refcnt++;
103 104 105 106 107 108 109

	spin_unlock(&cpuidle_driver_lock);
	return drv;
}

void cpuidle_driver_unref(void)
{
110 111
	struct cpuidle_driver *drv = cpuidle_curr_driver;

112 113
	spin_lock(&cpuidle_driver_lock);

114 115
	if (drv && !WARN_ON(drv->refcnt <= 0))
		drv->refcnt--;
116 117 118

	spin_unlock(&cpuidle_driver_lock);
}