2 * Copyright (C) 2006 Freescale Semiconductor, Inc.
4 * Dave Liu <daveliu@freescale.com>
5 * based on source code of Shlomi Gridish
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24 #include "asm/errno.h"
26 #include "asm/immap_85xx.h"
28 #if defined(CONFIG_QE)
29 #define NUM_OF_PINS 32
30 void qe_config_iopin(u8 port
, u8 pin
, int dir
, int open_drain
, int assign
)
37 volatile ccsr_gur_t
*gur
= (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR
);
38 volatile par_io_t
*par_io
= (volatile par_io_t
*)
41 /* Caculate pin location and 2bit mask and dir */
42 pin_2bit_mask
= (u32
)(0x3 << (NUM_OF_PINS
-(pin
%(NUM_OF_PINS
/2)+1)*2));
43 pin_2bit_dir
= (u32
)(dir
<< (NUM_OF_PINS
-(pin
%(NUM_OF_PINS
/2)+1)*2));
45 /* Setup the direction */
46 tmp_val
= (pin
> (NUM_OF_PINS
/2) - 1) ? \
47 in_be32(&par_io
[port
].cpdir2
) :
48 in_be32(&par_io
[port
].cpdir1
);
50 if (pin
> (NUM_OF_PINS
/2) -1) {
51 out_be32(&par_io
[port
].cpdir2
, ~pin_2bit_mask
& tmp_val
);
52 out_be32(&par_io
[port
].cpdir2
, pin_2bit_dir
| tmp_val
);
54 out_be32(&par_io
[port
].cpdir1
, ~pin_2bit_mask
& tmp_val
);
55 out_be32(&par_io
[port
].cpdir1
, pin_2bit_dir
| tmp_val
);
58 /* Calculate pin location for 1bit mask */
59 pin_1bit_mask
= (u32
)(1 << (NUM_OF_PINS
- (pin
+1)));
61 /* Setup the open drain */
62 tmp_val
= in_be32(&par_io
[port
].cpodr
);
64 out_be32(&par_io
[port
].cpodr
, pin_1bit_mask
| tmp_val
);
66 out_be32(&par_io
[port
].cpodr
, ~pin_1bit_mask
& tmp_val
);
68 /* Setup the assignment */
69 tmp_val
= (pin
> (NUM_OF_PINS
/2) - 1) ?
70 in_be32(&par_io
[port
].cppar2
):
71 in_be32(&par_io
[port
].cppar1
);
72 pin_2bit_assign
= (u32
)(assign
73 << (NUM_OF_PINS
- (pin
%(NUM_OF_PINS
/2)+1)*2));
75 /* Clear and set 2 bits mask */
76 if (pin
> (NUM_OF_PINS
/2) - 1) {
77 out_be32(&par_io
[port
].cppar2
, ~pin_2bit_mask
& tmp_val
);
78 out_be32(&par_io
[port
].cppar2
, pin_2bit_assign
| tmp_val
);
80 out_be32(&par_io
[port
].cppar1
, ~pin_2bit_mask
& tmp_val
);
81 out_be32(&par_io
[port
].cppar1
, pin_2bit_assign
| tmp_val
);
85 #endif /* CONFIG_QE */