| Alessandro Rubini | 60cbfbf | 2009-07-24 11:27:03 +0200 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2009 Alessandro Rubini |
| 3 | * |
| 4 | * See file CREDITS for list of people who contributed to this |
| 5 | * project. |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU General Public License as |
| 9 | * published by the Free Software Foundation; either version 2 of |
| 10 | * the License, or (at your option) any later version. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with this program; if not, write to the Free Software |
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 20 | * MA 02111-1307 USA |
| 21 | */ |
| 22 | |
| 23 | #include <common.h> |
| 24 | #include <asm/io.h> |
| 25 | #include <asm/arch/gpio.h> |
| 26 | |
| 27 | static unsigned long gpio_base[4] = { |
| 28 | NOMADIK_GPIO0_BASE, |
| 29 | NOMADIK_GPIO1_BASE, |
| 30 | NOMADIK_GPIO2_BASE, |
| 31 | NOMADIK_GPIO3_BASE |
| 32 | }; |
| 33 | |
| 34 | enum gpio_registers { |
| 35 | GPIO_DAT = 0x00, /* data register */ |
| 36 | GPIO_DATS = 0x04, /* data set */ |
| 37 | GPIO_DATC = 0x08, /* data clear */ |
| 38 | GPIO_PDIS = 0x0c, /* pull disable */ |
| 39 | GPIO_DIR = 0x10, /* direction */ |
| 40 | GPIO_DIRS = 0x14, /* direction set */ |
| 41 | GPIO_DIRC = 0x18, /* direction clear */ |
| 42 | GPIO_AFSLA = 0x20, /* alternate function select A */ |
| 43 | GPIO_AFSLB = 0x24, /* alternate function select B */ |
| 44 | }; |
| 45 | |
| 46 | static inline unsigned long gpio_to_base(int gpio) |
| 47 | { |
| 48 | return gpio_base[gpio / 32]; |
| 49 | } |
| 50 | |
| 51 | static inline u32 gpio_to_bit(int gpio) |
| 52 | { |
| 53 | return 1 << (gpio & 0x1f); |
| 54 | } |
| 55 | |
| 56 | void nmk_gpio_af(int gpio, int alternate_function) |
| 57 | { |
| 58 | unsigned long base = gpio_to_base(gpio); |
| 59 | u32 bit = gpio_to_bit(gpio); |
| 60 | u32 afunc, bfunc; |
| 61 | |
| 62 | /* alternate function is 0..3, with one bit per register */ |
| 63 | afunc = readl(base + GPIO_AFSLA) & ~bit; |
| 64 | bfunc = readl(base + GPIO_AFSLB) & ~bit; |
| 65 | if (alternate_function & 1) afunc |= bit; |
| 66 | if (alternate_function & 2) bfunc |= bit; |
| 67 | writel(afunc, base + GPIO_AFSLA); |
| 68 | writel(bfunc, base + GPIO_AFSLB); |
| 69 | } |
| 70 | |
| 71 | void nmk_gpio_dir(int gpio, int dir) |
| 72 | { |
| 73 | unsigned long base = gpio_to_base(gpio); |
| 74 | u32 bit = gpio_to_bit(gpio); |
| 75 | |
| 76 | if (dir) |
| 77 | writel(bit, base + GPIO_DIRS); |
| 78 | else |
| 79 | writel(bit, base + GPIO_DIRC); |
| 80 | } |
| 81 | |
| 82 | void nmk_gpio_set(int gpio, int val) |
| 83 | { |
| 84 | unsigned long base = gpio_to_base(gpio); |
| 85 | u32 bit = gpio_to_bit(gpio); |
| 86 | |
| 87 | if (val) |
| 88 | writel(bit, base + GPIO_DATS); |
| 89 | else |
| 90 | writel(bit, base + GPIO_DATC); |
| 91 | } |
| 92 | |
| 93 | int nmk_gpio_get(int gpio) |
| 94 | { |
| 95 | unsigned long base = gpio_to_base(gpio); |
| 96 | u32 bit = gpio_to_bit(gpio); |
| 97 | |
| 98 | return readl(base + GPIO_DAT) & bit; |
| 99 | } |