mirror of
https://github.com/smaeul/u-boot.git
synced 2025-11-09 08:20:17 +00:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commit c8ffd1356d42223cbb8c86280a083cc3c93e6426, reversing changes made to 2ee6f3a5f7550de3599faef9704e166e5dcace35. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
72 lines
2.1 KiB
C
72 lines
2.1 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2006 Freescale Semiconductor, Inc.
|
|
*
|
|
* Dave Liu <daveliu@freescale.com>
|
|
* based on source code of Shlomi Gridish
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <linux/errno.h>
|
|
#include <asm/io.h>
|
|
#include <asm/immap_85xx.h>
|
|
|
|
#if defined(CONFIG_QE) && !defined(CONFIG_U_QE)
|
|
#define NUM_OF_PINS 32
|
|
void qe_config_iopin(u8 port, u8 pin, int dir, int open_drain, int assign)
|
|
{
|
|
u32 pin_2bit_mask;
|
|
u32 pin_2bit_dir;
|
|
u32 pin_2bit_assign;
|
|
u32 pin_1bit_mask;
|
|
u32 tmp_val;
|
|
volatile ccsr_gur_t *gur = (void *)(CFG_SYS_MPC85xx_GUTS_ADDR);
|
|
volatile par_io_t *par_io = (volatile par_io_t *)
|
|
&(gur->qe_par_io);
|
|
|
|
/* Caculate pin location and 2bit mask and dir */
|
|
pin_2bit_mask = (u32)(0x3 << (NUM_OF_PINS-(pin%(NUM_OF_PINS/2)+1)*2));
|
|
pin_2bit_dir = (u32)(dir << (NUM_OF_PINS-(pin%(NUM_OF_PINS/2)+1)*2));
|
|
|
|
/* Setup the direction */
|
|
tmp_val = (pin > (NUM_OF_PINS/2) - 1) ? \
|
|
in_be32(&par_io[port].cpdir2) :
|
|
in_be32(&par_io[port].cpdir1);
|
|
|
|
if (pin > (NUM_OF_PINS/2) -1) {
|
|
out_be32(&par_io[port].cpdir2, ~pin_2bit_mask & tmp_val);
|
|
out_be32(&par_io[port].cpdir2, pin_2bit_dir | tmp_val);
|
|
} else {
|
|
out_be32(&par_io[port].cpdir1, ~pin_2bit_mask & tmp_val);
|
|
out_be32(&par_io[port].cpdir1, pin_2bit_dir | tmp_val);
|
|
}
|
|
|
|
/* Calculate pin location for 1bit mask */
|
|
pin_1bit_mask = (u32)(1 << (NUM_OF_PINS - (pin+1)));
|
|
|
|
/* Setup the open drain */
|
|
tmp_val = in_be32(&par_io[port].cpodr);
|
|
if (open_drain)
|
|
out_be32(&par_io[port].cpodr, pin_1bit_mask | tmp_val);
|
|
else
|
|
out_be32(&par_io[port].cpodr, ~pin_1bit_mask & tmp_val);
|
|
|
|
/* Setup the assignment */
|
|
tmp_val = (pin > (NUM_OF_PINS/2) - 1) ?
|
|
in_be32(&par_io[port].cppar2):
|
|
in_be32(&par_io[port].cppar1);
|
|
pin_2bit_assign = (u32)(assign
|
|
<< (NUM_OF_PINS - (pin%(NUM_OF_PINS/2)+1)*2));
|
|
|
|
/* Clear and set 2 bits mask */
|
|
if (pin > (NUM_OF_PINS/2) - 1) {
|
|
out_be32(&par_io[port].cppar2, ~pin_2bit_mask & tmp_val);
|
|
out_be32(&par_io[port].cppar2, pin_2bit_assign | tmp_val);
|
|
} else {
|
|
out_be32(&par_io[port].cppar1, ~pin_2bit_mask & tmp_val);
|
|
out_be32(&par_io[port].cppar1, pin_2bit_assign | tmp_val);
|
|
}
|
|
}
|
|
|
|
#endif /* CONFIG_QE */
|