kservice.c 23.0 KB
Newer Older
1 2 3
/*
 * File      : kservice.c
 * This file is part of RT-Thread RTOS
D
dzzxzz 已提交
4
 * COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
5 6 7
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
B
bernard.xiong 已提交
8
 * http://www.rt-thread.org/license/LICENSE
9 10 11 12 13 14
 *
 * Change Logs:
 * Date           Author       Notes
 * 2006-03-16     Bernard      the first version
 * 2006-05-25     Bernard      rewrite vsprintf
 * 2006-08-10     Bernard      add rt_show_version
B
bernard.xiong 已提交
15 16
 * 2010-03-17     Bernard      remove rt_strlcpy function
 *                             fix gcc compiling issue.
17
 * 2010-04-15     Bernard      remove weak definition on ICCM16C compiler
18
 * 2012-07-18     Arda         add the alignment display for signed integer
19
 * 2012-11-23     Bernard      fix IAR compiler error. 
20 21 22 23 24
 */

#include <rtthread.h>
#include <rthw.h>

25 26 27
/* use precision */
#define RT_PRINTF_PRECISION

28 29 30
/**
 * @addtogroup KernelService
 */
D
dzzxzz 已提交
31

32 33
/*@{*/

D
dzzxzz 已提交
34
/* global errno in RT-Thread */
35
static volatile int _errno;
36

37
#if defined(RT_USING_DEVICE) && defined(RT_USING_CONSOLE)
B
bernard.xiong 已提交
38
static rt_device_t _console_device = RT_NULL;
39
#endif
40 41 42

/*
 * This function will get errno
B
bernard.xiong 已提交
43
 *
44 45 46 47 48
 * @return errno
 */
rt_err_t rt_get_errno(void)
{
	rt_thread_t tid;
B
bernard.xiong 已提交
49

D
dzzxzz 已提交
50
	if (rt_interrupt_get_nest() != 0)
51 52
	{
		/* it's in interrupt context */
53
		return _errno;
54
	}
55

56
	tid = rt_thread_self();
D
dzzxzz 已提交
57 58
	if (tid == RT_NULL)
		return _errno;
B
bernard.xiong 已提交
59

60 61
	return tid->error;
}
62
RTM_EXPORT(rt_get_errno);
63 64 65 66 67 68 69 70 71

/*
 * This function will set errno
 *
 * @param error the errno shall be set
 */
void rt_set_errno(rt_err_t error)
{
	rt_thread_t tid;
B
bernard.xiong 已提交
72

D
dzzxzz 已提交
73
	if (rt_interrupt_get_nest() != 0)
74 75
	{
		/* it's in interrupt context */
76
		_errno = error;
D
dzzxzz 已提交
77

78 79
		return;
	}
80

81
	tid = rt_thread_self();
D
dzzxzz 已提交
82 83 84 85 86 87
	if (tid == RT_NULL)
	{
		_errno = error;
		
		return;
	}
B
bernard.xiong 已提交
88

89 90
	tid->error = error;
}
91
RTM_EXPORT(rt_set_errno);
92

93 94 95 96 97 98 99 100 101
/**
 * This function returns errno.
 *
 * @return the errno in the system
 */
int *_rt_errno(void)
{
	rt_thread_t tid;
	
D
dzzxzz 已提交
102 103
	if (rt_interrupt_get_nest() != 0)
		return (int *)&_errno;
104 105

	tid = rt_thread_self();
D
dzzxzz 已提交
106 107
	if (tid != RT_NULL)
		return (int *)&(tid->error);
108 109 110

	return (int *)&_errno;
}
111
RTM_EXPORT(_rt_errno);
112

113 114 115 116 117 118 119 120 121
/**
 * This function will set the content of memory to specified value
 *
 * @param s the address of source memory
 * @param c the value shall be set in content
 * @param count the copied length
 *
 * @return the address of source memory
 */
