Subversion Repositories openrisc_me

//==========================================================================

//

//        ecos_bsp.c

//

//        eCos BSP (for building Cygmon)

//

//==========================================================================

//####ECOSGPLCOPYRIGHTBEGIN####

// -------------------------------------------

// This file is part of eCos, the Embedded Configurable Operating System.

// Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.

//

// eCos 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 or (at your option) any later version.

//

// eCos 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 eCos; if not, write to the Free Software Foundation, Inc.,

// 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.

//

// As a special exception, if other files instantiate templates or use macros

// or inline functions from this file, or you compile this file and link it

// with other works to produce a work based on this file, this file does not

// by itself cause the resulting work to be covered by the GNU General Public

// License. However the source code for this file must still be made available

// in accordance with section (3) of the GNU General Public License.

//

// This exception does not invalidate any other reasons why a work based on

// this file might be covered by the GNU General Public License.

//

// Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.

// at http://sources.redhat.com/ecos/ecos-license/

// -------------------------------------------

//####ECOSGPLCOPYRIGHTEND####

//==========================================================================

//#####DESCRIPTIONBEGIN####

//

// Author(s):     gthomas

// Contributors:  gthomas, dmoseley

// Date:          1999-10-11

// Description:   Wrapper functions which provide BSP environment for Cygmon

//####DESCRIPTIONEND####

#ifdef CYGPKG_KERNEL

#include <pkgconf/kernel.h>   // Configuration headers

#endif

#include <pkgconf/hal.h>

#include <pkgconf/cygmon.h>

#include <cyg/hal/hal_arch.h>

#include <cyg/hal/hal_cache.h>

#ifdef CYGPKG_KERNEL

#include <cyg/kernel/kapi.h>

#else

#include <cyg/hal/drv_api.h>

#include <cyg/hal/hal_intr.h>

#endif

#include <cyg/infra/diag.h>

#include "bsp/common/bsp_if.h"

#include <cyg/hal/hal_if.h>

#include <signal.h>

#include CYGHWR_MEMORY_LAYOUT_H

#include <pkgconf/system.h>

#ifdef CYGPKG_IO

#include <cyg/io/io.h>

#include <cyg/io/serialio.h>

#endif

#define STACK_SIZE CYGNUM_HAL_STACK_SIZE_MINIMUM

static char stack[STACK_SIZE];

#ifdef CYGPKG_KERNEL

static cyg_thread thread_data;

static cyg_handle_t thread_handle;

#endif

char *build_date = __DATE__;

extern void monitor_main(int, char *);

extern int  stub_is_active;

void ecos_bsp_set_memsize(unsigned long size);

void

cygmon_main(void)

{

    _bsp_init();

    monitor_main(0, 0);  // Null argument list

}

extern unsigned long cygmon_memsize;

externC void

cyg_start( void )

{

    // Fill in the BSP memory info

    if (cygmon_memsize != 0)

        ecos_bsp_set_memsize(cygmon_memsize);

#ifdef CYGPKG_KERNEL

    // Create a main thread, so we can run the scheduler and have time 'pass'

    cyg_thread_create(10,                // Priority - just a number

                      (cyg_thread_entry_t*)cygmon_main,       // entry

                      0,                 // entry parameter

                      "Cygmon",          // Name

                      &stack[0],         // Stack

                      STACK_SIZE,        // Size

                      &thread_handle,    // Handle

                      &thread_data       // Thread data structure

            );

    cyg_thread_resume(thread_handle);  // Start it

    cyg_scheduler_start();

#else

#ifdef HAL_ARCH_FUNCALL_NEW_STACK

    HAL_ARCH_FUNCALL_NEW_STACK(cygmon_main, &stack[0], STACK_SIZE);

#else

    #error Need to define HAL_ARCH_FUNCALL_NEW_STACK

#endif

#endif

} // cyg_package_start()

#ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

extern void *_hal_registers;  // Used by eCos GDB stubs

extern void (*__init_vec)(void);

extern void (*__cleanup_vec)(void);

extern void __install_traps(void);

#endif

extern int machine_syscall(HAL_SavedRegisters *regs);

void

_bsp_handle_exception(cyg_addrword_t data, cyg_code_t num, cyg_addrword_t info)

{

    if (num == CYGNUM_HAL_EXCEPTION_INTERRUPT) {

        if (machine_syscall((HAL_SavedRegisters*)info)) {

            return;

        }

        // Fall through to "normal" exception handling if system call failed

    }

#ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

    _hal_registers = (void *)info;  // Used by eCos GDB stubs

    __cleanup_vec();

#endif

    bsp_invoke_dbg_handler(num, (void *)info);

#ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

    __init_vec();

#endif

}

#ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

extern void __handle_exception(void);

#else

int

unhandled_exception(int num, void *args)

