forked from Minki/linux
[ARM] 5551/1: Add multi-function pin api for w90p910 platform.
Add multi-function pin api for w90p910 platform. Signed-off-by: Wan ZongShun <mcuos.com@gmail.com> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
This commit is contained in:
parent
e1baa011a7
commit
27eb97582d
@ -4,7 +4,7 @@
|
||||
|
||||
# Object file lists.
|
||||
|
||||
obj-y := irq.o time.o
|
||||
obj-y := irq.o time.o mfp-w90p910.o
|
||||
|
||||
# W90X900 CPU support files
|
||||
|
||||
|
116
arch/arm/mach-w90x900/mfp-w90p910.c
Normal file
116
arch/arm/mach-w90x900/mfp-w90p910.c
Normal file
@ -0,0 +1,116 @@
|
||||
/*
|
||||
* linux/arch/arm/mach-w90x900/mfp-w90p910.c
|
||||
*
|
||||
* Copyright (c) 2008 Nuvoton technology corporation
|
||||
*
|
||||
* Wan ZongShun <mcuos.com@gmail.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation;version 2 of the License.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/io.h>
|
||||
|
||||
#include <mach/hardware.h>
|
||||
|
||||
#define REG_MFSEL (W90X900_VA_GCR + 0xC)
|
||||
|
||||
#define GPSELF (0x01 << 1)
|
||||
|
||||
#define GPSELC (0x03 << 2)
|
||||
#define ENKPI (0x02 << 2)
|
||||
#define ENNAND (0x01 << 2)
|
||||
|
||||
#define GPSELEI0 (0x01 << 26)
|
||||
#define GPSELEI1 (0x01 << 27)
|
||||
|
||||
static DECLARE_MUTEX(mfp_sem);
|
||||
|
||||
void mfp_set_groupf(struct device *dev)
|
||||
{
|
||||
unsigned long mfpen;
|
||||
const char *dev_id;
|
||||
|
||||
BUG_ON(!dev);
|
||||
|
||||
down(&mfp_sem);
|
||||
|
||||
dev_id = dev_name(dev);
|
||||
|
||||
mfpen = __raw_readl(REG_MFSEL);
|
||||
|
||||
if (strcmp(dev_id, "w90p910-emc") == 0)
|
||||
mfpen |= GPSELF;/*enable mac*/
|
||||
else
|
||||
mfpen &= ~GPSELF;/*GPIOF[9:0]*/
|
||||
|
||||
__raw_writel(mfpen, REG_MFSEL);
|
||||
|
||||
up(&mfp_sem);
|
||||
}
|
||||
EXPORT_SYMBOL(mfp_set_groupf);
|
||||
|
||||
void mfp_set_groupc(struct device *dev)
|
||||
{
|
||||
unsigned long mfpen;
|
||||
const char *dev_id;
|
||||
|
||||
BUG_ON(!dev);
|
||||
|
||||
down(&mfp_sem);
|
||||
|
||||
dev_id = dev_name(dev);
|
||||
|
||||
mfpen = __raw_readl(REG_MFSEL);
|
||||
|
||||
if (strcmp(dev_id, "w90p910-lcd") == 0)
|
||||
mfpen |= GPSELC;/*enable lcd*/
|
||||
else if (strcmp(dev_id, "w90p910-kpi") == 0) {
|
||||
mfpen &= (~GPSELC);/*enable kpi*/
|
||||
mfpen |= ENKPI;
|
||||
} else if (strcmp(dev_id, "w90p910-nand") == 0) {
|
||||
mfpen &= (~GPSELC);/*enable nand*/
|
||||
mfpen |= ENNAND;
|
||||
} else
|
||||
mfpen &= (~GPSELC);/*GPIOC[14:0]*/
|
||||
|
||||
__raw_writel(mfpen, REG_MFSEL);
|
||||
|
||||
up(&mfp_sem);
|
||||
}
|
||||
EXPORT_SYMBOL(mfp_set_groupc);
|
||||
|
||||
void mfp_set_groupi(struct device *dev, int gpio)
|
||||
{
|
||||
unsigned long mfpen;
|
||||
const char *dev_id;
|
||||
|
||||
BUG_ON(!dev);
|
||||
|
||||
down(&mfp_sem);
|
||||
|
||||
dev_id = dev_name(dev);
|
||||
|
||||
mfpen = __raw_readl(REG_MFSEL);
|
||||
|
||||
if (strcmp(dev_id, "w90p910-wdog") == 0)
|
||||
mfpen |= GPSELEI1;/*enable wdog*/
|
||||
else if (strcmp(dev_id, "w90p910-atapi") == 0)
|
||||
mfpen |= GPSELEI0;/*enable atapi*/
|
||||
|
||||
__raw_writel(mfpen, REG_MFSEL);
|
||||
|
||||
up(&mfp_sem);
|
||||
}
|
||||
EXPORT_SYMBOL(mfp_set_groupi);
|
||||
|
Loading…
Reference in New Issue
Block a user