D
dzzxzz 已提交
122
void *rt_memset(void *s, int c, rt_ubase_t count)
123 124
{
#ifdef RT_TINY_SIZE
D
dzzxzz 已提交
125
	char *xs = (char *)s;
126 127 128 129 130 131

	while (count--)
		*xs++ = c;

	return s;
#else
D
dzzxzz 已提交
132 133 134
#define LBLOCKSIZE      (sizeof(rt_int32_t))
#define UNALIGNED(X)    ((rt_int32_t)X & (LBLOCKSIZE - 1))
#define TOO_SMALL(LEN)  ((LEN) < LBLOCKSIZE)
135 136 137 138 139 140 141

	int i;
	char *m = (char *)s;
	rt_uint32_t buffer;
	rt_uint32_t *aligned_addr;
	rt_uint32_t d = c & 0xff;

D
dzzxzz 已提交
142
	if (!TOO_SMALL(count) && !UNALIGNED(s))
143 144
	{
		/* If we get this far, we know that n is large and m is word-aligned. */
D
dzzxzz 已提交
145
		aligned_addr = (rt_uint32_t *)s;
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167

		/* Store D into each char sized location in BUFFER so that
		 * we can set large blocks quickly.
		 */
		if (LBLOCKSIZE == 4)
		{
			buffer = (d << 8) | d;
			buffer |= (buffer << 16);
		}
		else
		{
			buffer = 0;
			for (i = 0; i < LBLOCKSIZE; i++)
				buffer = (buffer << 8) | d;
		}

		while (count >= LBLOCKSIZE*4)
		{
			*aligned_addr++ = buffer;
			*aligned_addr++ = buffer;
			*aligned_addr++ = buffer;
			*aligned_addr++ = buffer;
D
dzzxzz 已提交
168
			count -= 4 * LBLOCKSIZE;
169 170 171 172 173 174 175 176
		}

		while (count >= LBLOCKSIZE)
		{
			*aligned_addr++ = buffer;
			count -= LBLOCKSIZE;
		}

D
dzzxzz 已提交
177 178
		/* Pick up the remainder with a bytewise loop. */
		m = (char *)aligned_addr;
179 180 181 182 183 184 185 186 187 188 189 190 191 192
	}

	while (count--)
	{
		*m++ = (char)d;
	}

	return s;

#undef LBLOCKSIZE
#undef UNALIGNED
#undef TOO_SMALL
#endif
}
193
RTM_EXPORT(rt_memset);
194 195 196 197 198 199 200 201 202 203 204

/**
 * This function will copy memory content from source address to destination
 * address.
 *
 * @param dst the address of destination memory
 * @param src  the address of source memory
 * @param count the copied length
 *
 * @return the address of destination memory
 */
D
dzzxzz 已提交
205
void *rt_memcpy(void *dst, const void *src, rt_ubase_t count)
206 207
{
#ifdef RT_TINY_SIZE
D
dzzxzz 已提交
208
	char *tmp = (char *)dst, *s = (char *)src;
209 210 211 212 213 214 215 216

	while (count--)
		*tmp++ = *s++;

	return dst;
#else

#define UNALIGNED(X, Y) \
D
dzzxzz 已提交
217 218 219
	(((rt_int32_t)X & (sizeof(rt_int32_t) - 1)) | ((rt_int32_t)Y & (sizeof(rt_int32_t) - 1)))
#define BIGBLOCKSIZE    (sizeof(rt_int32_t) << 2)
#define LITTLEBLOCKSIZE (sizeof(rt_int32_t))
220 221
#define TOO_SMALL(LEN)  ((LEN) < BIGBLOCKSIZE)

D
dzzxzz 已提交
222 223
	char *dst_ptr = (char *)dst;
	char *src_ptr = (char *)src;
224 225 226 227 228
	rt_int32_t *aligned_dst;
	rt_int32_t *aligned_src;
	int len = count;

	/* If the size is small, or either SRC or DST is unaligned,
D
dzzxzz 已提交
229 230
	then punt into the byte copy loop.  This should be rare. */
	if (!TOO_SMALL(len) && !UNALIGNED(src_ptr, dst_ptr))
231
	{
D
dzzxzz 已提交
232 233
		aligned_dst = (rt_int32_t *)dst_ptr;
		aligned_src = (rt_int32_t *)src_ptr;
234

D
dzzxzz 已提交
235
		/* Copy 4X long words at a time if possible. */
236 237 238 239 240 241 242 243 244
		while (len >= BIGBLOCKSIZE)
		{
			*aligned_dst++ = *aligned_src++;
			*aligned_dst++ = *aligned_src++;
			*aligned_dst++ = *aligned_src++;
			*aligned_dst++ = *aligned_src++;
			len -= BIGBLOCKSIZE;
		}

D
dzzxzz 已提交
245
		/* Copy one long word at a time if possible. */
246 247 248 249 250 251
		while (len >= LITTLEBLOCKSIZE)
		{
			*aligned_dst++ = *aligned_src++;
			len -= LITTLEBLOCKSIZE;
		}

D
dzzxzz 已提交
252 253 254
		/* Pick up any residual with a byte copier. */
		dst_ptr = (char *)aligned_dst;
		src_ptr = (char *)aligned_src;
255 256 257 258 259 260 261 262 263 264 265 266
	}

	while (len--)
		*dst_ptr++ = *src_ptr++;

	return dst;
#undef UNALIGNED
#undef BIGBLOCKSIZE
#undef LITTLEBLOCKSIZE
#undef TOO_SMALL
#endif
}
267
RTM_EXPORT(rt_memcpy);
268 269 270 271 272 273 274 275 276 277 278

/**
 * This function will move memory content from source address to destination
 * address.
 *
 * @param dest the address of destination memory
 * @param src  the address of source memory
 * @param n the copied length
 *
 * @return the address of destination memory
 */
