[linux-2.6-block.git] / arch / mips / alchemy / devboards / pm.c

/*
 * Alchemy Development Board example suspend userspace interface.
 *
 * (c) 2008 Manuel Lauss <mano@roarinelk.homelinux.net>
 */

#include <linux/init.h>
#include <linux/kobject.h>
#include <linux/suspend.h>
#include <linux/sysfs.h>
#include <asm/mach-au1x00/au1000.h>
#include <asm/mach-au1x00/gpio-au1000.h>
#include <asm/mach-db1x00/bcsr.h>

/*
 * Generic suspend userspace interface for Alchemy development boards.
 * This code exports a few sysfs nodes under /sys/power/db1x/ which
 * can be used by userspace to en/disable all au1x-provided wakeup
 * sources and configure the timeout after which the the TOYMATCH2 irq
 * is to trigger a wakeup.
 */


static unsigned long db1x_pm_sleep_secs;
static unsigned long db1x_pm_wakemsk;
static unsigned long db1x_pm_last_wakesrc;

static int db1x_pm_enter(suspend_state_t state)
{
	unsigned short bcsrs[16];
	int i, j, hasint;

	/* save CPLD regs */
	hasint = bcsr_read(BCSR_WHOAMI);
	hasint = BCSR_WHOAMI_BOARD(hasint) >= BCSR_WHOAMI_DB1200;
	j = (hasint) ? BCSR_MASKSET : BCSR_SYSTEM;

	for (i = BCSR_STATUS; i <= j; i++)
		bcsrs[i] = bcsr_read(i);

	/* shut off hexleds */
	bcsr_write(BCSR_HEXCLEAR, 3);

	/* enable GPIO based wakeup */
	alchemy_gpio1_input_enable();

	/* clear and setup wake cause and source */
	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);
	alchemy_wrsys(0, AU1000_SYS_WAKESRC);

	alchemy_wrsys(db1x_pm_wakemsk, AU1000_SYS_WAKEMSK);

	/* setup 1Hz-timer-based wakeup: wait for reg access */
	while (alchemy_rdsys(AU1000_SYS_CNTRCTRL) & SYS_CNTRL_M20)
		asm volatile ("nop");

	alchemy_wrsys(alchemy_rdsys(AU1000_SYS_TOYREAD) + db1x_pm_sleep_secs,
		      AU1000_SYS_TOYMATCH2);

	/* wait for value to really hit the register */
	while (alchemy_rdsys(AU1000_SYS_CNTRCTRL) & SYS_CNTRL_M20)
		asm volatile ("nop");

	/* ...and now the sandman can come! */
	au_sleep();


	/* restore CPLD regs */
	for (i = BCSR_STATUS; i <= BCSR_SYSTEM; i++)
		bcsr_write(i, bcsrs[i]);

	/* restore CPLD int registers */
	if (hasint) {
		bcsr_write(BCSR_INTCLR, 0xffff);
		bcsr_write(BCSR_MASKCLR, 0xffff);
		bcsr_write(BCSR_INTSTAT, 0xffff);
		bcsr_write(BCSR_INTSET, bcsrs[BCSR_INTSET]);
		bcsr_write(BCSR_MASKSET, bcsrs[BCSR_MASKSET]);
	}

	/* light up hexleds */
	bcsr_write(BCSR_HEXCLEAR, 0);

	return 0;
}

static int db1x_pm_begin(suspend_state_t state)
{
	if (!db1x_pm_wakemsk) {
		printk(KERN_ERR "db1x: no wakeup source activated!\n");
		return -EINVAL;
	}

	return 0;
}

static void db1x_pm_end(void)
{
	/* read and store wakeup source, the clear the register. To
	 * be able to clear it, WAKEMSK must be cleared first.
	 */
	db1x_pm_last_wakesrc = alchemy_rdsys(AU1000_SYS_WAKESRC);

	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);
	alchemy_wrsys(0, AU1000_SYS_WAKESRC);
}

static const struct platform_suspend_ops db1x_pm_ops = {
	.valid		= suspend_valid_only_mem,
	.begin		= db1x_pm_begin,
	.enter		= db1x_pm_enter,
	.end		= db1x_pm_end,
};

#define ATTRCMP(x) (0 == strcmp(attr->attr.name, #x))

