48 lines
1.5 KiB
C
48 lines
1.5 KiB
C
|
/* Copyright (c) 2010-2011 The Linux Foundation. All rights reserved.
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License version 2 and
|
||
|
|
* only version 2 as published by the Free Software Foundation.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful,
|
||
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
* GNU General Public License for more details.
|
||
|
|
*/
|
||
|
|
#include <linux/bitops.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <mach/gpiomux.h>
|
||
|
|
#include <mach/proc_comm.h>
|
||
|
|
#include "gpio.h"
|
||
|
|
|
||
|
|
void __msm_gpiomux_write(unsigned gpio, struct gpiomux_setting val)
|
||
|
|
{
|
||
|
|
unsigned tlmm_config;
|
||
|
|
unsigned tlmm_disable = 0;
|
||
|
|
void __iomem *out_reg;
|
||
|
|
unsigned offset;
|
||
|
|
uint32_t bits;
|
||
|
|
int rc;
|
||
|
|
|
||
|
|
tlmm_config = (val.drv << 17) |
|
||
|
|
(val.pull << 15) |
|
||
|
|
((gpio & 0x3ff) << 4) |
|
||
|
|
val.func;
|
||
|
|
if (val.func == GPIOMUX_FUNC_GPIO) {
|
||
|
|
tlmm_config |= (val.dir > GPIOMUX_IN ? BIT(14) : 0);
|
||
|
|
msm_gpio_find_out(gpio, &out_reg, &offset);
|
||
|
|
bits = __raw_readl(out_reg);
|
||
|
|
if (val.dir == GPIOMUX_OUT_HIGH)
|
||
|
|
__raw_writel(bits | BIT(offset), out_reg);
|
||
|
|
else
|
||
|
|
__raw_writel(bits & ~BIT(offset), out_reg);
|
||
|
|
}
|
||
|
|
mb();
|
||
|
|
rc = msm_proc_comm(PCOM_RPC_GPIO_TLMM_CONFIG_EX,
|
||
|
|
&tlmm_config, &tlmm_disable);
|
||
|
|
if (rc)
|
||
|
|
pr_err("%s: unexpected proc_comm failure %d: %08x %08x\n",
|
||
|
|
__func__, rc, tlmm_config, tlmm_disable);
|
||
|
|
}
|