2 * linux/arch/arm/plat-pxa/mfp.c
4 * Multi-Function Pin Support
6 * Copyright (C) 2007 Marvell Internation Ltd.
8 * 2007-08-21: eric miao <eric.miao@marvell.com>
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/module.h>
17 #include <linux/kernel.h>
18 #include <linux/init.h>
20 #include <linux/sysdev.h>
24 #define MFPR_SIZE (PAGE_SIZE)
26 /* MFPR register bit definitions */
27 #define MFPR_PULL_SEL (0x1 << 15)
28 #define MFPR_PULLUP_EN (0x1 << 14)
29 #define MFPR_PULLDOWN_EN (0x1 << 13)
30 #define MFPR_SLEEP_SEL (0x1 << 9)
31 #define MFPR_SLEEP_OE_N (0x1 << 7)
32 #define MFPR_EDGE_CLEAR (0x1 << 6)
33 #define MFPR_EDGE_FALL_EN (0x1 << 5)
34 #define MFPR_EDGE_RISE_EN (0x1 << 4)
36 #define MFPR_SLEEP_DATA(x) ((x) << 8)
37 #define MFPR_DRIVE(x) (((x) & 0x7) << 10)
38 #define MFPR_AF_SEL(x) (((x) & 0x7) << 0)
40 #define MFPR_EDGE_NONE (0)
41 #define MFPR_EDGE_RISE (MFPR_EDGE_RISE_EN)
42 #define MFPR_EDGE_FALL (MFPR_EDGE_FALL_EN)
43 #define MFPR_EDGE_BOTH (MFPR_EDGE_RISE | MFPR_EDGE_FALL)
46 * Table that determines the low power modes outputs, with actual settings
47 * used in parentheses for don't-care values. Except for the float output,
48 * the configured driven and pulled levels match, so if there is a need for
49 * non-LPM pulled output, the same configuration could probably be used.
51 * Output value sleep_oe_n sleep_data pullup_en pulldown_en pull_sel
52 * (bit 7) (bit 8) (bit 14) (bit 13) (bit 15)
54 * Input 0 X(0) X(0) X(0) 0
55 * Drive 0 0 0 0 X(1) 0
56 * Drive 1 0 1 X(1) 0 0
57 * Pull hi (1) 1 X(1) 1 0 0
58 * Pull lo (0) 1 X(0) 0 1 0
59 * Z (float) 1 X(0) 0 0 0
61 #define MFPR_LPM_INPUT (0)
62 #define MFPR_LPM_DRIVE_LOW (MFPR_SLEEP_DATA(0) | MFPR_PULLDOWN_EN)
63 #define MFPR_LPM_DRIVE_HIGH (MFPR_SLEEP_DATA(1) | MFPR_PULLUP_EN)
64 #define MFPR_LPM_PULL_LOW (MFPR_LPM_DRIVE_LOW | MFPR_SLEEP_OE_N)
65 #define MFPR_LPM_PULL_HIGH (MFPR_LPM_DRIVE_HIGH | MFPR_SLEEP_OE_N)
66 #define MFPR_LPM_FLOAT (MFPR_SLEEP_OE_N)
67 #define MFPR_LPM_MASK (0xe080)
70 * The pullup and pulldown state of the MFP pin at run mode is by default
71 * determined by the selected alternate function. In case that some buggy
72 * devices need to override this default behavior, the definitions below
73 * indicates the setting of corresponding MFPR bits
75 * Definition pull_sel pullup_en pulldown_en
76 * MFPR_PULL_NONE 0 0 0
78 * MFPR_PULL_HIGH 1 1 0
79 * MFPR_PULL_BOTH 1 1 1
80 * MFPR_PULL_FLOAT 1 0 0
82 #define MFPR_PULL_NONE (0)
83 #define MFPR_PULL_LOW (MFPR_PULL_SEL | MFPR_PULLDOWN_EN)
84 #define MFPR_PULL_BOTH (MFPR_PULL_LOW | MFPR_PULLUP_EN)
85 #define MFPR_PULL_HIGH (MFPR_PULL_SEL | MFPR_PULLUP_EN)
86 #define MFPR_PULL_FLOAT (MFPR_PULL_SEL)
88 /* mfp_spin_lock is used to ensure that MFP register configuration
89 * (most likely a read-modify-write operation) is atomic, and that
90 * mfp_table[] is consistent
92 static DEFINE_SPINLOCK(mfp_spin_lock
);
94 static void __iomem
*mfpr_mmio_base
;
97 unsigned long config
; /* -1 for not configured */
98 unsigned long mfpr_off
; /* MFPRxx Register offset */
99 unsigned long mfpr_run
; /* Run-Mode Register Value */
100 unsigned long mfpr_lpm
; /* Low Power Mode Register Value */
103 static struct mfp_pin mfp_table
[MFP_PIN_MAX
];
105 /* mapping of MFP_LPM_* definitions to MFPR_LPM_* register bits */
106 static const unsigned long mfpr_lpm
[] = {
116 /* mapping of MFP_PULL_* definitions to MFPR_PULL_* register bits */
117 static const unsigned long mfpr_pull
[] = {
125 /* mapping of MFP_LPM_EDGE_* definitions to MFPR_EDGE_* register bits */
126 static const unsigned long mfpr_edge
[] = {
133 #define mfpr_readl(off) \
134 __raw_readl(mfpr_mmio_base + (off))
136 #define mfpr_writel(off, val) \
137 __raw_writel(val, mfpr_mmio_base + (off))
139 #define mfp_configured(p) ((p)->config != -1)
142 * perform a read-back of any valid MFPR register to make sure the
143 * previous writings are finished
145 static unsigned long mfpr_off_readback
;
146 #define mfpr_sync() (void)__raw_readl(mfpr_mmio_base + mfpr_off_readback)
148 static inline void __mfp_config_run(struct mfp_pin
*p
)
150 if (mfp_configured(p
))
151 mfpr_writel(p
->mfpr_off
, p
->mfpr_run
);
154 static inline void __mfp_config_lpm(struct mfp_pin
*p
)
156 if (mfp_configured(p
)) {
157 unsigned long mfpr_clr
= (p
->mfpr_run
& ~MFPR_EDGE_BOTH
) | MFPR_EDGE_CLEAR
;
158 if (mfpr_clr
!= p
->mfpr_run
)
159 mfpr_writel(p
->mfpr_off
, mfpr_clr
);
160 if (p
->mfpr_lpm
!= mfpr_clr
)
161 mfpr_writel(p
->mfpr_off
, p
->mfpr_lpm
);
165 void mfp_config(unsigned long *mfp_cfgs
, int num
)
170 spin_lock_irqsave(&mfp_spin_lock
, flags
);
172 for (i
= 0; i
< num
; i
++, mfp_cfgs
++) {
173 unsigned long tmp
, c
= *mfp_cfgs
;
175 int pin
, af
, drv
, lpm
, edge
, pull
;
178 BUG_ON(pin
>= MFP_PIN_MAX
);
183 lpm
= MFP_LPM_STATE(c
);
184 edge
= MFP_LPM_EDGE(c
);
187 /* run-mode pull settings will conflict with MFPR bits of
188 * low power mode state, calculate mfpr_run and mfpr_lpm
189 * individually if pull != MFP_PULL_NONE
191 tmp
= MFPR_AF_SEL(af
) | MFPR_DRIVE(drv
);
193 if (likely(pull
== MFP_PULL_NONE
)) {
194 p
->mfpr_run
= tmp
| mfpr_lpm
[lpm
] | mfpr_edge
[edge
];
195 p
->mfpr_lpm
= p
->mfpr_run
;
197 p
->mfpr_lpm
= tmp
| mfpr_lpm
[lpm
] | mfpr_edge
[edge
];
198 p
->mfpr_run
= tmp
| mfpr_pull
[pull
];
201 p
->config
= c
; __mfp_config_run(p
);
205 spin_unlock_irqrestore(&mfp_spin_lock
, flags
);
208 unsigned long mfp_read(int mfp
)
210 unsigned long val
, flags
;
212 BUG_ON(mfp
< 0 || mfp
>= MFP_PIN_MAX
);
214 spin_lock_irqsave(&mfp_spin_lock
, flags
);
215 val
= mfpr_readl(mfp_table
[mfp
].mfpr_off
);
216 spin_unlock_irqrestore(&mfp_spin_lock
, flags
);
221 void mfp_write(int mfp
, unsigned long val
)
225 BUG_ON(mfp
< 0 || mfp
>= MFP_PIN_MAX
);
227 spin_lock_irqsave(&mfp_spin_lock
, flags
);
228 mfpr_writel(mfp_table
[mfp
].mfpr_off
, val
);
230 spin_unlock_irqrestore(&mfp_spin_lock
, flags
);
233 void __init
mfp_init_base(unsigned long mfpr_base
)
237 /* initialize the table with default - unconfigured */
238 for (i
= 0; i
< ARRAY_SIZE(mfp_table
); i
++)
239 mfp_table
[i
].config
= -1;
241 mfpr_mmio_base
= (void __iomem
*)mfpr_base
;
244 void __init
mfp_init_addr(struct mfp_addr_map
*map
)
246 struct mfp_addr_map
*p
;
247 unsigned long offset
, flags
;
250 spin_lock_irqsave(&mfp_spin_lock
, flags
);
252 /* mfp offset for readback */
253 mfpr_off_readback
= map
[0].offset
;
255 for (p
= map
; p
->start
!= MFP_PIN_INVALID
; p
++) {
260 mfp_table
[i
].mfpr_off
= offset
;
261 mfp_table
[i
].mfpr_run
= 0;
262 mfp_table
[i
].mfpr_lpm
= 0;
264 } while ((i
<= p
->end
) && (p
->end
!= -1));
267 spin_unlock_irqrestore(&mfp_spin_lock
, flags
);
270 void mfp_config_lpm(void)
272 struct mfp_pin
*p
= &mfp_table
[0];
275 for (pin
= 0; pin
< ARRAY_SIZE(mfp_table
); pin
++, p
++)
279 void mfp_config_run(void)
281 struct mfp_pin
*p
= &mfp_table
[0];
284 for (pin
= 0; pin
< ARRAY_SIZE(mfp_table
); pin
++, p
++)