static ssize_t db1x_pmattr_show(struct kobject *kobj,
				struct kobj_attribute *attr,
				char *buf)
{
	int idx;

	if (ATTRCMP(timer_timeout))
		return sprintf(buf, "%lu\n", db1x_pm_sleep_secs);

	else if (ATTRCMP(timer))
		return sprintf(buf, "%u\n",
				!!(db1x_pm_wakemsk & SYS_WAKEMSK_M2));

	else if (ATTRCMP(wakesrc))
		return sprintf(buf, "%lu\n", db1x_pm_last_wakesrc);

	else if (ATTRCMP(gpio0) || ATTRCMP(gpio1) || ATTRCMP(gpio2) ||
		 ATTRCMP(gpio3) || ATTRCMP(gpio4) || ATTRCMP(gpio5) ||
		 ATTRCMP(gpio6) || ATTRCMP(gpio7)) {
		idx = (attr->attr.name)[4] - '0';
		return sprintf(buf, "%d\n",
			!!(db1x_pm_wakemsk & SYS_WAKEMSK_GPIO(idx)));

	} else if (ATTRCMP(wakemsk)) {
		return sprintf(buf, "%08lx\n", db1x_pm_wakemsk);
	}

	return -ENOENT;
}

static ssize_t db1x_pmattr_store(struct kobject *kobj,
				 struct kobj_attribute *attr,
				 const char *instr,
				 size_t bytes)
{
	unsigned long l;
	int tmp;

	if (ATTRCMP(timer_timeout)) {
		tmp = kstrtoul(instr, 0, &l);
		if (tmp)
			return tmp;

		db1x_pm_sleep_secs = l;

	} else if (ATTRCMP(timer)) {
		if (instr[0] != '0')
			db1x_pm_wakemsk |= SYS_WAKEMSK_M2;
		else
			db1x_pm_wakemsk &= ~SYS_WAKEMSK_M2;

	} else if (ATTRCMP(gpio0) || ATTRCMP(gpio1) || ATTRCMP(gpio2) ||
		   ATTRCMP(gpio3) || ATTRCMP(gpio4) || ATTRCMP(gpio5) ||
		   ATTRCMP(gpio6) || ATTRCMP(gpio7)) {
		tmp = (attr->attr.name)[4] - '0';
		if (instr[0] != '0') {
			db1x_pm_wakemsk |= SYS_WAKEMSK_GPIO(tmp);
		} else {
			db1x_pm_wakemsk &= ~SYS_WAKEMSK_GPIO(tmp);
		}

	} else if (ATTRCMP(wakemsk)) {
		tmp = kstrtoul(instr, 0, &l);
		if (tmp)
			return tmp;

		db1x_pm_wakemsk = l & 0x0000003f;

	} else
		bytes = -ENOENT;

	return bytes;
}

#define ATTR(x)							\
	static struct kobj_attribute x##_attribute =		\
		__ATTR(x, 0664, db1x_pmattr_show,		\
				db1x_pmattr_store);

ATTR(gpio0)		/* GPIO-based wakeup enable */
ATTR(gpio1)
ATTR(gpio2)
ATTR(gpio3)
ATTR(gpio4)
ATTR(gpio5)
ATTR(gpio6)
ATTR(gpio7)
ATTR(timer)		/* TOYMATCH2-based wakeup enable */
ATTR(timer_timeout)	/* timer-based wakeup timeout value, in seconds */
ATTR(wakesrc)		/* contents of SYS_WAKESRC after last wakeup */
ATTR(wakemsk)		/* direct access to SYS_WAKEMSK */

#define ATTR_LIST(x)	& x ## _attribute.attr
static struct attribute *db1x_pmattrs[] = {
	ATTR_LIST(gpio0),
	ATTR_LIST(gpio1),
	ATTR_LIST(gpio2),
	ATTR_LIST(gpio3),
	ATTR_LIST(gpio4),
	ATTR_LIST(gpio5),
	ATTR_LIST(gpio6),
	ATTR_LIST(gpio7),
	ATTR_LIST(timer),
	ATTR_LIST(timer_timeout),
	ATTR_LIST(wakesrc),
	ATTR_LIST(wakemsk),
	NULL,		/* terminator */
};

