summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/sparc/leon3/console/debugputs.c
blob: 10862b8ce54a7395028a2385e0f0e98fd79e4e31 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
/*
 *  This file contains the TTY driver for the serial ports on the LEON.
 *
 *  This driver uses the termios pseudo driver.
 *
 *  COPYRIGHT (c) 1989-1999.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  Modified for LEON3 BSP.
 *  COPYRIGHT (c) 2004.
 *  Gaisler Research.
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.com/license/LICENSE.
 *
 *  $Id$
 */

#include <bsp.h>
#include <rtems/libio.h>
#include <stdlib.h>
#include <assert.h>

/*
 * Number of uarts on AMBA bus
 */
extern int uarts;

/*
 *  console_outbyte_polled
 *
 *  This routine transmits a character using polling.
 */
void console_outbyte_polled(
  int           port,
  unsigned char ch
)
{
  if ((port >= 0) && (port < uarts)) {
    int u = LEON3_Cpu_Index+port;
    while ( (LEON3_Console_Uart[u]->status & LEON_REG_UART_STATUS_THE) == 0 );
    LEON3_Console_Uart[u]->data = (unsigned int) ch;
  }
}

/*
 *  console_inbyte_nonblocking 
 *
 *  This routine polls for a character.
 */
int console_inbyte_nonblocking( int port )
{
  if ((port >= 0) && (port < uarts)) {
    int u = LEON3_Cpu_Index+port;
    if (LEON3_Console_Uart[u]->status & LEON_REG_UART_STATUS_ERR)
      LEON3_Console_Uart[u]->status = ~LEON_REG_UART_STATUS_ERR;

    if ((LEON3_Console_Uart[u]->status & LEON_REG_UART_STATUS_DR) == 0)
      return -1;
    return (int) LEON3_Console_Uart[u]->data;
  } else {
    assert( 0 );
  }
  return -1;
}

/* putchar/getchar for printk */
static void bsp_out_char(char c)
{
  console_outbyte_polled(0, c);
}

/*
 *  To support printk
 */

#include <rtems/bspIo.h>

BSP_output_char_function_type BSP_output_char = bsp_out_char;

static int bsp_in_char(void)
{
  int tmp;

  while ((tmp = console_inbyte_nonblocking(0)) < 0);
  return tmp;
}

BSP_polling_getchar_function_type BSP_poll_char = bsp_in_char;