{

    diag_printf("Unhandled exception: %d/%x\n", num, args);

    while (1) ;

}

#endif

void

_bsp_cpu_init(void)

{

#ifdef CYGPKG_KERNEL

    int d0;

    cyg_exception_set_handler(CYGNUM_HAL_EXCEPTION_ILLEGAL_INSTRUCTION,

                              _bsp_handle_exception,

                              (cyg_addrword_t)&d0,

                              0,

                              0);

#endif

#ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

    bsp_install_dbg_handler((bsp_handler_t)__handle_exception);

    __install_traps();

#else

    bsp_install_dbg_handler(unhandled_exception);

#endif

}

#define FAIL() diag_printf("fail: %s\n", __FUNCTION__);  while (1) ;

#ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT

struct BSP_IO {

    char            *name;

    cyg_io_handle_t  chan;

};

static void

uart_putchar(void *base, char c)

{

    char buf;

    int len;

    struct BSP_IO *io = (struct BSP_IO *)base;

    if (io->chan) {

        len = 1;

        buf = c;

        cyg_io_write(io->chan, &buf, &len);

    }

}

extern int __output_gdb_string (const char *str, int string_len);

// This function is mostly used by the 'write()' system call

static void

uart_write(void *base, const char *buf, int len)

{

    struct BSP_IO *io = (struct BSP_IO *)base;

    if (io->chan) {

        if (stub_is_active) {

            // We are running in 'GDB' mode

            __output_gdb_string(buf, len);

        } else {

            cyg_io_write(io->chan, buf, &len);

        }

    }

}

static int

uart_read(void *base, char *buf, int len)

{

    struct BSP_IO *io = (struct BSP_IO *)base;

    if (io->chan) {

        cyg_io_read(io->chan, buf, &len);

        return len;

    }

    return 0;

}

static int

uart_getchar(void *base)

{

    char buf = '\0';

    int len;

    struct BSP_IO *io = (struct BSP_IO *)base;

    if (io->chan) {

        len = 1;

        cyg_io_read(io->chan, &buf, &len);

    }

    return buf;

}

static int

uart_control(void *base, int func, ...)

{

    int rc = 0;

    va_list ap;

    int arg;

    struct BSP_IO *io = (struct BSP_IO *)base;

    va_start(ap, func);

    if (func == COMMCTL_SETBAUD)

    {

        cyg_serial_info_t buffer = {

            CYG_SERIAL_BAUD_DEFAULT,

            CYG_SERIAL_STOP_DEFAULT,

            CYG_SERIAL_PARITY_DEFAULT,

            CYG_SERIAL_WORD_LENGTH_DEFAULT,

            CYG_SERIAL_FLAGS_DEFAULT

        };

        int len = sizeof(buffer);

        arg = va_arg(ap, int);

        switch (arg)

        {

        case 50:         buffer.baud = CYG_SERIAL_BAUD_RATE(50);       break;

        case 75:         buffer.baud = CYG_SERIAL_BAUD_RATE(75);       break;

        case 110:        buffer.baud = CYG_SERIAL_BAUD_RATE(110);      break;

        case 134:        buffer.baud = CYG_SERIAL_BAUD_RATE(134_5);    break;

        case 135:        buffer.baud = CYG_SERIAL_BAUD_RATE(134_5);    break;

        case 150:        buffer.baud = CYG_SERIAL_BAUD_RATE(150);      break;

        case 200:        buffer.baud = CYG_SERIAL_BAUD_RATE(200);      break;

        case 300:        buffer.baud = CYG_SERIAL_BAUD_RATE(300);      break;

        case 600:        buffer.baud = CYG_SERIAL_BAUD_RATE(600);      break;

        case 1200:       buffer.baud = CYG_SERIAL_BAUD_RATE(1200);     break;

        case 1800:       buffer.baud = CYG_SERIAL_BAUD_RATE(1800);     break;

        case 2400:       buffer.baud = CYG_SERIAL_BAUD_RATE(2400);     break;

        case 3600:       buffer.baud = CYG_SERIAL_BAUD_RATE(3600);     break;

        case 4800:       buffer.baud = CYG_SERIAL_BAUD_RATE(4800);     break;

        case 7200:       buffer.baud = CYG_SERIAL_BAUD_RATE(7200);     break;

        case 9600:       buffer.baud = CYG_SERIAL_BAUD_RATE(9600);     break;

        case 14400:      buffer.baud = CYG_SERIAL_BAUD_RATE(14400);    break;

        case 19200:      buffer.baud = CYG_SERIAL_BAUD_RATE(19200);    break;

        case 38400:      buffer.baud = CYG_SERIAL_BAUD_RATE(38400);    break;

        case 57600:      buffer.baud = CYG_SERIAL_BAUD_RATE(57600);    break;

        case 115200:     buffer.baud = CYG_SERIAL_BAUD_RATE(115200);   break;

        case 230400:     buffer.baud = CYG_SERIAL_BAUD_RATE(230400);   break;

        default:         buffer.baud = -1; rc = -1;                    break;

        }

        if ((io->chan) && (buffer.baud != -1)) {

            rc = cyg_io_set_config(io->chan, CYG_IO_SET_CONFIG_SERIAL_INFO, &buffer, &len);

        }

    }

    va_end(ap);

    return rc;

}

