mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-03 21:48:15 +00:00 
			
		
		
		
	Signed-off-by: Wolfgang Denk <wd@denx.de> [trini: Fixup common/cmd_io.c] Signed-off-by: Tom Rini <trini@ti.com>
		
			
				
	
	
		
			330 lines
		
	
	
		
			7.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			330 lines
		
	
	
		
			7.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Memory Setup stuff - taken from blob memsetup.S
 | 
						|
 *
 | 
						|
 * Copyright (C) 2009 Jens Scharsig (js_at_ng@scharsoft.de)
 | 
						|
 *
 | 
						|
 *  Copyright (C) 2005 HP Labs
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier:	GPL-2.0+
 | 
						|
 */
 | 
						|
 | 
						|
/*
 | 
						|
 * WARNING:
 | 
						|
 *
 | 
						|
 * As the code is right now, it expects all PIO ports A,B,C,...
 | 
						|
 * to be evenly spaced in the memory map:
 | 
						|
 * ATMEL_BASE_PIOA + port * sizeof at91pio_t
 | 
						|
 * This might not necessaryly be true in future Atmel SoCs.
 | 
						|
 * This code should be fixed to use a pointer array to the ports.
 | 
						|
 */
 | 
						|
 | 
						|
#include <config.h>
 | 
						|
#include <common.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <asm/sizes.h>
 | 
						|
#include <asm/arch/hardware.h>
 | 
						|
#include <asm/arch/at91_pio.h>
 | 
						|
 | 
						|