D
dzzxzz 已提交
279
void *rt_memmove(void *dest, const void *src, rt_ubase_t n)
280
{
D
dzzxzz 已提交
281
	char *tmp = (char *)dest, *s = (char *)src;
282 283 284

	if (s < tmp && tmp < s + n)
	{
D
dzzxzz 已提交
285 286
		tmp += n;
		s += n;
287 288

		while (n--)
289
			*(--tmp) = *(--s);
290 291 292 293 294 295 296 297 298
	}
	else
	{
		while (n--)
			*tmp++ = *s++;
	}

	return dest;
}
299
RTM_EXPORT(rt_memmove);
300 301

/**
D
dzzxzz 已提交
302 303 304 305 306 307 308
 * This function will compare two areas of memory
 *
 * @param cs one area of memory
 * @param ct znother area of memory
 * @param count the size of the area
 *
 * @return the result
309
 */
D
dzzxzz 已提交
310
rt_int32_t rt_memcmp(const void *cs, const void *ct, rt_ubase_t count)
311 312 313 314
{
	const unsigned char *su1, *su2;
	int res = 0;

D
dzzxzz 已提交
315
	for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
316 317
		if ((res = *su1 - *su2) != 0)
			break;
D
dzzxzz 已提交
318

319 320
	return res;
}
321
RTM_EXPORT(rt_memcmp);
322 323 324 325 326 327 328 329 330

/**
 * This function will return the first occurrence of a string.
 *
 * @param s1 the source string
 * @param s2 the find string
 *
 * @return the first occurrence of a s2 in s1, or RT_NULL if no found.
 */
D
dzzxzz 已提交
331
char *rt_strstr(const char *s1, const char *s2)
332 333 334 335 336
{
	int l1, l2;

	l2 = rt_strlen(s2);
	if (!l2)
D
dzzxzz 已提交
337
		return (char *)s1;
338 339 340
	l1 = rt_strlen(s1);
	while (l1 >= l2)
	{
D
dzzxzz 已提交
341 342 343 344
		l1 --;
		if (!rt_memcmp(s1, s2, l2))
			return (char *)s1;
		s1 ++;
345
	}
D
dzzxzz 已提交
346

347 348
	return RT_NULL;
}
349
RTM_EXPORT(rt_strstr);
350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375

/**
 * This function will compare two strings while ignoring differences in case
 *
 * @param a the string to be compared
 * @param b the string to be compared
 *
 * @return the result
 */
rt_uint32_t rt_strcasecmp(const char *a, const char *b)
{
	int ca, cb;

	do
	{
		ca = *a++ & 0xff;
		cb = *b++ & 0xff;
		if (ca >= 'A' && ca <= 'Z')
			ca += 'a' - 'A';
		if (cb >= 'A' && cb <= 'Z')
			cb += 'a' - 'A';
	}
	while (ca == cb && ca != '\0');

	return ca - cb;
}
376
RTM_EXPORT(rt_strcasecmp);
377 378 379 380

/**
 * This function will copy string no more than n bytes.
 *
381
 * @param dst the string to copy
382 383 384 385 386
 * @param src the string to be copied
 * @param n the maximum copied length
 *
 * @return the result
 */
387
char *rt_strncpy(char *dst, const char *src, rt_ubase_t n)
388
{
389 390 391 392
	if (n != 0)
	{
		char *d = dst;
		const char *s = src;
393

394 395 396 397 398 399
		do
		{
			if ((*d++ = *s++) == 0)
			{
				/* NUL pad the remaining n-1 bytes */
				while (--n != 0)
D
dzzxzz 已提交
400
					*d++ = 0;
401 402 403 404
				break;
			}
		} while (--n != 0);
	}
D
dzzxzz 已提交
405

406
	return (dst);
407
}
408
RTM_EXPORT(rt_strncpy);
409 410 411 412 413 414 415 416 417 418

/**
 * This function will compare two strings with specified maximum length
 *
 * @param cs the string to be compared
 * @param ct the string to be compared
 * @param count the maximum compare length
 *
 * @return the result
 */
D
dzzxzz 已提交
419
rt_ubase_t rt_strncmp(const char *cs, const char *ct, rt_ubase_t count)
420 421 422 423 424 425 426
{
	register signed char __res = 0;

	while (count)
	{
		if ((__res = *cs - *ct++) != 0 || !*cs++)
			break;
D
dzzxzz 已提交
427
		count --;
428 429 430 431
	}

	return __res;
}
432
RTM_EXPORT(rt_strncmp);
433

434 435 436 437 438 439 440 441
/**
 * This function will compare two strings without specified length
 *
 * @param cs the string to be compared
 * @param ct the string to be compared
 *
 * @return the result
 */
D
dzzxzz 已提交
442
rt_ubase_t rt_strcmp(const char *cs, const char *ct)
443 444 445
{
	while (*cs && *cs == *ct)
		cs++, ct++;
D
dzzxzz 已提交
446

447 448
	return (*cs - *ct);
}
449
RTM_EXPORT(rt_strcmp);
450