static struct attribute_group db1x_pmattr_group = {
	.name	= "db1x",
	.attrs	= db1x_pmattrs,
};

/*
 * Initialize suspend interface
 */
static int __init pm_init(void)
{
	/* init TOY to tick at 1Hz if not already done. No need to wait
	 * for confirmation since there's plenty of time from here to
	 * the next suspend cycle.
	 */
	if (alchemy_rdsys(AU1000_SYS_TOYTRIM) != 32767)
		alchemy_wrsys(32767, AU1000_SYS_TOYTRIM);

	db1x_pm_last_wakesrc = alchemy_rdsys(AU1000_SYS_WAKESRC);

	alchemy_wrsys(0, AU1000_SYS_WAKESRC);
	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);

	suspend_set_ops(&db1x_pm_ops);

	return sysfs_create_group(power_kobj, &db1x_pmattr_group);
}

late_initcall(pm_init);
Commit	Line	Data
61f9c58d ML	1	/*
	2	* Alchemy Development Board example suspend userspace interface.
	3	*
	4	* (c) 2008 Manuel Lauss <mano@roarinelk.homelinux.net>
	5	*/
	6
	7	#include <linux/init.h>
	8	#include <linux/kobject.h>
	9	#include <linux/suspend.h>
	10	#include <linux/sysfs.h>
	11	#include <asm/mach-au1x00/au1000.h>
832f5dac	12	#include <asm/mach-au1x00/gpio-au1000.h>
e275ed5e	13	#include <asm/mach-db1x00/bcsr.h>
61f9c58d ML	14
	15	/*
	16	* Generic suspend userspace interface for Alchemy development boards.
	17	* This code exports a few sysfs nodes under /sys/power/db1x/ which
	18	* can be used by userspace to en/disable all au1x-provided wakeup
	19	* sources and configure the timeout after which the the TOYMATCH2 irq
	20	* is to trigger a wakeup.
	21	*/
	22
	23
	24	static unsigned long db1x_pm_sleep_secs;
	25	static unsigned long db1x_pm_wakemsk;
	26	static unsigned long db1x_pm_last_wakesrc;
	27
	28	static int db1x_pm_enter(suspend_state_t state)
	29	{
e275ed5e ML	30	unsigned short bcsrs[16];
	31	int i, j, hasint;
	32
	33	/* save CPLD regs */
	34	hasint = bcsr_read(BCSR_WHOAMI);
	35	hasint = BCSR_WHOAMI_BOARD(hasint) >= BCSR_WHOAMI_DB1200;
	36	j = (hasint) ? BCSR_MASKSET : BCSR_SYSTEM;
	37
	38	for (i = BCSR_STATUS; i <= j; i++)
	39	bcsrs[i] = bcsr_read(i);
	40
	41	/* shut off hexleds */
	42	bcsr_write(BCSR_HEXCLEAR, 3);
	43
61f9c58d	44	/* enable GPIO based wakeup */
ce65cc8f	45	alchemy_gpio1_input_enable();
61f9c58d ML	46
61f9c58d ML	47	/* clear and setup wake cause and source */
1d09de7d ML	48	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);
1d09de7d ML	49	alchemy_wrsys(0, AU1000_SYS_WAKESRC);
61f9c58d	50
1d09de7d	51	alchemy_wrsys(db1x_pm_wakemsk, AU1000_SYS_WAKEMSK);
61f9c58d ML	52
61f9c58d ML	53	/* setup 1Hz-timer-based wakeup: wait for reg access */
1d09de7d	54	while (alchemy_rdsys(AU1000_SYS_CNTRCTRL) & SYS_CNTRL_M20)
61f9c58d ML	55	asm volatile ("nop");
61f9c58d ML	56
1d09de7d ML	57	alchemy_wrsys(alchemy_rdsys(AU1000_SYS_TOYREAD) + db1x_pm_sleep_secs,
1d09de7d ML	58	AU1000_SYS_TOYMATCH2);
61f9c58d ML	59
61f9c58d ML	60	/* wait for value to really hit the register */
1d09de7d	61	while (alchemy_rdsys(AU1000_SYS_CNTRCTRL) & SYS_CNTRL_M20)
61f9c58d ML	62	asm volatile ("nop");
	63
	64	/* ...and now the sandman can come! */
	65	au_sleep();
	66
