You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
195 lines
3.9 KiB
195 lines
3.9 KiB
|
|
/*
|
|
* uart.c
|
|
*/
|
|
|
|
/*******************************************************/
|
|
/* printf²Ù×÷º¯Êý */
|
|
/*******************************************************/
|
|
#include <stdio.h>
|
|
|
|
#define SKYEYE 1
|
|
void uart_putc (const char c)
|
|
{
|
|
if (SKYEYE)
|
|
*(char *)0xd000 = c; /* write char to Transmit Buffer Register */
|
|
else
|
|
putc(c, stdout);
|
|
return;
|
|
}
|
|
|
|
void uart_puts (const char *s)
|
|
{
|
|
while (*s)
|
|
{
|
|
uart_putc (*s++);
|
|
}
|
|
return;
|
|
}
|
|
|
|
|
|
int my_strlen(char *str)
|
|
{
|
|
int i;
|
|
for(i = 0; str[i] != '\0'; i++);
|
|
return i;
|
|
}
|
|
char *myitoa(int n, int hex)
|
|
{
|
|
int num, i = 0, k = 0;
|
|
static char str[100];
|
|
char temp;
|
|
if(n < 0)
|
|
{
|
|
str[i++] = '-';
|
|
n = -1 * n;
|
|
}
|
|
do
|
|
{
|
|
num = n;
|
|
n = n / hex;
|
|
if (num%hex > 9)
|
|
str[i+k++] = 'a' + (num%hex - 0xa);
|
|
else
|
|
str[i + k++] = '0' + num % hex;
|
|
}while(n);
|
|
str[i + k] = '\0';
|
|
|
|
k = my_strlen(str) - 1;
|
|
|
|
for(;i < k; i++, k--)
|
|
{
|
|
temp = str[i];
|
|
str[i] = str[k];
|
|
str[k] = temp;
|
|
}
|
|
return str;
|
|
}
|
|
unsigned square(unsigned val, unsigned num){
|
|
int i;
|
|
unsigned ret = val;
|
|
for(i = 0; i < num - 1; i++){
|
|
ret = ret*val;
|
|
}
|
|
return ret;
|
|
}
|
|
char * ftoa(double val, int prec)
|
|
{
|
|
int sig = 0, index = 0, p, i, j;
|
|
static char s[100] = {'\0'};
|
|
char temp_ch;
|
|
long val_long, num;
|
|
double val_temp;
|
|
float v;
|
|
long val_float;
|
|
if(val < 0){
|
|
s[index++] = '-';
|
|
val_long = ((long)val) * -1;
|
|
val_temp = val * -1;
|
|
p = 1;
|
|
}else{
|
|
val_long = (long)val;
|
|
val_temp = val;
|
|
p = 0;
|
|
}
|
|
|
|
do
|
|
{
|
|
num = val_long;
|
|
val_long = val_long / 10;
|
|
s[index++] = '0' + num % 10;
|
|
}while(val_long);
|
|
for(i = p, j = index - 1; i < j; i++, j--){
|
|
temp_ch = s[i];
|
|
s[i] = s[j];
|
|
s[j] = temp_ch;
|
|
}
|
|
s[index++] = '.';
|
|
p = index;
|
|
v = (val_temp - (long)val_temp) * square(10, prec);
|
|
val_float = (long)v;
|
|
for(i = 0; i < prec; i++){
|
|
num = val_float;
|
|
val_float = val_float/10;
|
|
s[index++] = '0' + num % 10;
|
|
}
|
|
for(i = p, j = index - 1; i < j; i++, j--){
|
|
temp_ch = s[i];
|
|
s[i] = s[j];
|
|
s[j] = temp_ch;
|
|
}
|
|
s[index] = '\0';
|
|
return s;
|
|
}
|
|
|
|
void uart_printf(const char *format, ...)
|
|
{
|
|
va_list ap;
|
|
char c;
|
|
va_start(ap ,format);
|
|
while((c = *format++) > 0)
|
|
{
|
|
if(c == '%')
|
|
{
|
|
switch(c = *format++){
|
|
case 'c':{
|
|
char ch = va_arg(ap, int);
|
|
uart_putc(ch);
|
|
break;
|
|
}
|
|
case 's':{
|
|
char *p = va_arg(ap, char*);
|
|
uart_puts(p);
|
|
break;
|
|
}
|
|
case '%':
|
|
{
|
|
uart_putc(c);
|
|
break;
|
|
}
|
|
|
|
case 'd':
|
|
{
|
|
int num = va_arg(ap, int);
|
|
char *p = myitoa(num, 10);
|
|
uart_puts(p);
|
|
break;
|
|
}
|
|
case 'x':
|
|
{
|
|
int num = va_arg(ap, int);
|
|
char *p = myitoa(num, 16);
|
|
uart_puts(p);
|
|
break;
|
|
}
|
|
|
|
case 'f':
|
|
{
|
|
double fdata = va_arg(ap, double);
|
|
char *str = ftoa(fdata, 6);
|
|
uart_puts(str);
|
|
break;
|
|
}
|
|
default:
|
|
uart_putc(c);
|
|
break;
|
|
}
|
|
}
|
|
else if(c == '\\')
|
|
{
|
|
switch(c = *format++){
|
|
case 'n':{
|
|
uart_putc('\r');
|
|
break;
|
|
}
|
|
|
|
default:
|
|
uart_putc(c);
|
|
break;
|
|
}
|
|
}
|
|
else
|
|
uart_putc(c);
|
|
}
|
|
va_end(ap);
|
|
}
|