451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467
/**
 * This function will return the length of a string, which terminate will
 * null character.
 *
 * @param s the string
 *
 * @return the length of string
 */
rt_ubase_t rt_strlen(const char *s)
{
	const char *sc;

	for (sc = s; *sc != '\0'; ++sc) /* nothing */
		;

	return sc - s;
}
468
RTM_EXPORT(rt_strlen);
469 470 471 472 473 474 475 476 477 478 479 480 481 482

#ifdef RT_USING_HEAP
/**
 * This function will duplicate a string.
 *
 * @param s the string to be duplicated
 *
 * @return the duplicated string pointer
 */
char *rt_strdup(const char *s)
{
	rt_size_t len = rt_strlen(s) + 1;
	char *tmp = (char *)rt_malloc(len);

D
dzzxzz 已提交
483 484
	if (!tmp)
		return RT_NULL;
485 486

	rt_memcpy(tmp, s, len);
D
dzzxzz 已提交
487

488 489
	return tmp;
}
490
RTM_EXPORT(rt_strdup);
491 492 493 494 495
#endif

/**
 * This function will show the version of rt-thread rtos
 */
D
dzzxzz 已提交
496
void rt_show_version(void)
497 498
{
	rt_kprintf("\n \\ | /\n");
G
 
gary.li.wenchao.4 已提交
499
	rt_kprintf("- RT -     Thread Operating System\n");
wuyangyong's avatar
 
wuyangyong 已提交
500
	rt_kprintf(" / | \\     %d.%d.%d build %s\n", RT_VERSION, RT_SUBVERSION, RT_REVISION, __DATE__);
D
dzzxzz 已提交
501
	rt_kprintf(" 2006 - 2012 Copyright by rt-thread team\n");
502
}
503
RTM_EXPORT(rt_show_version);
504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529

/* private function */
#define isdigit(c)  ((unsigned)((c) - '0') < 10)

rt_inline rt_int32_t divide(rt_int32_t *n, rt_int32_t base)
{
	rt_int32_t res;

	/* optimized for processor which does not support divide instructions. */
	if (base == 10)
	{
		res = ((rt_uint32_t)*n) % 10U;
		*n = ((rt_uint32_t)*n) / 10U;
	}
	else
	{
		res = ((rt_uint32_t)*n) % 16U;
		*n = ((rt_uint32_t)*n) / 16U;
	}

	return res;
}

rt_inline int skip_atoi(const char **s)
{
	register int i=0;
D
dzzxzz 已提交
530 531
	while (isdigit(**s))
		i = i * 10 + *((*s)++) - '0';
532 533 534 535

	return i;
}

D
dzzxzz 已提交
536 537 538 539 540 541 542
#define ZEROPAD     (1 << 0)	/* pad with zero */
#define SIGN        (1 << 1)	/* unsigned/signed long */
#define PLUS        (1 << 2)	/* show plus */
#define SPACE       (1 << 3)	/* space if plus */
#define LEFT        (1 << 4)	/* left justified */
#define SPECIAL     (1 << 5)	/* 0x */
#define LARGE       (1 << 6)	/* use 'ABCDEF' instead of 'abcdef' */
543 544

