Subversion Repositories openrisc_me

/*

 * This software is Copyright (C) 1998 by T.sqware - all rights limited

 * It is provided in to the public domain "as is", can be freely modified

 * as far as this copyight notice is kept unchanged, but does not imply

 * an endorsement by T.sqware of the product in which it is included.

 *

 *  $Id: i386-stub-glue.c,v 1.2 2001-09-27 11:59:49 chris Exp $

 */

#include <rtems/system.h>

#include <rtems/score/cpu.h>

#include <bsp.h>

#include <irq.h>

#include <uart.h>

#include <assert.h>

int  putDebugChar(int ch);     /* write a single character      */

int  getDebugChar(void);       /* read and return a single char */

/* assign an exception handler */

void exceptionHandler(int, void (*handler)(void));

void BSP_loop(int uart);

/* Current uart used by gdb stub */

static int uart_current = 0;

/*

 * Initialize glue code linking i386-stub with the rest of

 * the system

 */

void

i386_stub_glue_init(int uart)

{

  assert(uart == BSP_UART_COM1 || uart == BSP_UART_COM2);

  uart_current = uart;

  BSP_uart_init(uart, 38400, 0);

}

void BSP_uart_on(const rtems_raw_irq_connect_data* used)

{

  BSP_irq_enable_at_i8259s(used->idtIndex - BSP_IRQ_VECTOR_BASE);

}

void BSP_uart_off(const rtems_raw_irq_connect_data* used)

{

  BSP_irq_disable_at_i8259s(used->idtIndex - BSP_IRQ_VECTOR_BASE);

}

int BSP_uart_isOn(const rtems_raw_irq_connect_data* used)

{

  return BSP_irq_enabled_at_i8259s(used->idtIndex - BSP_IRQ_VECTOR_BASE);

}

/*

 * In order to have a possibility to break into

 * running program, one has to call this function

 */

void i386_stub_glue_init_breakin(void)

{

  rtems_raw_irq_connect_data uart_raw_irq_data;

  assert(uart_current == BSP_UART_COM1 || uart_current == BSP_UART_COM2);

  if(uart_current == BSP_UART_COM1)

    {

      uart_raw_irq_data.idtIndex = BSP_UART_COM1_IRQ + BSP_IRQ_VECTOR_BASE;

    }

  else

    {

      uart_raw_irq_data.idtIndex = BSP_UART_COM2_IRQ + BSP_IRQ_VECTOR_BASE;

    }

  if(!i386_get_current_idt_entry(&uart_raw_irq_data))

    {

      printk("cannot get idt entry\n");

      rtems_fatal_error_occurred(1);

    }

  if(!i386_delete_idt_entry(&uart_raw_irq_data))

    {

      printk("cannot delete idt entry\n");

      rtems_fatal_error_occurred(1);

    }

  uart_raw_irq_data.on  = BSP_uart_on;

  uart_raw_irq_data.off = BSP_uart_off;

  uart_raw_irq_data.isOn= BSP_uart_isOn;

  /* Install ISR  */

  if(uart_current == BSP_UART_COM1)

    {

      uart_raw_irq_data.idtIndex = BSP_UART_COM1_IRQ + BSP_IRQ_VECTOR_BASE;

      uart_raw_irq_data.hdl = BSP_uart_dbgisr_com1;

    }

  else

    {

      uart_raw_irq_data.idtIndex = BSP_UART_COM2_IRQ + BSP_IRQ_VECTOR_BASE;

      uart_raw_irq_data.hdl = BSP_uart_dbgisr_com2;

    }

  if (!i386_set_idt_entry (&uart_raw_irq_data))

    {

      printk("raw exception handler connection failed\n");

      rtems_fatal_error_occurred(1);

    }

  /* Enable interrupts */

  BSP_uart_intr_ctrl(uart_current, BSP_UART_INTR_CTRL_GDB);

  return;

}

int

putDebugChar(int ch)

{

  assert(uart_current == BSP_UART_COM1 || uart_current == BSP_UART_COM2);

  BSP_uart_polled_write(uart_current, ch);

  return 1;

}

int getDebugChar(void)

{

  int val;

  assert(uart_current == BSP_UART_COM1 || uart_current == BSP_UART_COM2);

  val = BSP_uart_polled_read(uart_current);

  return val;

}

static void nop(){}

static int isOn() {return 1;}

void exceptionHandler(int vector, void (*handler)(void))

{

  rtems_raw_irq_connect_data excep_raw_irq_data;

  excep_raw_irq_data.idtIndex = vector;

  if(!i386_get_current_idt_entry(&excep_raw_irq_data))

    {

      printk("cannot get idt entry\n");

      rtems_fatal_error_occurred(1);

    }

  if(!i386_delete_idt_entry(&excep_raw_irq_data))

    {

      printk("cannot delete idt entry\n");

      rtems_fatal_error_occurred(1);

    }

  excep_raw_irq_data.on = nop;

  excep_raw_irq_data.off = nop;

  excep_raw_irq_data.isOn = isOn;

  excep_raw_irq_data.hdl = handler;

  if (!i386_set_idt_entry (&excep_raw_irq_data)) {

      printk("raw exception handler connection failed\n");

      rtems_fatal_error_occurred(1);

    }

  return;

}