| /* 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/io.h> |
| #include <mach/msm_iomap.h> |
| #include <mach/gpiomux.h> |
| |
| #define GPIO_CFG(n) (MSM_TLMM_BASE + 0x1000 + (0x10 * n)) |
| #define GPIO_IN_OUT(n) (MSM_TLMM_BASE + 0x1004 + (0x10 * n)) |
| |
| void __msm_gpiomux_write(unsigned gpio, struct gpiomux_setting val) |
| { |
| uint32_t bits; |
| |
| bits = (val.drv << 6) | (val.func << 2) | val.pull; |
| if (val.func == GPIOMUX_FUNC_GPIO) { |
| bits |= val.dir > GPIOMUX_IN ? BIT(9) : 0; |
| __raw_writel(val.dir == GPIOMUX_OUT_HIGH ? BIT(1) : 0, |
| GPIO_IN_OUT(gpio)); |
| } |
| __raw_writel(bits, GPIO_CFG(gpio)); |
| mb(); |
| } |