#ifdef RT_PRINTF_PRECISION
D
dzzxzz 已提交
545
static char *print_number(char *buf, char *end, long num, int base, int s, int precision, int type)
546
#else
D
dzzxzz 已提交
547
static char *print_number(char *buf, char *end, long num, int base, int s, int type)
548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564
#endif
{
	char c, sign;
#ifdef RT_PRINTF_LONGLONG
	char tmp[32];
#else
	char tmp[16];
#endif
	const char *digits;
	static const char small_digits[] = "0123456789abcdef";
	static const char large_digits[] = "0123456789ABCDEF";
	register int i;
	register int size;

	size = s;

	digits = (type & LARGE) ? large_digits : small_digits;
D
dzzxzz 已提交
565 566
	if (type & LEFT)
		type &= ~ZEROPAD;
567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591

	c = (type & ZEROPAD) ? '0' : ' ';

	/* get sign */
	sign = 0;
	if (type & SIGN)
	{
		if (num < 0)
		{
			sign = '-';
			num = -num;
		}
		else if (type & PLUS) sign = '+';
		else if (type & SPACE) sign = ' ';
	}

#ifdef RT_PRINTF_SPECIAL
	if (type & SPECIAL)
	{
		if (base == 16) size -= 2;
		else if (base == 8) size--;
	}
#endif

	i = 0;
D
dzzxzz 已提交
592 593
	if (num == 0)
		tmp[i++]='0';
594 595
	else
	{
D
dzzxzz 已提交
596 597
		while (num != 0)
			tmp[i++] = digits[divide(&num, base)];
598 599 600
	}

#ifdef RT_PRINTF_PRECISION
D
dzzxzz 已提交
601 602
	if (i > precision)
		precision = i;
603 604 605 606 607 608 609
	size -= precision;
#else
	size -= i;
#endif

	if (!(type&(ZEROPAD | LEFT)))
	{
610 611 612
		if ((sign)&&(size>0))
			size--;

D
dzzxzz 已提交
613
		while (size-->0)
614
		{
D
dzzxzz 已提交
615 616
			if (buf <= end)
				*buf = ' ';
D
dzzxzz 已提交
617
			++ buf;
618 619 620 621 622 623 624 625
		}
	}

	if (sign)
	{
		if (buf <= end)
		{
			*buf = sign;
D
dzzxzz 已提交
626
			-- size;
627
		}
D
dzzxzz 已提交
628
		++ buf;
629 630 631 632 633 634 635
	}

#ifdef RT_PRINTF_SPECIAL
	if (type & SPECIAL)
	{
		if (base==8)
		{
D
dzzxzz 已提交
636 637
			if (buf <= end)
				*buf = '0';
D
dzzxzz 已提交
638
			++ buf;
639
		}
D
dzzxzz 已提交
640
		else if (base == 16)
641
		{
D
dzzxzz 已提交
642 643
			if (buf <= end)
				*buf = '0';
D
dzzxzz 已提交
644
			++ buf;
645 646 647 648
			if (buf <= end)
			{
				*buf = type & LARGE? 'X' : 'x';
			}
D
dzzxzz 已提交
649
			++ buf;
650 651 652 653 654 655 656 657 658
		}
	}
#endif

	/* no align to the left */
	if (!(type & LEFT))
	{
		while (size-- > 0)
		{
D
dzzxzz 已提交
659 660
			if (buf <= end)
				*buf = c;
D
dzzxzz 已提交
661
			++ buf;
662 663 664 665 666 667
		}
	}

#ifdef RT_PRINTF_PRECISION
	while (i < precision--)
	{
D
dzzxzz 已提交
668 669
		if (buf <= end)
			*buf = '0';
D
dzzxzz 已提交
670
		++ buf;
671 672 673 674 675 676
	}
#endif

	/* put number in the temporary buffer */
	while (i-- > 0)
	{
D
dzzxzz 已提交
677 678
		if (buf <= end)
			*buf = tmp[i];
D
dzzxzz 已提交
679
		++ buf;
680 681 682 683
	}

	while (size-- > 0)
	{
D
dzzxzz 已提交
684 685
		if (buf <= end)
			*buf = ' ';
D
dzzxzz 已提交
686
		++ buf;
687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705
	}

	return buf;
}

