newlib/libc/sys/sysnec810/write.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

static volatile char *data = (char *)(0x20);
static volatile char *control = (char *)(0x24);

extern void _outb (volatile char*, unsigned char);
extern unsigned char _inb (volatile char*);

static unsigned char
 read_scc_reg (unsigned char n)
{
  _outb (control, n);
  return _inb(control);
}

static void write_scc_data (unsigned char n)
{
  _outb (data, n);
}

int
_write (int dev, void *buf, unsigned int len)
{
  int i;
  char *string = (char*)buf;

  for (i = 0; i < len; i++) 
    {
      int j;

      for (j = 0 ; j < 5000; j++)
	;
      write_scc_data (string[i]);

    }
  return len;
}