summaryrefslogtreecommitdiffstats
path: root/qemu/roms/SLOF/llfw/clib/iolib.c
blob: 7f14b512d5075d268562ae0ac63ab975a2fcfef1 (plain)
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
/******************************************************************************
 * Copyright (c) 2004, 2008 IBM Corporation
 * All rights reserved.
 * This program and the accompanying materials
 * are made available under the terms of the BSD License
 * which accompanies this distribution, and is available at
 * http://www.opensource.org/licenses/bsd-license.php
 *
 * Contributors:
 *     IBM Corporation - initial implementation
 *****************************************************************************/

#include <stdint.h>
#include <stddef.h>
#include <unistd.h>
#include "iolib.h"

void uart_send_byte(unsigned char b)
{
	asm volatile ("":::"3","4","5","6","7");
	io_putchar(b);
}

/**
 * Standard write function for the libc.
 *
 * @param fd	file descriptor (should always be 1 or 2)
 * @param buf	pointer to the array with the output characters
 * @param count	number of bytes to be written
 * @return	the number of bytes that have been written successfully
 */
ssize_t write(int fd, const void *buf, size_t count)
{
	size_t i;
	char *ptr = (char *)buf;

	if (fd != 1 && fd != 2)
		return 0;

	for (i = 0; i < count; i++) {
		if (*ptr == '\n')
			uart_send_byte('\r');
		uart_send_byte(*ptr++);
	}

	return i;
}