static rt_int32_t vsnprintf(char *buf, rt_size_t size, const char *fmt, va_list args)
{
#ifdef RT_PRINTF_LONGLONG
	unsigned long long num;
#else
	rt_uint32_t num;
#endif
	int i, len;
	char *str, *end, c;
	const char *s;

	rt_uint8_t base;			/* the base of number */
	rt_uint8_t flags;			/* flags to print number */
	rt_uint8_t qualifier;		/* 'h', 'l', or 'L' for integer fields */
D
dzzxzz 已提交
706
	rt_int32_t field_width;		/* width of output field */
707 708 709 710 711 712 713 714 715

#ifdef RT_PRINTF_PRECISION
	int precision;		/* min. # of digits for integers and max for a string */
#endif

	str = buf;
	end = buf + size - 1;

	/* Make sure end is always >= buf */
B
bernard.xiong 已提交
716
	if (end < buf)
717 718 719 720
	{
		end = ((char *)-1);
		size = end - buf;
	}
B
bernard.xiong 已提交
721

722 723 724 725
	for (; *fmt ; ++fmt)
	{
		if (*fmt != '%')
		{
D
dzzxzz 已提交
726 727
			if (str <= end)
				*str = *fmt;
D
dzzxzz 已提交
728
			++ str;
729 730 731 732 733 734
			continue;
		}

		/* process flags */
		flags = 0;

D
dzzxzz 已提交
735
		while (1)
736 737
		{
			/* skips the first '%' also */
D
dzzxzz 已提交
738
			++ fmt;
739 740 741 742 743 744 745 746 747 748 749 750 751
			if (*fmt == '-') flags |= LEFT;
			else if (*fmt == '+') flags |= PLUS;
			else if (*fmt == ' ') flags |= SPACE;
			else if (*fmt == '#') flags |= SPECIAL;
			else if (*fmt == '0') flags |= ZEROPAD;
			else break;
		}

		/* get field width */
		field_width = -1;
		if (isdigit(*fmt)) field_width = skip_atoi(&fmt);
		else if (*fmt == '*')
		{
D
dzzxzz 已提交
752
			++ fmt;
753 754 755 756 757 758 759 760 761 762 763 764 765 766
			/* it's the next argument */
			field_width = va_arg(args, int);
			if (field_width < 0)
			{
				field_width = -field_width;
				flags |= LEFT;
			}
		}

#ifdef RT_PRINTF_PRECISION
		/* get the precision */
		precision = -1;
		if (*fmt == '.')
		{
D
dzzxzz 已提交
767
			++ fmt;
768 769 770
			if (isdigit(*fmt)) precision = skip_atoi(&fmt);
			else if (*fmt == '*')
			{
D
dzzxzz 已提交
771
				++ fmt;
772 773 774 775 776 777 778 779 780
				/* it's the next argument */
				precision = va_arg(args, int);
			}
			if (precision < 0) precision = 0;
		}
#endif
		/* get the conversion qualifier */
		qualifier = 0;
#ifdef RT_PRINTF_LONGLONG
781 782 783
		if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L')
#else
		if (*fmt == 'h' || *fmt == 'l')
784 785 786
#endif
		{
			qualifier = *fmt;
D
dzzxzz 已提交
787
			++ fmt;
788 789 790 791
#ifdef RT_PRINTF_LONGLONG
			if (qualifier == 'l' && *fmt == 'l')
			{
				qualifier = 'L';
D
dzzxzz 已提交
792
				++ fmt;
793 794 795 796 797 798 799 800 801 802 803 804 805 806 807
			}
#endif
		}

		/* the default base */
		base = 10;

		switch (*fmt)
		{
		case 'c':
			if (!(flags & LEFT))
			{
				while (--field_width > 0)
				{
					if (str <= end) *str = ' ';
D
dzzxzz 已提交
808
					++ str;
809 810 811 812
				}
			}

			/* get character */
D
dzzxzz 已提交
813
			c = (rt_uint8_t)va_arg(args, int);
814
			if (str <= end) *str = c;
D
dzzxzz 已提交
815
			++ str;
816 817 818 819 820

			/* put width */
			while (--field_width > 0)
			{
				if (str <= end) *str = ' ';
D
dzzxzz 已提交
821
				++ str;
822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838
			}
			continue;

		case 's':
			s = va_arg(args, char *);
			if (!s) s = "(NULL)";

			len = rt_strlen(s);
#ifdef RT_PRINTF_PRECISION
			if (precision > 0 && len > precision) len = precision;
#endif

			if (!(flags & LEFT))
			{
				while (len < field_width--)
				{
					if (str <= end) *str = ' ';
D
dzzxzz 已提交
839
					++ str;
840 841 842 843 844 845
				}
			}

			for (i = 0; i < len; ++i)
			{
				if (str <= end) *str = *s;
D
dzzxzz 已提交
846 847
				++ str;
				++ s;
848 849 850 851 852
			}

			while (len < field_width--)
			{
				if (str <= end) *str = ' ';
D
dzzxzz 已提交
853
				++ str;
854 855 856 857 858 859 860 861 862 863 864
			}
			continue;

		case 'p':
			if (field_width == -1)
			{
				field_width = sizeof(void *) << 1;
				flags |= ZEROPAD;
			}
#ifdef RT_PRINTF_PRECISION
			str = print_number(str, end,
D
dzzxzz 已提交
865
							   (long)va_arg(args, void *),
866 867 868
							   16, field_width, precision, flags);
#else
			str = print_number(str, end,
D
dzzxzz 已提交
869
							   (long)va_arg(args, void *),
870 871 872 873 874 875
							   16, field_width, flags);
#endif
			continue;

		case '%':
			if (str <= end) *str = '%';
D
dzzxzz 已提交
876
			++ str;
877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897
			continue;

			/* integer number formats - set up the flags and "break" */
		case 'o':
			base = 8;
			break;

		case 'X':
			flags |= LARGE;
		case 'x':
			base = 16;
			break;

		case 'd':
		case 'i':
			flags |= SIGN;
		case 'u':
			break;

		default:
			if (str <= end) *str = '%';
D
dzzxzz 已提交
898
			++ str;
899 900 901 902

			if (*fmt)
			{
				if (str <= end) *str = *fmt;
D
dzzxzz 已提交
903
				++ str;
904 905 906
			}
			else
			{
D
dzzxzz 已提交
907
				-- fmt;
908 909 910 911 912 913 914 915 916 917 918 919
			}
			continue;
		}

#ifdef RT_PRINTF_LONGLONG
		if (qualifier == 'L') num = va_arg(args, long long);
		else if (qualifier == 'l')
#else
		if (qualifier == 'l')
#endif
		{
			num = va_arg(args, rt_uint32_t);
D
dzzxzz 已提交
920
			if (flags & SIGN) num = (rt_int32_t)num;
921 922 923
		}
		else if (qualifier == 'h')
		{
D
dzzxzz 已提交
924 925
			num = (rt_uint16_t)va_arg(args, rt_int32_t);
			if (flags & SIGN) num = (rt_int16_t)num;
926 927 928 929
		}
		else
		{
			num = va_arg(args, rt_uint32_t);
D
dzzxzz 已提交
930
			if (flags & SIGN) num = (rt_int32_t)num;
931 932 933 934 935 936 937 938 939 940 941 942 943 944
		}
#ifdef RT_PRINTF_PRECISION
		str = print_number(str, end, num, base, field_width, precision, flags);
#else
		str = print_number(str, end, num, base, field_width, flags);
#endif
	}

	if (str <= end) *str = '\0';
	else *end = '\0';

	/* the trailing null byte doesn't count towards the total
	* ++str;
	*/
D
dzzxzz 已提交
945
	return str - buf;
946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965
}

