ossc/software/sys_controller_bsp/HAL/src/alt_printf.c
2016-02-23 01:03:50 +02:00

133 lines
5.1 KiB
C

/******************************************************************************
* *
* License Agreement *
* *
* Copyright (c) 2015 Altera Corporation, San Jose, California, USA. *
* All rights reserved. *
* *
* Permission is hereby granted, free of charge, to any person obtaining a *
* copy of this software and associated documentation files (the "Software"), *
* to deal in the Software without restriction, including without limitation *
* the rights to use, copy, modify, merge, publish, distribute, sublicense, *
* and/or sell copies of the Software, and to permit persons to whom the *
* Software is furnished to do so, subject to the following conditions: *
* *
* The above copyright notice and this permission notice shall be included in *
* all copies or substantial portions of the Software. *
* *
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR *
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, *
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE *
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER *
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING *
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER *
* DEALINGS IN THE SOFTWARE. *
* *
* This agreement shall be governed in all respects by the laws of the State *
* of California and by the laws of the United States of America. *
* *
* Altera does not recommend, suggest or require that this reference design *
* file be used in conjunction or combination with any other product. *
******************************************************************************/
/*
* This file provides a very minimal printf implementation for use with very
* small applications. Only the following format strings are supported:
* %x
* %s
* %c
* %%
*/
#include <stdarg.h>
#include "sys/alt_stdio.h"
#ifdef ALT_SEMIHOSTING
#define alt_putchar(x) alt_putcharbuf(x)
#endif
/*
* ALT printf function
*/
void
alt_printf(const char* fmt, ... )
{
va_list args;
va_start(args, fmt);
const char *w;
char c;
/* Process format string. */
w = fmt;
while ((c = *w++) != 0)
{
/* If not a format escape character, just print */
/* character. Otherwise, process format string. */
if (c != '%')
{
alt_putchar(c);
}
else
{
/* Get format character. If none */
/* available, processing is complete. */
if ((c = *w++) != 0)
{
if (c == '%')
{
/* Process "%" escape sequence. */
alt_putchar(c);
}
else if (c == 'c')
{
int v = va_arg(args, int);
alt_putchar(v);
}
else if (c == 'x')
{
/* Process hexadecimal number format. */
unsigned long v = va_arg(args, unsigned long);
unsigned long digit;
int digit_shift;
/* If the number value is zero, just print and continue. */
if (v == 0)
{
alt_putchar('0');
continue;
}
/* Find first non-zero digit. */
digit_shift = 28;
while (!(v & (0xF << digit_shift)))
digit_shift -= 4;
/* Print digits. */
for (; digit_shift >= 0; digit_shift -= 4)
{
digit = (v & (0xF << digit_shift)) >> digit_shift;
if (digit <= 9)
c = '0' + digit;
else
c = 'a' + digit - 10;
alt_putchar(c);
}
}
else if (c == 's')
{
/* Process string format. */
char *s = va_arg(args, char *);
while(*s)
alt_putchar(*s++);
}
}
else
{
break;
}
}
}
#ifdef ALT_SEMIHOSTING
alt_putbufflush();
#endif
}