e275ed5e ML	67
	68	/* restore CPLD regs */
	69	for (i = BCSR_STATUS; i <= BCSR_SYSTEM; i++)
	70	bcsr_write(i, bcsrs[i]);
	71
	72	/* restore CPLD int registers */
	73	if (hasint) {
	74	bcsr_write(BCSR_INTCLR, 0xffff);
	75	bcsr_write(BCSR_MASKCLR, 0xffff);
	76	bcsr_write(BCSR_INTSTAT, 0xffff);
	77	bcsr_write(BCSR_INTSET, bcsrs[BCSR_INTSET]);
	78	bcsr_write(BCSR_MASKSET, bcsrs[BCSR_MASKSET]);
	79	}
	80
	81	/* light up hexleds */
	82	bcsr_write(BCSR_HEXCLEAR, 0);
	83
61f9c58d ML	84	return 0;
	85	}
	86
	87	static int db1x_pm_begin(suspend_state_t state)
	88	{
	89	if (!db1x_pm_wakemsk) {
	90	printk(KERN_ERR "db1x: no wakeup source activated!\n");
	91	return -EINVAL;
	92	}
	93
	94	return 0;
	95	}
	96
	97	static void db1x_pm_end(void)
	98	{
	99	/* read and store wakeup source, the clear the register. To
	100	* be able to clear it, WAKEMSK must be cleared first.
	101	*/
1d09de7d	102	db1x_pm_last_wakesrc = alchemy_rdsys(AU1000_SYS_WAKESRC);
61f9c58d	103
1d09de7d ML	104	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);
1d09de7d ML	105	alchemy_wrsys(0, AU1000_SYS_WAKESRC);
61f9c58d ML	106	}
61f9c58d ML	107
2f55ac07	108	static const struct platform_suspend_ops db1x_pm_ops = {
61f9c58d ML	109	.valid = suspend_valid_only_mem,
	110	.begin = db1x_pm_begin,
	111	.enter = db1x_pm_enter,
	112	.end = db1x_pm_end,
	113	};
	114
	115	#define ATTRCMP(x) (0 == strcmp(attr->attr.name, #x))
	116
	117	static ssize_t db1x_pmattr_show(struct kobject *kobj,
	118	struct kobj_attribute *attr,
	119	char *buf)
	120	{
	121	int idx;
	122
	123	if (ATTRCMP(timer_timeout))
	124	return sprintf(buf, "%lu\n", db1x_pm_sleep_secs);
	125
	126	else if (ATTRCMP(timer))
	127	return sprintf(buf, "%u\n",
	128	!!(db1x_pm_wakemsk & SYS_WAKEMSK_M2));
	129
	130	else if (ATTRCMP(wakesrc))
	131	return sprintf(buf, "%lu\n", db1x_pm_last_wakesrc);
	132
	133	else if (ATTRCMP(gpio0) \|\| ATTRCMP(gpio1) \|\| ATTRCMP(gpio2) \|\|
	134	ATTRCMP(gpio3) \|\| ATTRCMP(gpio4) \|\| ATTRCMP(gpio5) \|\|
	135	ATTRCMP(gpio6) \|\| ATTRCMP(gpio7)) {
	136	idx = (attr->attr.name)[4] - '0';
	137	return sprintf(buf, "%d\n",
	138	!!(db1x_pm_wakemsk & SYS_WAKEMSK_GPIO(idx)));
	139
	140	} else if (ATTRCMP(wakemsk)) {
	141	return sprintf(buf, "%08lx\n", db1x_pm_wakemsk);
	142	}
	143
	144	return -ENOENT;
	145	}
	146
	147	static ssize_t db1x_pmattr_store(struct kobject *kobj,
	148	struct kobj_attribute *attr,
	149	const char *instr,
	150	size_t bytes)
	151	{
	152	unsigned long l;
	153	int tmp;
	154
	155	if (ATTRCMP(timer_timeout)) {
8ca635bf	156	tmp = kstrtoul(instr, 0, &l);
61f9c58d ML	157	if (tmp)
	158	return tmp;
	159
	160	db1x_pm_sleep_secs = l;
	161
	162	} else if (ATTRCMP(timer)) {
	163	if (instr[0] != '0')
	164	db1x_pm_wakemsk \|= SYS_WAKEMSK_M2;
	165	else
	166	db1x_pm_wakemsk &= ~SYS_WAKEMSK_M2;
	167
	168	} else if (ATTRCMP(gpio0) \|\| ATTRCMP(gpio1) \|\| ATTRCMP(gpio2) \|\|
	169	ATTRCMP(gpio3) \|\| ATTRCMP(gpio4) \|\| ATTRCMP(gpio5) \|\|
	170	ATTRCMP(gpio6) \|\| ATTRCMP(gpio7)) {
	171	tmp = (attr->attr.name)[4] - '0';
	172	if (instr[0] != '0') {
	173	db1x_pm_wakemsk \|= SYS_WAKEMSK_GPIO(tmp);
	174	} else {
	175	db1x_pm_wakemsk &= ~SYS_WAKEMSK_GPIO(tmp);
	176	}
	177
	178	} else if (ATTRCMP(wakemsk)) {
8ca635bf	179	tmp = kstrtoul(instr, 0, &l);
61f9c58d ML	180	if (tmp)
	181	return tmp;
	182
	183	db1x_pm_wakemsk = l & 0x0000003f;
	184
	185	} else
	186	bytes = -ENOENT;
	187
	188	return bytes;
	189	}
	190
	191	#define ATTR(x) \