/**
 * This function will fill a formatted string to buffer
 *
 * @param buf the buffer to save formatted string
 * @param size the size of buffer
 * @param fmt the format
 */
rt_int32_t rt_snprintf(char *buf, rt_size_t size, const char *fmt, ...)
{
	rt_int32_t n;
	va_list args;

	va_start(args, fmt);
	n = vsnprintf(buf, size, fmt, args);
	va_end(args);

	return n;
}
966
RTM_EXPORT(rt_snprintf);
967 968 969 970 971

/**
 * This function will fill a formatted string to buffer
 *
 * @param buf the buffer to save formatted string
B
bernard.xiong 已提交
972
 * @param arg_ptr the arg_ptr
973 974 975 976 977 978
 * @param format the format
 */
rt_int32_t rt_vsprintf(char *buf, const char *format, va_list arg_ptr)
{
	return vsnprintf(buf, (rt_size_t) -1, format, arg_ptr);
}
979
RTM_EXPORT(rt_vsprintf);
980 981 982 983 984 985 986

/**
 * This function will fill a formatted string to buffer
 *
 * @param buf the buffer to save formatted string
 * @param format the format
 */
D
dzzxzz 已提交
987
rt_int32_t rt_sprintf(char *buf, const char *format, ...)
988 989 990
{
	rt_int32_t n;
	va_list arg_ptr;
B
bernard.xiong 已提交
991

992
	va_start(arg_ptr, format);
D
dzzxzz 已提交
993 994
	n = rt_vsprintf(buf ,format, arg_ptr);
	va_end(arg_ptr);
B
bernard.xiong 已提交
995

996 997
	return n;
}
998
RTM_EXPORT(rt_sprintf);
B
bernard.xiong 已提交
999

1000 1001
#ifdef RT_USING_CONSOLE

1002
#ifdef RT_USING_DEVICE
1003 1004 1005 1006 1007 1008 1009 1010 1011
/**
 * This function returns the device using in console.
 *
 * @return the device using in console or RT_NULL
 */
rt_device_t rt_console_get_device(void)
{
	return _console_device;
}
1012
RTM_EXPORT(rt_console_get_device);
1013

1014
/**
B
bernard.xiong@gmail.com 已提交
1015
 * This function will set a device as console device.
1016
 * After set a device to console, all output of rt_kprintf will be
B
bernard.xiong@gmail.com 已提交
1017
 * redirected to this new device.
1018
 *
B
bernard.xiong@gmail.com 已提交
1019
 * @param name the name of new console device
1020
 *
B
bernard.xiong@gmail.com 已提交
1021
 * @return the old console device handler
1022
 */
D
dzzxzz 已提交
1023
rt_device_t rt_console_set_device(const char *name)
1024 1025 1026 1027 1028
{
	rt_device_t new, old;

	/* save old device */
	old = _console_device;
1029

1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045
	/* find new console device */
	new = rt_device_find(name);
	if (new != RT_NULL)
	{
		if (_console_device != RT_NULL)
		{
			/* close old console device */
			rt_device_close(_console_device);
		}

		/* set new console device */
		_console_device = new;
		rt_device_open(_console_device, RT_DEVICE_OFLAG_RDWR);
	}

	return old;
B
bernard.xiong 已提交
1046
}
1047
RTM_EXPORT(rt_console_set_device);
1048
#endif
1049

1050
#if defined(__GNUC__) || defined(__ADSPBLACKFIN__)
D
dzzxzz 已提交
1051 1052
void rt_hw_console_output(const char *str) __attribute__((weak));
void rt_hw_console_output(const char *str)
B
bernard.xiong 已提交
1053
#elif defined(__CC_ARM)
D
dzzxzz 已提交
1054
__weak void rt_hw_console_output(const char *str)
1055
#elif defined(__IAR_SYSTEMS_ICC__)
1056 1057 1058
    #if __VER__ > 540
    __weak
    #endif
1059
void rt_hw_console_output(const char *str)
1060
#else
D
dzzxzz 已提交
1061
void rt_hw_console_output(const char *str)
1062 1063
#endif
{
D
dzzxzz 已提交
1064
	/* empty console output */
1065
}
1066
RTM_EXPORT(rt_hw_console_output);
1067 1068 1069 1070 1071 1072 1073 1074 1075

/**
 * This function will print a formatted string on system console
 *
 * @param fmt the format
 */
