]>
git.ipfire.org Git - people/ms/u-boot.git/blob - cpu/mpc83xx/qe_io.c
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_83xx.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 immap_t
*im
= (volatile immap_t
*)CFG_IMMR
;
38 volatile gpio83xx_t
*par_io
=(volatile gpio83xx_t
*)&im
->gpio
;
40 /* Caculate pin location and 2bit mask and dir */
41 pin_2bit_mask
= (u32
)(0x3 << (NUM_OF_PINS
-(pin
%(NUM_OF_PINS
/2)+1)*2));
42 pin_2bit_dir
= (u32
)(dir
<< (NUM_OF_PINS
-(pin
%(NUM_OF_PINS
/2)+1)*2));
44 /* Setup the direction */
45 tmp_val
= (pin
> (NUM_OF_PINS
/2) - 1) ? \
46 in_be32(&par_io
->ioport
[port
].dir2
) :
47 in_be32(&par_io
->ioport
[port
].dir1
);
49 if (pin
> (NUM_OF_PINS
/2) -1) {
50 out_be32(&par_io
->ioport
[port
].dir2
, ~pin_2bit_mask
& tmp_val
);
51 out_be32(&par_io
->ioport
[port
].dir2
, pin_2bit_dir
| tmp_val
);
53 out_be32(&par_io
->ioport
[port
].dir1
, ~pin_2bit_mask
& tmp_val
);
54 out_be32(&par_io
->ioport
[port
].dir1
, pin_2bit_dir
| tmp_val
);
57 /* Calculate pin location for 1bit mask */
58 pin_1bit_mask
= (u32
)(1 << (NUM_OF_PINS
- (pin
+1)));
60 /* Setup the open drain */
61 tmp_val
= in_be32(&par_io
->ioport
[port
].podr
);
63 out_be32(&par_io
->ioport
[port
].podr
, pin_1bit_mask
| tmp_val
);
65 out_be32(&par_io
->ioport
[port
].podr
, ~pin_1bit_mask
& tmp_val
);
68 /* Setup the assignment */
69 tmp_val
= (pin
> (NUM_OF_PINS
/2) - 1) ?
70 in_be32(&par_io
->ioport
[port
].ppar2
):
71 in_be32(&par_io
->ioport
[port
].ppar1
);
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
->ioport
[port
].ppar2
, ~pin_2bit_mask
& tmp_val
);
78 out_be32(&par_io
->ioport
[port
].ppar2
, pin_2bit_assign
| tmp_val
);
80 out_be32(&par_io
->ioport
[port
].ppar1
, ~pin_2bit_mask
& tmp_val
);
81 out_be32(&par_io
->ioport
[port
].ppar1
, pin_2bit_assign
| tmp_val
);
85 #endif /* CONFIG_QE */