/*
 * (C) Copyright 2002
 * Kyle Harris, Nexus Technologies, Inc. kharris@nexus-tech.net
 *
 * (C) Copyright 2002
 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
 * Marius Groeger <mgroeger@sysgo.de>
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * 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 <asm/arch/pxa-regs.h>
#include <common.h>

DECLARE_GLOBAL_DATA_PTR;

/* ------------------------------------------------------------------------- */


/* local prototypes */
void set_led (int led, int color);
void error_code_halt (int code);
int init_sio (int led, unsigned long base);
inline void cradle_outb (unsigned short val, unsigned long base,
                         unsigned long reg);
inline unsigned char cradle_inb (unsigned long base, unsigned long reg);
inline void sleep (int i);

inline void
/**********************************************************/
sleep (int i)
/**********************************************************/
{
        while (i--) {
                udelay (1000000);
        }
}

void
/**********************************************************/
error_code_halt (int code)
/**********************************************************/
{
        while (1) {
                led_code (code, RED);
                sleep (1);
                led_code (0, OFF);
                sleep (1);
        }
}

void
/**********************************************************/
led_code (int code, int color)
/**********************************************************/
{
        int i;

        code &= 0xf;            /* only 4 leds */

        for (i = 0; i < 4; i++) {
                if (code & (1 << i)) {
                        set_led (i, color);
                } else {
                        set_led (i, OFF);
                }
        }
}

void
/**********************************************************/
set_led (int led, int color)
/**********************************************************/
{
        int shift = led * 2;
        unsigned long mask = 0x3 << shift;

        CRADLE_LED_CLR_REG = mask;      /* clear bits */
        CRADLE_LED_SET_REG = (color << shift);  /* set bits */
        udelay (5000);
}

inline void
/**********************************************************/
cradle_outb (unsigned short val, unsigned long base, unsigned long reg)
/**********************************************************/
{
        *(volatile unsigned short *) (base + (reg * 2)) = val;
}

inline unsigned char
/**********************************************************/
cradle_inb (unsigned long base, unsigned long reg)
/**********************************************************/
{
        unsigned short val;

        val = *(volatile unsigned short *) (base + (reg * 2));
        return (val & 0xff);
}

int
/**********************************************************/
init_sio (int led, unsigned long base)
/**********************************************************/
{
        unsigned char val;

        set_led (led, YELLOW);
        val = cradle_inb (base, CRADLE_SIO_INDEX);
        val = cradle_inb (base, CRADLE_SIO_INDEX);
        if (val != 0) {
                set_led (led, RED);
                return -1;
        }

        /* map SCC2 to COM1 */
        cradle_outb (0x01, base, CRADLE_SIO_INDEX);
        cradle_outb (0x00, base, CRADLE_SIO_DATA);

        /* enable SCC2 extended regs */
        cradle_outb (0x40, base, CRADLE_SIO_INDEX);
        cradle_outb (0xa0, base, CRADLE_SIO_DATA);

        /* enable SCC2 clock multiplier */
        cradle_outb (0x51, base, CRADLE_SIO_INDEX);
        cradle_outb (0x04, base, CRADLE_SIO_DATA);

        /* enable SCC2 */
        cradle_outb (0x00, base, CRADLE_SIO_INDEX);
        cradle_outb (0x04, base, CRADLE_SIO_DATA);

        /* map SCC2 DMA to channel 0 */
        cradle_outb (0x4f, base, CRADLE_SIO_INDEX);
        cradle_outb (0x09, base, CRADLE_SIO_DATA);

        /* read ID from SIO to check operation */
        cradle_outb (0xe4, base, 0x3f8 + 0x3);
        val = cradle_inb (base, 0x3f8 + 0x0);
        if ((val & 0xf0) != 0x20) {
                set_led (led, RED);
                /* disable SCC2 */
                cradle_outb (0, base, CRADLE_SIO_INDEX);
                cradle_outb (0, base, CRADLE_SIO_DATA);
                return -1;
        }
        /* set back to bank 0 */
        cradle_outb (0, base, 0x3f8 + 0x3);
        set_led (led, GREEN);
        return 0;
}

/*
 * Miscelaneous platform dependent initialisations
 */

int
/**********************************************************/
board_late_init (void)
/**********************************************************/
{
        return (0);
}

int
/**********************************************************/
board_init (void)
/**********************************************************/
{
        led_code (0xf, YELLOW);

        /* arch number of HHP Cradle */
        gd->bd->bi_arch_number = MACH_TYPE_HHP_CRADLE;

        /* adress of boot parameters */
        gd->bd->bi_boot_params = 0xa0000100;

        /* Init SIOs to enable SCC2 */
        udelay (100000);                /* delay makes it look neat */
        init_sio (0, CRADLE_SIO1_PHYS);
        udelay (100000);
        init_sio (1, CRADLE_SIO2_PHYS);
        udelay (100000);
        init_sio (2, CRADLE_SIO3_PHYS);
        udelay (100000);
        set_led (3, GREEN);

        return 1;
}

int
/**********************************************************/
dram_init (void)
/**********************************************************/
{
        gd->bd->bi_dram[0].start = PHYS_SDRAM_1;
        gd->bd->bi_dram[0].size  = PHYS_SDRAM_1_SIZE;
        gd->bd->bi_dram[1].start = PHYS_SDRAM_2;
        gd->bd->bi_dram[1].size  = PHYS_SDRAM_2_SIZE;
        gd->bd->bi_dram[2].start = PHYS_SDRAM_3;
        gd->bd->bi_dram[2].size  = PHYS_SDRAM_3_SIZE;
        gd->bd->bi_dram[3].start = PHYS_SDRAM_4;
        gd->bd->bi_dram[3].size  = PHYS_SDRAM_4_SIZE;

        return (PHYS_SDRAM_1_SIZE +
                PHYS_SDRAM_2_SIZE +
                PHYS_SDRAM_3_SIZE +
                PHYS_SDRAM_4_SIZE );
}