void rt_kprintf(const char *fmt, ...)
{
	va_list args;
B
bernard.xiong 已提交
1076 1077
	rt_size_t length;
	static char rt_log_buf[RT_CONSOLEBUF_SIZE];
1078

1079
	va_start(args, fmt);
1080
	length = vsnprintf(rt_log_buf, sizeof(rt_log_buf), fmt, args);
1081
#ifdef RT_USING_DEVICE
1082 1083
	if (_console_device == RT_NULL)
	{
D
dzzxzz 已提交
1084
		rt_hw_console_output(rt_log_buf);
B
bernard.xiong 已提交
1085 1086 1087 1088
	}
	else
	{
		rt_device_write(_console_device, 0, rt_log_buf, length);
1089
	}
1090 1091 1092
#else
	rt_hw_console_output(rt_log_buf);
#endif
1093 1094
	va_end(args);
}
1095
RTM_EXPORT(rt_kprintf);
1096 1097 1098 1099
#else
void rt_kprintf(const char *fmt, ...)
{
}
1100 1101
RTM_EXPORT(rt_kprintf);

1102
#endif
1103

1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145
#ifdef RT_USING_HEAP
/**
 * This function allocates a memory block, which address is aligned to the
 * specified alignment size.
 *
 * @param size the allocated memory block size
 * @param align the alignment size
 *
 * @return the allocated memory block on successful, otherwise returns RT_NULL
 */
void* rt_malloc_align(rt_size_t size, rt_size_t align)
{
	void *align_ptr;
	void *ptr;
	rt_size_t align_size;

	/* align the alignment size to 4 byte */
	align = ((align + 0x03) & ~0x03);

	/* get total aligned size */
	align_size = ((size + 0x03) & ~0x03) + align;
	/* allocate memory block from heap */
	ptr = rt_malloc(align_size);
	if (ptr != RT_NULL)
	{
		if (((rt_uint32_t)ptr & (align - 1)) == 0) /* the allocated memory block is aligned */
		{
			align_ptr = (void*) ((rt_uint32_t)ptr + align);
		}
		else
		{
			align_ptr = (void*) (((rt_uint32_t)ptr + (align - 1)) & ~(align - 1));
		}

		/* set the pointer before alignment pointer to the real pointer */
		*((rt_uint32_t*)((rt_uint32_t)align_ptr - sizeof(void*))) = (rt_uint32_t)ptr;

		ptr = align_ptr;
	}

	return ptr;
}
1146
RTM_EXPORT(rt_malloc_align);
1147 1148 1149 1150 1151 1152 1153

/**
 * This function release the memory block, which is allocated by rt_malloc_align
 * function and address is aligned.
 *
 * @param ptr the memory block pointer
 */
D
dzzxzz 已提交
1154
void rt_free_align(void *ptr)
1155
{
D
dzzxzz 已提交
1156
	void *real_ptr;
1157 1158 1159 1160

	real_ptr = (void*)*(rt_uint32_t*)((rt_uint32_t)ptr - sizeof(void*));
	rt_free(real_ptr);
}
1161
RTM_EXPORT(rt_free_align);
1162 1163
#endif

1164 1165
#if !defined (RT_USING_NEWLIB) && defined (RT_USING_MINILIBC) && defined (__GNUC__)
#include <sys/types.h>
D
dzzxzz 已提交
1166 1167 1168
void *memcpy(void *dest, const void *src, size_t n) __attribute__((weak, alias("rt_memcpy")));
void *memset(void *s, int c, size_t n) __attribute__((weak, alias("rt_memset")));
void *memmove(void *dest, const void *src, size_t n) __attribute__((weak, alias("rt_memmove")));
1169 1170 1171
int   memcmp(const void *s1, const void *s2, size_t n) __attribute__((weak, alias("rt_memcmp")));

size_t strlen(const char *s) __attribute__((weak, alias("rt_strlen")));
G
 
gary.li.wenchao.4 已提交
1172
char *strstr(const char *s1,const char *s2) __attribute__((weak, alias("rt_strstr")));
1173 1174
int strcasecmp(const char *a, const char *b) __attribute__((weak, alias("rt_strcasecmp")));
char *strncpy(char *dest, const char *src, size_t n) __attribute__((weak, alias("rt_strncpy")));
G
 
gary.li.wenchao.4 已提交
1175
int strncmp(const char *cs, const char *ct, size_t count) __attribute__((weak, alias("rt_strncmp")));
1176
#ifdef RT_USING_HEAP
G
 
gary.li.wenchao.4 已提交
1177
char *strdup(const char *s) __attribute__((weak, alias("rt_strdup")));
1178
#endif
1179

D
dzzxzz 已提交
1180
int sprintf(char *buf, const char *format, ...) __attribute__((weak, alias("rt_sprintf")));
1181 1182 1183
int snprintf(char *buf, rt_size_t size, const char *fmt, ...) __attribute__((weak, alias("rt_snprintf")));
int vsprintf(char *buf, const char *format, va_list arg_ptr) __attribute__((weak, alias("rt_vsprintf")));

1184 1185 1186
#endif

/*@}*/