2 * arch/arm/mach-kirkwood/mpp.c
4 * MPP functions for Marvell Kirkwood SoCs
6 * This file is licensed under the terms of the GNU General Public
7 * License version 2. This program is licensed "as is" without any
8 * warranty of any kind, whether express or implied.
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/mbus.h>
16 #include <mach/hardware.h>
20 static unsigned int __init
kirkwood_variant(void)
24 kirkwood_pcie_id(&dev
, &rev
);
26 if (dev
== MV88F6281_DEV_ID
&& rev
>= MV88F6281_REV_A0
)
27 return MPP_F6281_MASK
;
28 if (dev
== MV88F6192_DEV_ID
&& rev
>= MV88F6192_REV_A0
)
29 return MPP_F6192_MASK
;
30 if (dev
== MV88F6180_DEV_ID
)
31 return MPP_F6180_MASK
;
33 printk(KERN_ERR
"MPP setup: unknown kirkwood variant "
34 "(dev %#x rev %#x)\n", dev
, rev
);
38 #define MPP_CTRL(i) (DEV_BUS_VIRT_BASE + (i) * 4)
39 #define MPP_NR_REGS (1 + MPP_MAX/8)
41 void __init
kirkwood_mpp_conf(unsigned int *mpp_list
)
43 u32 mpp_ctrl
[MPP_NR_REGS
];
44 unsigned int variant_mask
;
47 variant_mask
= kirkwood_variant();
51 /* Initialize gpiolib. */
54 printk(KERN_DEBUG
"initial MPP regs:");
55 for (i
= 0; i
< MPP_NR_REGS
; i
++) {
56 mpp_ctrl
[i
] = readl(MPP_CTRL(i
));
57 printk(" %08x", mpp_ctrl
[i
]);
62 unsigned int num
= MPP_NUM(*mpp_list
);
63 unsigned int sel
= MPP_SEL(*mpp_list
);
67 printk(KERN_ERR
"kirkwood_mpp_conf: invalid MPP "
68 "number (%u)\n", num
);
71 if (!(*mpp_list
& variant_mask
)) {
73 "kirkwood_mpp_conf: requested MPP%u config "
74 "unavailable on this hardware\n", num
);
78 shift
= (num
& 7) << 2;
79 mpp_ctrl
[num
/ 8] &= ~(0xf << shift
);
80 mpp_ctrl
[num
/ 8] |= sel
<< shift
;
83 if (*mpp_list
& MPP_INPUT_MASK
)
84 gpio_mode
|= GPIO_INPUT_OK
;
85 if (*mpp_list
& MPP_OUTPUT_MASK
)
86 gpio_mode
|= GPIO_OUTPUT_OK
;
89 orion_gpio_set_valid(num
, gpio_mode
);
94 printk(KERN_DEBUG
" final MPP regs:");
95 for (i
= 0; i
< MPP_NR_REGS
; i
++) {
96 writel(mpp_ctrl
[i
], MPP_CTRL(i
));
97 printk(" %08x", mpp_ctrl
[i
]);