70342287	192	static struct kobj_attribute x##_attribute = \
61f9c58d ML	193	__ATTR(x, 0664, db1x_pmattr_show, \
	194	db1x_pmattr_store);
	195
	196	ATTR(gpio0) /* GPIO-based wakeup enable */
	197	ATTR(gpio1)
	198	ATTR(gpio2)
	199	ATTR(gpio3)
	200	ATTR(gpio4)
	201	ATTR(gpio5)
	202	ATTR(gpio6)
	203	ATTR(gpio7)
	204	ATTR(timer) /* TOYMATCH2-based wakeup enable */
	205	ATTR(timer_timeout) /* timer-based wakeup timeout value, in seconds */
	206	ATTR(wakesrc) /* contents of SYS_WAKESRC after last wakeup */
	207	ATTR(wakemsk) /* direct access to SYS_WAKEMSK */
	208
	209	#define ATTR_LIST(x) & x ## _attribute.attr
	210	static struct attribute *db1x_pmattrs[] = {
	211	ATTR_LIST(gpio0),
	212	ATTR_LIST(gpio1),
	213	ATTR_LIST(gpio2),
	214	ATTR_LIST(gpio3),
	215	ATTR_LIST(gpio4),
	216	ATTR_LIST(gpio5),
	217	ATTR_LIST(gpio6),
	218	ATTR_LIST(gpio7),
	219	ATTR_LIST(timer),
	220	ATTR_LIST(timer_timeout),
	221	ATTR_LIST(wakesrc),
	222	ATTR_LIST(wakemsk),
	223	NULL, /* terminator */
	224	};
	225
	226	static struct attribute_group db1x_pmattr_group = {
	227	.name = "db1x",
	228	.attrs = db1x_pmattrs,
	229	};
	230
	231	/*
	232	* Initialize suspend interface
	233	*/
	234	static int __init pm_init(void)
	235	{
	236	/* init TOY to tick at 1Hz if not already done. No need to wait
	237	* for confirmation since there's plenty of time from here to
	238	* the next suspend cycle.
	239	*/
1d09de7d ML	240	if (alchemy_rdsys(AU1000_SYS_TOYTRIM) != 32767)
1d09de7d ML	241	alchemy_wrsys(32767, AU1000_SYS_TOYTRIM);
61f9c58d	242
1d09de7d	243	db1x_pm_last_wakesrc = alchemy_rdsys(AU1000_SYS_WAKESRC);
61f9c58d	244
1d09de7d ML	245	alchemy_wrsys(0, AU1000_SYS_WAKESRC);
1d09de7d ML	246	alchemy_wrsys(0, AU1000_SYS_WAKEMSK);
61f9c58d ML	247
	248	suspend_set_ops(&db1x_pm_ops);
	249
	250	return sysfs_create_group(power_kobj, &db1x_pmattr_group);
	251	}
	252
	253	late_initcall(pm_init);