Commit | Line | Data |
---|---|---|
5e1c5ff4 TL |
1 | /* |
2 | * linux/arch/arm/plat-omap/mux.c | |
3 | * | |
4 | * Utility to set the Omap MUX and PULL_DWN registers from a table in mux.h | |
5 | * | |
9330899e | 6 | * Copyright (C) 2003 - 2008 Nokia Corporation |
5e1c5ff4 | 7 | * |
9330899e | 8 | * Written by Tony Lindgren |
5e1c5ff4 TL |
9 | * |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
23 | * | |
24 | */ | |
5e1c5ff4 TL |
25 | #include <linux/module.h> |
26 | #include <linux/init.h> | |
1a8bfa1e | 27 | #include <linux/kernel.h> |
fced80c7 | 28 | #include <linux/io.h> |
5e1c5ff4 | 29 | #include <asm/system.h> |
5e1c5ff4 | 30 | #include <linux/spinlock.h> |
ce491cf8 | 31 | #include <plat/mux.h> |
5e1c5ff4 TL |
32 | |
33 | #ifdef CONFIG_OMAP_MUX | |
34 | ||
7d7f665d | 35 | static struct omap_mux_cfg *mux_cfg; |
1a8bfa1e | 36 | |
7d7f665d | 37 | int __init omap_mux_register(struct omap_mux_cfg *arch_mux_cfg) |
1a8bfa1e | 38 | { |
7d7f665d TL |
39 | if (!arch_mux_cfg || !arch_mux_cfg->pins || arch_mux_cfg->size == 0 |
40 | || !arch_mux_cfg->cfg_reg) { | |
41 | printk(KERN_ERR "Invalid pin table\n"); | |
42 | return -EINVAL; | |
43 | } | |
44 | ||
45 | mux_cfg = arch_mux_cfg; | |
1a8bfa1e TL |
46 | |
47 | return 0; | |
48 | } | |
49 | ||
5e1c5ff4 TL |
50 | /* |
51 | * Sets the Omap MUX and PULL_DWN registers based on the table | |
52 | */ | |
1a8bfa1e | 53 | int __init_or_module omap_cfg_reg(const unsigned long index) |
5e1c5ff4 | 54 | { |
225dfda1 | 55 | struct pin_config *reg; |
5e1c5ff4 | 56 | |
c9d8230e | 57 | if (!cpu_class_is_omap1()) { |
15ac7afe TL |
58 | printk(KERN_ERR "mux: Broken omap_cfg_reg(%lu) entry\n", |
59 | index); | |
60 | WARN_ON(1); | |
61 | return -EINVAL; | |
62 | } | |
44169075 | 63 | |
7d7f665d TL |
64 | if (mux_cfg == NULL) { |
65 | printk(KERN_ERR "Pin mux table not initialized\n"); | |
66 | return -ENODEV; | |
67 | } | |
92105bb7 | 68 | |
7d7f665d | 69 | if (index >= mux_cfg->size) { |
1a8bfa1e | 70 | printk(KERN_ERR "Invalid pin mux index: %lu (%lu)\n", |
7d7f665d | 71 | index, mux_cfg->size); |
1a8bfa1e TL |
72 | dump_stack(); |
73 | return -ENODEV; | |
5e1c5ff4 TL |
74 | } |
75 | ||
225dfda1 | 76 | reg = (struct pin_config *)&mux_cfg->pins[index]; |
5e1c5ff4 | 77 | |
225dfda1 TL |
78 | if (!mux_cfg->cfg_reg) |
79 | return -ENODEV; | |
5e1c5ff4 | 80 | |
225dfda1 | 81 | return mux_cfg->cfg_reg(reg); |
5e1c5ff4 | 82 | } |
5e1c5ff4 | 83 | EXPORT_SYMBOL(omap_cfg_reg); |
1a8bfa1e TL |
84 | #else |
85 | #define omap_mux_init() do {} while(0) | |
86 | #define omap_cfg_reg(x) do {} while(0) | |
5e1c5ff4 | 87 | #endif /* CONFIG_OMAP_MUX */ |