openwrtv4/target/linux/adm5120-2.6/image/lzma-loader/src/board.c

/*
 * ADM5120 specific board support for LZMA decompressor
 *
 * Copyright (C) 2007 OpenWrt.org
 * Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */

#include <stddef.h>

#define READREG(r)	*(volatile unsigned int *)(r)
#define WRITEREG(r,v)	*(volatile unsigned int *)(r) = v

/*
 * INTC definitions
 */
#define INTC_BASE	0xB2200000

/* INTC registers */
#define INTC_REG_IRQ_DISABLE	0x0C

/*
 * UART definitions
 */
#define UART_BASE	0xB2600000
/* UART registers */
#define UART_REG_DATA	0x00	/* Data register */
#define UART_REG_ECR	0x04	/* Error Clear register */
#define UART_REG_LCRH	0x08	/* Line Control High register */
#define UART_REG_LCRM	0x0C	/* Line Control Middle register */
#define UART_REG_LCRL	0x10	/* Line Control Low register */
#define UART_REG_CTRL	0x14	/* Control register */
#define UART_REG_FLAG   0x18	/* Flag register */

/* Control register bits */
#define UART_CTRL_EN	( 1 << 0 )	/* UART enable */

/* Line Control High register bits */
#define UART_LCRH_FEN	( 1 << 4 )	/* FIFO enable */

/* Flag register bits */
#define UART_FLAG_CTS	( 1 << 0 )
#define UART_FLAG_DSR	( 1 << 1 )
#define UART_FLAG_DCD	( 1 << 2 )
#define UART_FLAG_BUSY	( 1 << 3 )
#define UART_FLAG_RXFE	( 1 << 4 )	/* RX FIFO empty */
#define UART_FLAG_TXFF	( 1 << 5 )	/* TX FIFO full */
#define UART_FLAG_RXFF	( 1 << 6 )	/* RX FIFO full */
#define UART_FLAG_TXFE	( 1 << 7 )	/* TX FIFO empty */

/*
 * SWITCH definitions
 */
#define SWITCH_BASE	0xB2000000

#define SWITCH_REG_CPUP_CONF	0x0024
#define SWITCH_REG_PORT_CONF0	0x0028

#define SWITCH_REG_GPIO_CONF0	0x00B8
#define SWITCH_REG_GPIO_CONF2	0x00BC

#define SWITCH_REG_PORT0_LED	0x0100
#define SWITCH_REG_PORT1_LED	0x0104
#define SWITCH_REG_PORT2_LED	0x0108
#define SWITCH_REG_PORT3_LED	0x010C
#define SWITCH_REG_PORT4_LED	0x0110

#define SWITCH_PORTS_HW		0x3F		/* Hardware Ports */

/* CPUP_CONF register bits */
#define CPUP_CONF_DCPUP		( 1 << 0 )	/* Disable CPU port */

/* PORT_CONF0 register bits */
#define PORT_CONF0_DP_SHIFT	0	/* disable port shift*/


/*
 * UART routines
 */

#define UART_READ(r)	READREG(UART_BASE+(r))
#define UART_WRITE(r,v)	WRITEREG(UART_BASE+(r),(v))

static void uart_init(void)
{
#if 0
	unsigned int t;

	/* disable uart */
	UART_WRITE(UART_REG_CTRL, 0);

	/* keep current baud rate */
	t = UART_READ(UART_REG_LCRM);
	UART_WRITE(UART_REG_LCRM, t);
	t = UART_READ(UART_REG_LCRL);
	UART_WRITE(UART_REG_LCRL, t);

	/* keep data, stop, and parity bits, but disable FIFO */
	t = UART_READ(UART_REG_LCRH);
	t &= ~(UART_LCRH_FEN);
	UART_WRITE(UART_REG_LCRH, t );

	/* clear error bits */
	UART_WRITE(UART_REG_ECR, 0xFF);

	/* enable uart, and disable interrupts */
	UART_WRITE(UART_REG_CTRL, UART_CTRL_EN);
#endif
}

/*
 * INTC routines
 */

#define INTC_READ(r)	READREG(INTC_BASE+(r))
#define INTC_WRITE(r,v)	WRITEREG(INTC_BASE+(r),v)

static void intc_init(void)
{
	INTC_WRITE(INTC_REG_IRQ_DISABLE, 0xFFFFFFFF);
}

/*
 * SWITCH routines
 */

#define SWITCH_READ(r)		READREG(SWITCH_BASE+(r))
#define SWITCH_WRITE(r,v)	WRITEREG(SWITCH_BASE+(r),v)

static void switch_init(void)
{
	/* disable PHYS ports */
	SWITCH_WRITE(SWITCH_REG_PORT_CONF0,
	    (SWITCH_PORTS_HW << PORT_CONF0_DP_SHIFT));

	/* disable CPU port */
	SWITCH_WRITE(SWITCH_REG_CPUP_CONF, CPUP_CONF_DCPUP);

	/* disable GPIO lines */
	SWITCH_WRITE(SWITCH_REG_GPIO_CONF0, 0);
	SWITCH_WRITE(SWITCH_REG_GPIO_CONF2, 0);

	/* disable LED lines */
	SWITCH_WRITE(SWITCH_REG_PORT0_LED, 0);
	SWITCH_WRITE(SWITCH_REG_PORT1_LED, 0);
	SWITCH_WRITE(SWITCH_REG_PORT2_LED, 0);
	SWITCH_WRITE(SWITCH_REG_PORT3_LED, 0);
	SWITCH_WRITE(SWITCH_REG_PORT4_LED, 0);
}

void board_putc(int ch)
{
	while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);

	UART_WRITE(UART_REG_DATA, ch);

	while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);
}

void board_init(void)
{
	intc_init();
	switch_init();
	uart_init();
}