blob: 9d202f4c3eef161a8eca0316e9396e70d73a424a (
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
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
|
/******************************************************************************
* Copyright (c) 2004, 2007 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 "types.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;
}
/**
* @brief C-routine to delay for a number of milliseconds.
* @param delay interval in terms of ms
*/
void delay_ms( unsigned int ms )
{
uint32_t ticks_per_ms;
ticks_per_ms = tb_frequency() / 1000;
while (0 < ms) {
set_dec(ticks_per_ms);
while( ((get_dec()) & 0x80000000) == 0 );
ms--;
}
}
|
