/*
* Copyright (C) 2001-2004 Jakub Jermar
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* - Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* - Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* - The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include <putchar.h>
#include <print.h>
#include <synch/spinlock.h>
#include <arch/arg.h>
#include <arch/asm.h>
#include <arch/fmath.h>
#include <arch.h>
static char digits[] = "0123456789abcdef"; /**< Hexadecimal characters */
static spinlock_t printflock; /**< printf spinlock */
#define DEFAULT_DOUBLE_PRECISION 16
#define DEFAULT_DOUBLE_BUFFER_SIZE 128
void print_double(double num, __u16 precision)
{
double intval,intval2;
int counter;
int exponent,exponenttmp;
unsigned char buf[DEFAULT_DOUBLE_BUFFER_SIZE];
unsigned long in1,in2;
/*
if (fmath_is_nan(num)) {
print_str("NaN");
return;
}
*/
if (fmath_is_negative(num)) {
}
num=fmath_abs(num);
/*
if (fmath_is_infinity(num)) {
print_str("Inf");
}
*/
//TODO: rounding constant - when we got fraction >= 0.5, we must increment last printed number
/* Here is problem with cumulative error while printing big double values -> we will divide
the number with a power of 10, print new number with better method for small numbers and then print decimal point at correct position */
fmath_fint(fmath_get_decimal_exponent(num),&intval);
exponent=(intval>0.0?intval:0);
precision+=exponent;
if (exponent>0) num = num / ((fmath_dpow(10.0,exponent)));
num=fmath_fint(num,&intval);
if (precision>0) {
counter=precision-1;
if (exponent>0) counter++;
if (counter>=DEFAULT_DOUBLE_BUFFER_SIZE) {
counter=DEFAULT_DOUBLE_BUFFER_SIZE;
}
exponenttmp=exponent;
while(counter>=0) {
num *= 10.0;
num = fmath_fint(num,&intval2);
buf[counter--]=((int)intval2)+'0';
exponenttmp--;
if ((exponenttmp==0)&&(counter>=0)) buf[counter--]='.';
}
counter=precision;
if ((exponent==0)&&(counter<DEFAULT_DOUBLE_BUFFER_SIZE)) buf[counter]='.';
counter++;
} else {
counter=0;
}
if (intval==0.0) {
if (counter<DEFAULT_DOUBLE_BUFFER_SIZE) buf[counter++]='0';
} else {
in1=intval;
while(( in1>0 )&&(counter<DEFAULT_DOUBLE_BUFFER_SIZE)) {
in2=in1;
in1/=10;
buf[counter]=in2-in1*10 + '0';
counter++;
}
}
counter = (counter>=DEFAULT_DOUBLE_BUFFER_SIZE?DEFAULT_DOUBLE_BUFFER_SIZE:counter);
while (counter>0) {
};
return;
}
/** Print NULL terminated string
*
* Print characters from str using putchar() until
* \x00 character is reached.
*
* @param str Characters to print.
*
*/
void print_str(const char *str)
{
int i = 0;
char c;
while (c = str[i++])
}
/** Print hexadecimal digits
*
* Print fixed count of hexadecimal digits from
* the number num. The digits are printed in
* natural left-to-right order starting with
* the width-th digit.
*
* @param num Number containing digits.
* @param width Count of digits to print.
*
*/
void print_fixed_hex(const __u64 num, const int width)
{
int i;
for (i = width*8 - 4; i >= 0; i -= 4)
}
/** Print number in given base
*
* Print significant digits of a number in given
* base.
*
* @param num Number to print.
* @param base Base to print the number in (should
* be in range 2 .. 16).
*
*/
void print_number(const __native num, const unsigned int base)
{
int val = num;
char d[sizeof(__native)*8+1]; /* this is good enough even for base == 2 */
int i = sizeof(__native)*8-1;
do {
d[i--] = digits[val % base];
} while (val /= base);
d[sizeof(__native)*8] = 0;
print_str(&d[i + 1]);
}
/** General formatted text print
*
* Print text formatted according the fmt parameter
* and variant arguments. Each formatting directive
* begins with % (percentage) character and one of the
* following character:
*
* % Prints the percentage character.
* s The next variant argument is treated as char*
* and printed as a NULL terminated string.
* c The next variant argument is treated as a single char.
* p The next variant argument is treated as a maximum
* bit-width integer with respect to architecture
* and printed in full hexadecimal width.
* P As with 'p', but '0x' is prefixed.
* q The next variant argument is treated as a 64b integer
* and printed in full hexadecimal width.
* Q As with 'q', but '0x' is prefixed.
* l The next variant argument is treated as a 32b integer
* and printed in full hexadecimal width.
* L As with 'l', but '0x' is prefixed.
* w The next variant argument is treated as a 16b integer
* and printed in full hexadecimal width.
* W As with 'w', but '0x' is prefixed.
* b The next variant argument is treated as a 8b integer
* and printed in full hexadecimal width.
* N As with 'b', but '0x' is prefixed.
* d The next variant argument is treated as integer
* and printed in standard decimal format (only significant
* digits).
* x The next variant argument is treated as integer
* and printed in standard hexadecimal format (only significant
* digits).
* X As with 'x', but '0x' is prefixed.
*
* All other characters from fmt except the formatting directives
* are printed in verbatim.
*
* @param fmt Formatting NULL terminated string.
*
*/
void printf(const char *fmt
, ...
) {
int irqpri, i = 0;
va_list ap;
char c;
irqpri = cpu_priority_high();
spinlock_lock(&printflock);
while (c = fmt[i++]) {
switch (c) {
/* control character */
case '%':
switch (c = fmt[i++]) {
/* percentile itself */
case '%':
break;
/*
* String and character conversions.
*/
case 's':
print_str
(va_arg(ap
, char_ptr
)); goto loop;
case 'c':
break;
/*
* Hexadecimal conversions with fixed width.
*/
case 'P':
print_str("0x");
case 'p':
print_fixed_hex
(va_arg(ap
, __native
), sizeof(__native
)); goto loop;
case 'Q':
print_str("0x");
case 'q':
print_fixed_hex
(va_arg(ap
, __u64
), INT64
); goto loop;
case 'L':
print_str("0x");
case 'l':
print_fixed_hex
(va_arg(ap
, __native
), INT32
); goto loop;
case 'W':
print_str("0x");
case 'w':
print_fixed_hex
(va_arg(ap
, __native
), INT16
); goto loop;
case 'B':
print_str("0x");
case 'b':
print_fixed_hex
(va_arg(ap
, __native
), INT8
); goto loop;
/*
* Floating point conversions.
*/
case 'F':
case 'f':
print_double
(va_arg(ap
, double),DEFAULT_DOUBLE_PRECISION
); goto loop;
/*
* Decimal and hexadecimal conversions.
*/
case 'd':
print_number
(va_arg(ap
, __native
), 10); goto loop;
case 'X':
print_str("0x");
case 'x':
print_number
(va_arg(ap
, __native
), 16); goto loop;
/*
* Bad formatting.
*/
default:
goto out;
}
}
loop:
;
}
out:
spinlock_unlock(&printflock);
cpu_priority_restore(irqpri);
}