2 * arch/powerpc/sysdev/qe_lib/qe_io.c
4 * QE Parallel I/O ports configuration routines
6 * Copyright 2006 Freescale Semiconductor, Inc. All rights reserved.
8 * Author: Li Yang <LeoLi@freescale.com>
9 * Based on code from Shlomi Gridish <gridish@freescale.com>
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by the
13 * Free Software Foundation; either version 2 of the License, or (at your
14 * option) any later version.
17 #include <linux/stddef.h>
18 #include <linux/kernel.h>
19 #include <linux/init.h>
20 #include <linux/errno.h>
21 #include <linux/module.h>
22 #include <linux/ioport.h>
27 #include <sysdev/fsl_soc.h>
31 static struct qe_pio_regs __iomem
*par_io
;
32 static int num_par_io_ports
= 0;
34 int par_io_init(struct device_node
*np
)
40 /* Map Parallel I/O ports registers */
41 ret
= of_address_to_resource(np
, 0, &res
);
44 par_io
= ioremap(res
.start
, resource_size(&res
));
46 num_ports
= of_get_property(np
, "num-ports", NULL
);
48 num_par_io_ports
= *num_ports
;
53 void __par_io_config_pin(struct qe_pio_regs __iomem
*par_io
, u8 pin
, int dir
,
54 int open_drain
, int assignment
, int has_irq
)
61 /* calculate pin location for single and 2 bits information */
62 pin_mask1bit
= (u32
) (1 << (QE_PIO_PINS
- (pin
+ 1)));
64 /* Set open drain, if required */
65 tmp_val
= in_be32(&par_io
->cpodr
);
67 out_be32(&par_io
->cpodr
, pin_mask1bit
| tmp_val
);
69 out_be32(&par_io
->cpodr
, ~pin_mask1bit
& tmp_val
);
71 /* define direction */
72 tmp_val
= (pin
> (QE_PIO_PINS
/ 2) - 1) ?
73 in_be32(&par_io
->cpdir2
) :
74 in_be32(&par_io
->cpdir1
);
76 /* get all bits mask for 2 bit per port */
77 pin_mask2bits
= (u32
) (0x3 << (QE_PIO_PINS
-
78 (pin
% (QE_PIO_PINS
/ 2) + 1) * 2));
80 /* Get the final mask we need for the right definition */
81 new_mask2bits
= (u32
) (dir
<< (QE_PIO_PINS
-
82 (pin
% (QE_PIO_PINS
/ 2) + 1) * 2));
84 /* clear and set 2 bits mask */
85 if (pin
> (QE_PIO_PINS
/ 2) - 1) {
86 out_be32(&par_io
->cpdir2
,
87 ~pin_mask2bits
& tmp_val
);
88 tmp_val
&= ~pin_mask2bits
;
89 out_be32(&par_io
->cpdir2
, new_mask2bits
| tmp_val
);
91 out_be32(&par_io
->cpdir1
,
92 ~pin_mask2bits
& tmp_val
);
93 tmp_val
&= ~pin_mask2bits
;
94 out_be32(&par_io
->cpdir1
, new_mask2bits
| tmp_val
);
96 /* define pin assignment */
97 tmp_val
= (pin
> (QE_PIO_PINS
/ 2) - 1) ?
98 in_be32(&par_io
->cppar2
) :
99 in_be32(&par_io
->cppar1
);
101 new_mask2bits
= (u32
) (assignment
<< (QE_PIO_PINS
-
102 (pin
% (QE_PIO_PINS
/ 2) + 1) * 2));
103 /* clear and set 2 bits mask */
104 if (pin
> (QE_PIO_PINS
/ 2) - 1) {
105 out_be32(&par_io
->cppar2
,
106 ~pin_mask2bits
& tmp_val
);
107 tmp_val
&= ~pin_mask2bits
;
108 out_be32(&par_io
->cppar2
, new_mask2bits
| tmp_val
);
110 out_be32(&par_io
->cppar1
,
111 ~pin_mask2bits
& tmp_val
);
112 tmp_val
&= ~pin_mask2bits
;
113 out_be32(&par_io
->cppar1
, new_mask2bits
| tmp_val
);
116 EXPORT_SYMBOL(__par_io_config_pin
);
118 int par_io_config_pin(u8 port
, u8 pin
, int dir
, int open_drain
,
119 int assignment
, int has_irq
)
121 if (!par_io
|| port
>= num_par_io_ports
)
124 __par_io_config_pin(&par_io
[port
], pin
, dir
, open_drain
, assignment
,
128 EXPORT_SYMBOL(par_io_config_pin
);
130 int par_io_data_set(u8 port
, u8 pin
, u8 val
)
132 u32 pin_mask
, tmp_val
;
134 if (port
>= num_par_io_ports
)
136 if (pin
>= QE_PIO_PINS
)
138 /* calculate pin location */
139 pin_mask
= (u32
) (1 << (QE_PIO_PINS
- 1 - pin
));
141 tmp_val
= in_be32(&par_io
[port
].cpdata
);
143 if (val
== 0) /* clear */
144 out_be32(&par_io
[port
].cpdata
, ~pin_mask
& tmp_val
);
146 out_be32(&par_io
[port
].cpdata
, pin_mask
| tmp_val
);
150 EXPORT_SYMBOL(par_io_data_set
);
152 int par_io_of_config(struct device_node
*np
)
154 struct device_node
*pio
;
157 const unsigned int *pio_map
;
159 if (par_io
== NULL
) {
160 printk(KERN_ERR
"par_io not initialized\n");
164 ph
= of_get_property(np
, "pio-handle", NULL
);
166 printk(KERN_ERR
"pio-handle not available\n");
170 pio
= of_find_node_by_phandle(*ph
);
172 pio_map
= of_get_property(pio
, "pio-map", &pio_map_len
);
173 if (pio_map
== NULL
) {
174 printk(KERN_ERR
"pio-map is not set!\n");
177 pio_map_len
/= sizeof(unsigned int);
178 if ((pio_map_len
% 6) != 0) {
179 printk(KERN_ERR
"pio-map format wrong!\n");
183 while (pio_map_len
> 0) {
184 par_io_config_pin((u8
) pio_map
[0], (u8
) pio_map
[1],
185 (int) pio_map
[2], (int) pio_map
[3],
186 (int) pio_map
[4], (int) pio_map
[5]);
193 EXPORT_SYMBOL(par_io_of_config
);
196 static void dump_par_io(void)
200 printk(KERN_INFO
"%s: par_io=%p\n", __func__
, par_io
);
201 for (i
= 0; i
< num_par_io_ports
; i
++) {
202 printk(KERN_INFO
" cpodr[%u]=%08x\n", i
,
203 in_be32(&par_io
[i
].cpodr
));
204 printk(KERN_INFO
" cpdata[%u]=%08x\n", i
,
205 in_be32(&par_io
[i
].cpdata
));
206 printk(KERN_INFO
" cpdir1[%u]=%08x\n", i
,
207 in_be32(&par_io
[i
].cpdir1
));
208 printk(KERN_INFO
" cpdir2[%u]=%08x\n", i
,
209 in_be32(&par_io
[i
].cpdir2
));
210 printk(KERN_INFO
" cppar1[%u]=%08x\n", i
,
211 in_be32(&par_io
[i
].cppar1
));
212 printk(KERN_INFO
" cppar2[%u]=%08x\n", i
,
213 in_be32(&par_io
[i
].cppar2
));
217 EXPORT_SYMBOL(dump_par_io
);