linux-vybrid_public/arch/arm/mach-omap2/control.c

/*
 * OMAP2/3 System Control Module register access
 *
 * Copyright (C) 2007 Texas Instruments, Inc.
 * Copyright (C) 2007 Nokia Corporation
 *
 * Written by Paul Walmsley
 *
 * 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.
 */
#undef DEBUG

#include <linux/kernel.h>

#include <asm/io.h>

#include <asm/arch/control.h>

static u32 omap2_ctrl_base;

#define OMAP_CTRL_REGADDR(reg)	(void __iomem *)IO_ADDRESS(omap2_ctrl_base \
								+ (reg))

void omap_ctrl_base_set(u32 base)
{
	omap2_ctrl_base = base;
}

u32 omap_ctrl_base_get(void)
{
	return omap2_ctrl_base;
}

u8 omap_ctrl_readb(u16 offset)
{
	return __raw_readb(OMAP_CTRL_REGADDR(offset));
}

u16 omap_ctrl_readw(u16 offset)
{
	return __raw_readw(OMAP_CTRL_REGADDR(offset));
}

u32 omap_ctrl_readl(u16 offset)
{
	return __raw_readl(OMAP_CTRL_REGADDR(offset));
}

void omap_ctrl_writeb(u8 val, u16 offset)
{
	pr_debug("omap_ctrl_writeb: writing 0x%0x to 0x%0x\n", val,
		 (u32)OMAP_CTRL_REGADDR(offset));

	__raw_writeb(val, OMAP_CTRL_REGADDR(offset));
}

void omap_ctrl_writew(u16 val, u16 offset)
{
	pr_debug("omap_ctrl_writew: writing 0x%0x to 0x%0x\n", val,
		 (u32)OMAP_CTRL_REGADDR(offset));

	__raw_writew(val, OMAP_CTRL_REGADDR(offset));
}

void omap_ctrl_writel(u32 val, u16 offset)
{
	pr_debug("omap_ctrl_writel: writing 0x%0x to 0x%0x\n", val,
		 (u32)OMAP_CTRL_REGADDR(offset));

	__raw_writel(val, OMAP_CTRL_REGADDR(offset));
}