| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 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 |  * | 
| Tony Lindgren | 9330899 | 2008-01-24 17:24:15 -0800 | [diff] [blame] | 6 |  * Copyright (C) 2003 - 2008 Nokia Corporation | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 7 |  * | 
| Tony Lindgren | 9330899 | 2008-01-24 17:24:15 -0800 | [diff] [blame] | 8 |  * Written by Tony Lindgren | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 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 |  */ | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 25 | #include <linux/module.h> | 
 | 26 | #include <linux/init.h> | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 27 | #include <linux/kernel.h> | 
| Russell King | fced80c | 2008-09-06 12:10:45 +0100 | [diff] [blame] | 28 | #include <linux/io.h> | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 29 | #include <asm/system.h> | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 30 | #include <linux/spinlock.h> | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 31 | #include <mach/mux.h> | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 32 |  | 
 | 33 | #ifdef CONFIG_OMAP_MUX | 
 | 34 |  | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 35 | static struct omap_mux_cfg *mux_cfg; | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 36 |  | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 37 | int __init omap_mux_register(struct omap_mux_cfg *arch_mux_cfg) | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 38 | { | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 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; | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 46 |  | 
 | 47 | 	return 0; | 
 | 48 | } | 
 | 49 |  | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 50 | /* | 
 | 51 |  * Sets the Omap MUX and PULL_DWN registers based on the table | 
 | 52 |  */ | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 53 | int __init_or_module omap_cfg_reg(const unsigned long index) | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 54 | { | 
| Tony Lindgren | 225dfda | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 55 | 	struct pin_config *reg; | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 56 |  | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 57 | 	if (mux_cfg == NULL) { | 
 | 58 | 		printk(KERN_ERR "Pin mux table not initialized\n"); | 
 | 59 | 		return -ENODEV; | 
 | 60 | 	} | 
| Tony Lindgren | 92105bb | 2005-09-07 17:20:26 +0100 | [diff] [blame] | 61 |  | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 62 | 	if (index >= mux_cfg->size) { | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 63 | 		printk(KERN_ERR "Invalid pin mux index: %lu (%lu)\n", | 
| Tony Lindgren | 7d7f665 | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 64 | 		       index, mux_cfg->size); | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 65 | 		dump_stack(); | 
 | 66 | 		return -ENODEV; | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 67 | 	} | 
 | 68 |  | 
| Tony Lindgren | 225dfda | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 69 | 	reg = (struct pin_config *)&mux_cfg->pins[index]; | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 70 |  | 
| Tony Lindgren | 225dfda | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 71 | 	if (!mux_cfg->cfg_reg) | 
 | 72 | 		return -ENODEV; | 
| Kyungmin Park | 7bbb3cc | 2006-12-06 17:13:54 -0800 | [diff] [blame] | 73 |  | 
| Tony Lindgren | 225dfda | 2008-01-25 00:42:48 -0800 | [diff] [blame] | 74 | 	return mux_cfg->cfg_reg(reg); | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 75 | } | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 76 | EXPORT_SYMBOL(omap_cfg_reg); | 
| Tony Lindgren | 1a8bfa1 | 2005-11-10 14:26:50 +0000 | [diff] [blame] | 77 | #else | 
 | 78 | #define omap_mux_init() do {} while(0) | 
 | 79 | #define omap_cfg_reg(x)	do {} while(0) | 
| Tony Lindgren | 5e1c5ff | 2005-07-10 19:58:15 +0100 | [diff] [blame] | 80 | #endif	/* CONFIG_OMAP_MUX */ |