c/src/lib/libbsp/powerpc/ep1a/console/ns16550cfg.c


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

/*
 *  This include file contains all console driver definations for the nc16550
 *
 *  COPYRIGHT (c) 1989-2008.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.org/license/LICENSE.
 */

#include <rtems.h>
#include <libchip/serial.h>
#include <libchip/ns16550.h>
#include <bsp.h>

typedef struct uart_reg
{
  unsigned char reg;
  unsigned char pad[7];
} uartReg;

uint8_t Read_ns16550_register(
  uint32_t  ulCtrlPort,
  uint8_t   ucRegNum
)
{
volatile struct uart_reg *p = (volatile struct uart_reg *)ulCtrlPort;
  uint8_t  ucData;
  ucData = p[ucRegNum].reg;
  __asm__ volatile("sync");
  return ucData;
}

void  Write_ns16550_register(
  uint32_t  ulCtrlPort,
  uint8_t   ucRegNum,
  uint8_t   ucData
)
{
  volatile struct uart_reg *p = (volatile struct uart_reg *)ulCtrlPort;
  volatile int i;
  p[ucRegNum].reg = ucData;
  __asm__ volatile("sync");
  __asm__ volatile("isync");
  __asm__ volatile("eieio");
  for (i=0;i<0x08ff;i++)
    __asm__ volatile("isync");
}