/*

 * Setup the bsp_comm_channel data structure

 */

struct BSP_IO bsp_comm_io[] = {

    {CYGDAT_CYGMON_CONSOLE_DEV, 0},  // Console device

};

struct bsp_comm_channel _bsp_comm_list[] =

{

    {

        { "UART 0",

          BSP_COMM_SERIAL,

          BSP_PROTO_NONE },

        { (void*)&bsp_comm_io[0],

          uart_write,

          uart_read,

          uart_putchar,

          uart_getchar,

          uart_control }

    },

};

int _bsp_num_comms = sizeof(_bsp_comm_list)/sizeof(_bsp_comm_list[0]);

void

_bsp_init_board_comm(void)

{

    int i;

    for (i = 0;  i < _bsp_num_comms;  i++) {

        Cyg_ErrNo err;

        struct BSP_IO *io;

        io = (struct BSP_IO *)_bsp_comm_list[i].procs.ch_data;

        if ((err = cyg_io_lookup(io->name, &io->chan)) != ENOERR) {

            diag_printf("Can't open '%s'\n", io->name);

        }

    }

}

#else // CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT

struct bsp_comm_channel _bsp_comm_list[1];

int _bsp_num_comms = 1;

// Yuck! Two things need doing:

// FIXME: Make bsp code use pointers in the bsp_comm_channel instead

//        of sub-structures.

// FIXME: Make HAL provide the bsp_comm_info structure - I missed that

//        initially because it cannot be accessed via the virtual table API.

void

_bsp_init_board_comm(void)

{

    struct bsp_comm_channel* channel;

    hal_virtual_comm_table_t* comm;

    channel = &_bsp_comm_list[0];

    channel->info.name = "fixme";

    channel->info.kind = BSP_COMM_SERIAL;

    channel->info.protocol = BSP_PROTO_NONE;

    comm = CYGACC_CALL_IF_DEBUG_PROCS();

    channel->procs = *(struct bsp_comm_procs*)comm;

}

#endif // CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT

/*

 * Array of memory region descriptors. We just list RAM.

 */

#ifdef CYGMEM_REGION_ram

#define RAM_VIRTUAL_BASE CYGMEM_REGION_ram

#define RAM_TOTAL_SIZE   CYGMEM_REGION_ram_SIZE

#else

#define RAM_VIRTUAL_BASE 0x00008000

#define RAM_TOTAL_SIZE   0x00FF8000

#endif

struct bsp_mem_info _bsp_memory_list[] =

{

    { (void *)RAM_VIRTUAL_BASE,

      (void *)RAM_VIRTUAL_BASE,

      0,

      RAM_TOTAL_SIZE,

      BSP_MEM_RAM

    },

};

/*

 * Number of memory region descriptors.

 */

int _bsp_num_mem_regions = sizeof(_bsp_memory_list)/sizeof(_bsp_memory_list[0]);

void

_bsp_install_cpu_irq_controllers(void)

{

}

void

_bsp_install_board_irq_controllers(void)

{

}

void

__init_irq_controllers(void)

{

}

void

_bsp_board_init(void)

{

    /*

     * Define platform info.

     */

#ifdef HAL_PLATFORM_CPU

    _bsp_platform_info.cpu = HAL_PLATFORM_CPU;

#else

    _bsp_platform_info.cpu = "Unknown CPU";

#endif

#ifdef HAL_PLATFORM_BOARD

    _bsp_platform_info.board = HAL_PLATFORM_BOARD;

#else

    _bsp_platform_info.board = "Unknown board";

#endif

#ifdef HAL_PLATFORM_EXTRA

    _bsp_platform_info.extra = HAL_PLATFORM_EXTRA;

#else

    _bsp_platform_info.extra = "";

#endif

}

extern char *strchr(char *, char);

char *

index(char *string, char key)

{

    return strchr(string, key);

}

void

flush_i_cache(void)

{

    HAL_ICACHE_SYNC();

}

void

ecos_bsp_console_putc(char c)

{

    if (bsp_shared_data) {

        bsp_console_putc(c);

    }

}

char

ecos_bsp_console_getc(void)

{

    if (bsp_shared_data) {

        return bsp_console_getc();

    } else {

        return '?';

    }

}

void

ecos_bsp_set_memsize(unsigned long size)

{

    _bsp_memory_list[0].nbytes = size;

}