int at91_set_pio_pullup(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		if (use_pullup)
 | 
						|
			writel(1 << pin, &pio->port[port].puer);
 | 
						|
		else
 | 
						|
			writel(1 << pin, &pio->port[port].pudr);
 | 
						|
		writel(mask, &pio->port[port].per);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the "GPIO" peripheral role.
 | 
						|
 */
 | 
						|
int at91_set_pio_periph(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
		writel(mask, &pio->port[port].per);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the "A" internal peripheral role.
 | 
						|
 */
 | 
						|
int at91_set_a_periph(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
#if defined(CPU_HAS_PIO3)
 | 
						|
		writel(readl(&pio->port[port].abcdsr1) & ~mask,
 | 
						|
			&pio->port[port].abcdsr1);
 | 
						|
		writel(readl(&pio->port[port].abcdsr2) & ~mask,
 | 
						|
			&pio->port[port].abcdsr2);
 | 
						|
#else
 | 
						|
		writel(mask, &pio->port[port].asr);
 | 
						|
#endif
 | 
						|
		writel(mask, &pio->port[port].pdr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the "B" internal peripheral role.
 | 
						|
 */
 | 
						|
int at91_set_b_periph(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
#if defined(CPU_HAS_PIO3)
 | 
						|
		writel(readl(&pio->port[port].abcdsr1) | mask,
 | 
						|
			&pio->port[port].abcdsr1);
 | 
						|
		writel(readl(&pio->port[port].abcdsr2) & ~mask,
 | 
						|
			&pio->port[port].abcdsr2);
 | 
						|
#else
 | 
						|
		writel(mask, &pio->port[port].bsr);
 | 
						|
#endif
 | 
						|
		writel(mask, &pio->port[port].pdr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#if defined(CPU_HAS_PIO3)
 | 
						|
/*
 | 
						|
 * mux the pin to the "C" internal peripheral role.
 | 
						|
 */
 | 
						|
int at91_set_c_periph(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
		writel(readl(&pio->port[port].abcdsr1) & ~mask,
 | 
						|
			&pio->port[port].abcdsr1);
 | 
						|
		writel(readl(&pio->port[port].abcdsr2) | mask,
 | 
						|
			&pio->port[port].abcdsr2);
 | 
						|
		writel(mask, &pio->port[port].pdr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the "D" internal peripheral role.
 | 
						|
 */
 | 
						|
int at91_set_d_periph(unsigned port, unsigned pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
		writel(readl(&pio->port[port].abcdsr1) | mask,
 | 
						|
			&pio->port[port].abcdsr1);
 | 
						|
		writel(readl(&pio->port[port].abcdsr2) | mask,
 | 
						|
			&pio->port[port].abcdsr2);
 | 
						|
		writel(mask, &pio->port[port].pdr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the gpio controller (instead of "A" or "B" peripheral), and
 | 
						|
 * configure it for an input.
 | 
						|
 */
 | 
						|
int at91_set_pio_input(unsigned port, u32 pin, int use_pullup)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		at91_set_pio_pullup(port, pin, use_pullup);
 | 
						|
		writel(mask, &pio->port[port].odr);
 | 
						|
		writel(mask, &pio->port[port].per);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * mux the pin to the gpio controller (instead of "A" or "B" peripheral),
 | 
						|
 * and configure it for an output.
 | 
						|
 */
 | 
						|
int at91_set_pio_output(unsigned port, u32 pin, int value)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].idr);
 | 
						|
		writel(mask, &pio->port[port].pudr);
 | 
						|
		if (value)
 | 
						|
			writel(mask, &pio->port[port].sodr);
 | 
						|
		else
 | 
						|
			writel(mask, &pio->port[port].codr);
 | 
						|
		writel(mask, &pio->port[port].oer);
 | 
						|
		writel(mask, &pio->port[port].per);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * enable/disable the glitch filter. mostly used with IRQ handling.
 | 
						|
 */
 | 
						|
int at91_set_pio_deglitch(unsigned port, unsigned pin, int is_on)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		if (is_on) {
 | 
						|
#if defined(CPU_HAS_PIO3)
 | 
						|
			writel(mask, &pio->port[port].ifscdr);
 | 
						|
#endif
 | 
						|
			writel(mask, &pio->port[port].ifer);
 | 
						|
		} else {
 | 
						|
			writel(mask, &pio->port[port].ifdr);
 | 
						|
		}
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#if defined(CPU_HAS_PIO3)
 | 
						|
/*
 | 
						|
 * enable/disable the debounce filter.
 | 
						|
 */
 | 
						|
int at91_set_pio_debounce(unsigned port, unsigned pin, int is_on, int div)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		if (is_on) {
 | 
						|
			writel(mask, &pio->port[port].ifscer);
 | 
						|
			writel(div & PIO_SCDR_DIV, &pio->port[port].scdr);
 | 
						|
			writel(mask, &pio->port[port].ifer);
 | 
						|
		} else {
 | 
						|
			writel(mask, &pio->port[port].ifdr);
 | 
						|
		}
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * enable/disable the pull-down.
 | 
						|
 * If pull-up already enabled while calling the function, we disable it.
 | 
						|
 */
 | 
						|
int at91_set_pio_pulldown(unsigned port, unsigned pin, int is_on)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(mask, &pio->port[port].pudr);
 | 
						|
		if (is_on)
 | 
						|
			writel(mask, &pio->port[port].ppder);
 | 
						|
		else
 | 
						|
			writel(mask, &pio->port[port].ppddr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * disable Schmitt trigger
 | 
						|
 */
 | 
						|
int at91_set_pio_disable_schmitt_trig(unsigned port, unsigned pin)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		writel(readl(&pio->port[port].schmitt) | mask,
 | 
						|
			&pio->port[port].schmitt);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * enable/disable the multi-driver. This is only valid for output and
 | 
						|
 * allows the output pin to run as an open collector output.
 | 
						|
 */
 | 
						|
int at91_set_pio_multi_drive(unsigned port, unsigned pin, int is_on)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		if (is_on)
 | 
						|
			writel(mask, &pio->port[port].mder);
 | 
						|
		else
 | 
						|
			writel(mask, &pio->port[port].mddr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * assuming the pin is muxed as a gpio output, set its value.
 | 
						|
 */
 | 
						|
int at91_set_pio_value(unsigned port, unsigned pin, int value)
 | 
						|
{
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		if (value)
 | 
						|
			writel(mask, &pio->port[port].sodr);
 | 
						|
		else
 | 
						|
			writel(mask, &pio->port[port].codr);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * read the pin's value (works even if it's not muxed as a gpio).
 | 
						|
 */
 | 
						|
int at91_get_pio_value(unsigned port, unsigned pin)
 | 
						|
{
 | 
						|
	u32		pdsr = 0;
 | 
						|
	at91_pio_t	*pio = (at91_pio_t *) ATMEL_BASE_PIOA;
 | 
						|
	u32		mask;
 | 
						|
 | 
						|
	if ((port < ATMEL_PIO_PORTS) && (pin < 32)) {
 | 
						|
		mask = 1 << pin;
 | 
						|
		pdsr = readl(&pio->port[port].pdsr) & mask;
 | 
						|
	}
 | 
						|
	return pdsr != 0;
 | 
						|
}
 |