[net-next-2.6.git] / arch / sparc / kernel / pmc.c

/* pmc - Driver implementation for power management functions
 * of Power Management Controller (PMC) on SPARCstation-Voyager.
 *
 * Copyright (c) 2002 Eric Brower (ebrower@usa.net)
 */

#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/pm.h>
#include <linux/of.h>
#include <linux/of_device.h>

#include <asm/io.h>
#include <asm/oplib.h>
#include <asm/uaccess.h>
#include <asm/auxio.h>

/* Debug
 *
 * #define PMC_DEBUG_LED
 * #define PMC_NO_IDLE
 */

#define PMC_OBPNAME	"SUNW,pmc"
#define PMC_DEVNAME	"pmc"

#define PMC_IDLE_REG	0x00
#define PMC_IDLE_ON	0x01

static u8 __iomem *regs;

#define pmc_readb(offs)		(sbus_readb(regs+offs))
#define pmc_writeb(val, offs)	(sbus_writeb(val, regs+offs))

/*
 * CPU idle callback function
 * See .../arch/sparc/kernel/process.c
 */
static void pmc_swift_idle(void)
{
#ifdef PMC_DEBUG_LED
	set_auxio(0x00, AUXIO_LED);
#endif

	pmc_writeb(pmc_readb(PMC_IDLE_REG) | PMC_IDLE_ON, PMC_IDLE_REG);

#ifdef PMC_DEBUG_LED
	set_auxio(AUXIO_LED, 0x00);
#endif
}

static int __devinit pmc_probe(struct of_device *op,
			       const struct of_device_id *match)
{
	regs = of_ioremap(&op->resource[0], 0,
			  resource_size(&op->resource[0]), PMC_OBPNAME);
	if (!regs) {
		printk(KERN_ERR "%s: unable to map registers\n", PMC_DEVNAME);
		return -ENODEV;
	}

#ifndef PMC_NO_IDLE
	/* Assign power management IDLE handler */
	pm_idle = pmc_swift_idle;
#endif

	printk(KERN_INFO "%s: power management initialized\n", PMC_DEVNAME);
	return 0;
}

static struct of_device_id __initdata pmc_match[] = {
	{
		.name = PMC_OBPNAME,
	},
	{},
};
MODULE_DEVICE_TABLE(of, pmc_match);

static struct of_platform_driver pmc_driver = {
	.driver = {
		.name = "pmc",
		.owner = THIS_MODULE,
		.of_match_table = pmc_match,
	},
	.probe		= pmc_probe,
};

static int __init pmc_init(void)
{
	return of_register_platform_driver(&pmc_driver);
}

/* This driver is not critical to the boot process
 * and is easiest to ioremap when SBus is already
 * initialized, so we install ourselves thusly:
 */
__initcall(pmc_init);
Commit	Line	Data
1da177e4 LT	1	/* pmc - Driver implementation for power management functions
	2	* of Power Management Controller (PMC) on SPARCstation-Voyager.
	3	*
	4	* Copyright (c) 2002 Eric Brower (ebrower@usa.net)
	5	*/
	6
	7	#include <linux/kernel.h>
	8	#include <linux/fs.h>
	9	#include <linux/errno.h>
	10	#include <linux/init.h>
1da177e4	11	#include <linux/pm.h>
f1b6aa87 DM	12	#include <linux/of.h>
f1b6aa87 DM	13	#include <linux/of_device.h>
1da177e4 LT	14
1da177e4 LT	15	#include <asm/io.h>
1da177e4 LT	16	#include <asm/oplib.h>
	17	#include <asm/uaccess.h>
	18	#include <asm/auxio.h>
	19
	20	/* Debug
	21	*
	22	* #define PMC_DEBUG_LED
	23	* #define PMC_NO_IDLE
	24	*/
	25
1da177e4	26	#define PMC_OBPNAME "SUNW,pmc"
85bfbf44	27	#define PMC_DEVNAME "pmc"
1da177e4 LT	28
1da177e4 LT	29	#define PMC_IDLE_REG 0x00
85bfbf44	30	#define PMC_IDLE_ON 0x01
1da177e4	31
f1b6aa87	32	static u8 __iomem *regs;
1da177e4	33
f1b6aa87	34	#define pmc_readb(offs) (sbus_readb(regs+offs))
85bfbf44	35	#define pmc_writeb(val, offs) (sbus_writeb(val, regs+offs))
1da177e4	36
85bfbf44	37	/*
1da177e4 LT	38	* CPU idle callback function
	39	* See .../arch/sparc/kernel/process.c
	40	*/
39f6649b	41	static void pmc_swift_idle(void)
1da177e4 LT	42	{
1da177e4 LT	43	#ifdef PMC_DEBUG_LED
85bfbf44	44	set_auxio(0x00, AUXIO_LED);
1da177e4 LT	45	#endif
	46
	47	pmc_writeb(pmc_readb(PMC_IDLE_REG) \| PMC_IDLE_ON, PMC_IDLE_REG);
	48
	49	#ifdef PMC_DEBUG_LED
85bfbf44	50	set_auxio(AUXIO_LED, 0x00);
1da177e4	51	#endif
85bfbf44	52	}
1da177e4	53
f1b6aa87 DM	54	static int __devinit pmc_probe(struct of_device *op,
f1b6aa87 DM	55	const struct of_device_id *match)
1da177e4	56	{
f1b6aa87 DM	57	regs = of_ioremap(&op->resource[0], 0,
f1b6aa87 DM	58	resource_size(&op->resource[0]), PMC_OBPNAME);
1da177e4 LT	59	if (!regs) {
	60	printk(KERN_ERR "%s: unable to map registers\n", PMC_DEVNAME);
	61	return -ENODEV;
	62	}
	63
	64	#ifndef PMC_NO_IDLE
	65	/* Assign power management IDLE handler */
85bfbf44	66	pm_idle = pmc_swift_idle;
1da177e4 LT	67	#endif
	68
	69	printk(KERN_INFO "%s: power management initialized\n", PMC_DEVNAME);
	70	return 0;
	71	}
	72
fd098316	73	static struct of_device_id __initdata pmc_match[] = {
f1b6aa87 DM	74	{
	75	.name = PMC_OBPNAME,
	76	},
	77	{},
	78	};
	79	MODULE_DEVICE_TABLE(of, pmc_match);
	80
	81	static struct of_platform_driver pmc_driver = {
4018294b GL	82	.driver = {
	83	.name = "pmc",
	84	.owner = THIS_MODULE,
	85	.of_match_table = pmc_match,
	86	},
f1b6aa87 DM	87	.probe = pmc_probe,
	88	};
	89
	90	static int __init pmc_init(void)
	91	{
1ab1d63a	92	return of_register_platform_driver(&pmc_driver);
f1b6aa87 DM	93	}
f1b6aa87 DM	94
1da177e4 LT	95	/* This driver is not critical to the boot process
	96	* and is easiest to ioremap when SBus is already
	97	* initialized, so we install ourselves thusly:
	98	*/
f1b6aa87	99	__initcall(pmc_init);