2009-07-03 06:48:23 +08:00
|
|
|
/*
|
|
|
|
* File : kservice.c
|
|
|
|
* This file is part of RT-Thread RTOS
|
2011-09-21 11:56:42 +08:00
|
|
|
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
2009-07-03 06:48:23 +08:00
|
|
|
*
|
|
|
|
* The license and distribution terms for this file may be
|
|
|
|
* found in the file LICENSE in this distribution or at
|
2009-12-25 20:18:53 +08:00
|
|
|
* http://www.rt-thread.org/license/LICENSE
|
2009-07-03 06:48:23 +08:00
|
|
|
*
|
|
|
|
* 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
|
2010-03-17 12:19:17 +08:00
|
|
|
* 2010-03-17 Bernard remove rt_strlcpy function
|
|
|
|
* fix gcc compiling issue.
|
2010-04-15 10:51:20 +08:00
|
|
|
* 2010-04-15 Bernard remove weak definition on ICCM16C compiler
|
2009-07-03 06:48:23 +08:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <rtthread.h>
|
|
|
|
#include <rthw.h>
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @addtogroup KernelService
|
|
|
|
*/
|
|
|
|
/*@{*/
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
/* global errno in RT-Thread */
|
2011-08-28 23:57:10 +08:00
|
|
|
static volatile int _errno;
|
2011-09-25 10:33:51 +08:00
|
|
|
|
2011-03-12 08:08:47 +08:00
|
|
|
#if defined(RT_USING_DEVICE) && defined(RT_USING_CONSOLE)
|
2010-03-17 12:19:17 +08:00
|
|
|
static rt_device_t _console_device = RT_NULL;
|
2011-01-24 21:40:42 +08:00
|
|
|
#endif
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* This function will get errno
|
2009-12-25 20:18:53 +08:00
|
|
|
*
|
2009-07-03 06:48:23 +08:00
|
|
|
* @return errno
|
|
|
|
*/
|
|
|
|
rt_err_t rt_get_errno(void)
|
|
|
|
{
|
|
|
|
rt_thread_t tid;
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
if (rt_interrupt_get_nest() != 0)
|
2011-06-29 22:45:35 +08:00
|
|
|
{
|
|
|
|
/* it's in interrupt context */
|
2011-08-28 23:57:10 +08:00
|
|
|
return _errno;
|
2011-06-29 22:45:35 +08:00
|
|
|
}
|
2011-06-12 18:01:48 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
tid = rt_thread_self();
|
2011-08-28 23:57:10 +08:00
|
|
|
if (tid == RT_NULL) return _errno;
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
return tid->error;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This function will set errno
|
|
|
|
*
|
|
|
|
* @param error the errno shall be set
|
|
|
|
*/
|
|
|
|
void rt_set_errno(rt_err_t error)
|
|
|
|
{
|
|
|
|
rt_thread_t tid;
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
if (rt_interrupt_get_nest() != 0)
|
2011-06-29 22:45:35 +08:00
|
|
|
{
|
|
|
|
/* it's in interrupt context */
|
2011-08-28 23:57:10 +08:00
|
|
|
_errno = error;
|
2011-06-29 22:45:35 +08:00
|
|
|
return;
|
|
|
|
}
|
2011-06-12 18:01:48 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
tid = rt_thread_self();
|
2011-08-28 23:57:10 +08:00
|
|
|
if (tid == RT_NULL) { _errno = error; return; }
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
tid->error = error;
|
|
|
|
}
|
|
|
|
|
2011-08-28 23:57:10 +08:00
|
|
|
/**
|
|
|
|
* This function returns errno.
|
|
|
|
*
|
|
|
|
* @return the errno in the system
|
|
|
|
*/
|
|
|
|
int *_rt_errno(void)
|
|
|
|
{
|
|
|
|
rt_thread_t tid;
|
|
|
|
|
|
|
|
if (rt_interrupt_get_nest() != 0) return (int *)&_errno;
|
|
|
|
|
|
|
|
tid = rt_thread_self();
|
|
|
|
if (tid != RT_NULL) return (int *)&(tid->error);
|
|
|
|
|
|
|
|
return (int *)&_errno;
|
|
|
|
}
|
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
/**
|
|
|
|
* 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
|
|
|
|
*
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
void *rt_memset(void *s, int c, rt_ubase_t count)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
#ifdef RT_TINY_SIZE
|
2011-09-21 11:56:42 +08:00
|
|
|
char *xs = (char *)s;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
while (count--)
|
|
|
|
*xs++ = c;
|
|
|
|
|
|
|
|
return s;
|
|
|
|
#else
|
2011-09-21 11:56:42 +08:00
|
|
|
#define LBLOCKSIZE (sizeof(rt_int32_t))
|
|
|
|
#define UNALIGNED(X) ((rt_int32_t)X & (LBLOCKSIZE - 1))
|
|
|
|
#define TOO_SMALL(LEN) ((LEN) < LBLOCKSIZE)
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
int i;
|
|
|
|
char *m = (char *)s;
|
|
|
|
rt_uint32_t buffer;
|
|
|
|
rt_uint32_t *aligned_addr;
|
|
|
|
rt_uint32_t d = c & 0xff;
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
if (!TOO_SMALL(count) && !UNALIGNED(s))
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
/* If we get this far, we know that n is large and m is word-aligned. */
|
2011-09-21 11:56:42 +08:00
|
|
|
aligned_addr = (rt_uint32_t *)s;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
/* 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;
|
|
|
|
count -= 4*LBLOCKSIZE;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (count >= LBLOCKSIZE)
|
|
|
|
{
|
|
|
|
*aligned_addr++ = buffer;
|
|
|
|
count -= LBLOCKSIZE;
|
|
|
|
}
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
/* Pick up the remainder with a bytewise loop. */
|
|
|
|
m = (char *)aligned_addr;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
while (count--)
|
|
|
|
{
|
|
|
|
*m++ = (char)d;
|
|
|
|
}
|
|
|
|
|
|
|
|
return s;
|
|
|
|
|
|
|
|
#undef LBLOCKSIZE
|
|
|
|
#undef UNALIGNED
|
|
|
|
#undef TOO_SMALL
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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
|
|
|
|
*
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
void *rt_memcpy(void *dst, const void *src, rt_ubase_t count)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
#ifdef RT_TINY_SIZE
|
2011-09-21 11:56:42 +08:00
|
|
|
char *tmp = (char *)dst, *s = (char *)src;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
while (count--)
|
|
|
|
*tmp++ = *s++;
|
|
|
|
|
|
|
|
return dst;
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define UNALIGNED(X, Y) \
|
2011-09-21 11:56:42 +08:00
|
|
|
(((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))
|
2009-07-03 06:48:23 +08:00
|
|
|
#define TOO_SMALL(LEN) ((LEN) < BIGBLOCKSIZE)
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
char *dst_ptr = (char *)dst;
|
|
|
|
char *src_ptr = (char *)src;
|
2009-07-03 06:48:23 +08:00
|
|
|
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,
|
2011-09-21 11:56:42 +08:00
|
|
|
then punt into the byte copy loop. This should be rare. */
|
|
|
|
if (!TOO_SMALL(len) && !UNALIGNED(src_ptr, dst_ptr))
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
aligned_dst = (rt_int32_t *)dst_ptr;
|
|
|
|
aligned_src = (rt_int32_t *)src_ptr;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
/* Copy 4X long words at a time if possible. */
|
2009-07-03 06:48:23 +08:00
|
|
|
while (len >= BIGBLOCKSIZE)
|
|
|
|
{
|
|
|
|
*aligned_dst++ = *aligned_src++;
|
|
|
|
*aligned_dst++ = *aligned_src++;
|
|
|
|
*aligned_dst++ = *aligned_src++;
|
|
|
|
*aligned_dst++ = *aligned_src++;
|
|
|
|
len -= BIGBLOCKSIZE;
|
|
|
|
}
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
/* Copy one long word at a time if possible. */
|
2009-07-03 06:48:23 +08:00
|
|
|
while (len >= LITTLEBLOCKSIZE)
|
|
|
|
{
|
|
|
|
*aligned_dst++ = *aligned_src++;
|
|
|
|
len -= LITTLEBLOCKSIZE;
|
|
|
|
}
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
/* Pick up any residual with a byte copier. */
|
|
|
|
dst_ptr = (char *)aligned_dst;
|
|
|
|
src_ptr = (char *)aligned_src;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
while (len--)
|
|
|
|
*dst_ptr++ = *src_ptr++;
|
|
|
|
|
|
|
|
return dst;
|
|
|
|
#undef UNALIGNED
|
|
|
|
#undef BIGBLOCKSIZE
|
|
|
|
#undef LITTLEBLOCKSIZE
|
|
|
|
#undef TOO_SMALL
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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
|
|
|
|
*
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
void *rt_memmove(void *dest, const void *src, rt_ubase_t n)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
char *tmp = (char *)dest, *s = (char *)src;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
if (s < tmp && tmp < s + n)
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
tmp += n;
|
|
|
|
s += n;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
while (n--)
|
|
|
|
*tmp-- = *s--;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
while (n--)
|
|
|
|
*tmp++ = *s++;
|
|
|
|
}
|
|
|
|
|
|
|
|
return dest;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-09-21 11:56:42 +08:00
|
|
|
* 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
|
2009-07-03 06:48:23 +08:00
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_int32_t rt_memcmp(const void *cs, const void *ct, rt_ubase_t count)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
const unsigned char *su1, *su2;
|
|
|
|
int res = 0;
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
|
2009-07-03 06:48:23 +08:00
|
|
|
if ((res = *su1 - *su2) != 0)
|
|
|
|
break;
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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.
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
char *rt_strstr(const char *s1, const char *s2)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
int l1, l2;
|
|
|
|
|
|
|
|
l2 = rt_strlen(s2);
|
|
|
|
if (!l2)
|
2011-09-21 11:56:42 +08:00
|
|
|
return (char *)s1;
|
2009-07-03 06:48:23 +08:00
|
|
|
l1 = rt_strlen(s1);
|
|
|
|
while (l1 >= l2)
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
l1 --;
|
|
|
|
if (!rt_memcmp(s1, s2, l2))
|
|
|
|
return (char *)s1;
|
|
|
|
s1 ++;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
return RT_NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* This function will copy string no more than n bytes.
|
|
|
|
*
|
2011-11-08 12:06:12 +08:00
|
|
|
* @param dst the string to copy
|
2009-07-03 06:48:23 +08:00
|
|
|
* @param src the string to be copied
|
|
|
|
* @param n the maximum copied length
|
|
|
|
*
|
|
|
|
* @return the result
|
|
|
|
*/
|
2011-11-08 12:06:12 +08:00
|
|
|
char *rt_strncpy(char *dst, const char *src, rt_ubase_t n)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
2011-11-08 12:06:12 +08:00
|
|
|
if (n != 0)
|
|
|
|
{
|
|
|
|
char *d = dst;
|
|
|
|
const char *s = src;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
2011-11-08 12:06:12 +08:00
|
|
|
do
|
|
|
|
{
|
|
|
|
if ((*d++ = *s++) == 0)
|
|
|
|
{
|
|
|
|
/* NUL pad the remaining n-1 bytes */
|
|
|
|
while (--n != 0)
|
2011-12-29 14:35:55 +08:00
|
|
|
*d++ = 0;
|
2011-11-08 12:06:12 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
} while (--n != 0);
|
|
|
|
}
|
|
|
|
return (dst);
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_ubase_t rt_strncmp(const char *cs, const char *ct, rt_ubase_t count)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
register signed char __res = 0;
|
|
|
|
|
|
|
|
while (count)
|
|
|
|
{
|
|
|
|
if ((__res = *cs - *ct++) != 0 || !*cs++)
|
|
|
|
break;
|
2011-09-21 11:56:42 +08:00
|
|
|
count --;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return __res;
|
|
|
|
}
|
|
|
|
|
2010-10-19 17:25:00 +08:00
|
|
|
/**
|
|
|
|
* 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
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_ubase_t rt_strcmp(const char *cs, const char *ct)
|
2010-10-19 17:25:00 +08:00
|
|
|
{
|
|
|
|
while (*cs && *cs == *ct)
|
|
|
|
cs++, ct++;
|
|
|
|
return (*cs - *ct);
|
|
|
|
}
|
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
|
|
|
|
#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);
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
if (!tmp) return RT_NULL;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
rt_memcpy(tmp, s, len);
|
|
|
|
return tmp;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/**
|
|
|
|
* This function will show the version of rt-thread rtos
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
void rt_show_version(void)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
rt_kprintf("\n \\ | /\n");
|
2010-03-16 21:37:14 +08:00
|
|
|
rt_kprintf("- RT - Thread Operating System\n");
|
2011-12-31 14:48:46 +08:00
|
|
|
rt_kprintf(" / | \\ %d.%d.%d build %s\n", RT_VERSION, RT_SUBVERSION, RT_REVISION, __DATE__);
|
2011-02-24 10:07:49 +08:00
|
|
|
rt_kprintf(" 2006 - 2011 Copyright by rt-thread team\n");
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* 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;
|
|
|
|
while (isdigit(**s)) i = i*10 + *((*s)++) - '0';
|
|
|
|
|
|
|
|
return i;
|
|
|
|
}
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
#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' */
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
#ifdef RT_PRINTF_PRECISION
|
2011-09-21 11:56:42 +08:00
|
|
|
static char *print_number(char *buf, char *end, long num, int base, int s, int precision, int type)
|
2009-07-03 06:48:23 +08:00
|
|
|
#else
|
2011-09-21 11:56:42 +08:00
|
|
|
static char *print_number(char *buf, char *end, long num, int base, int s, int type)
|
2009-07-03 06:48:23 +08:00
|
|
|
#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;
|
|
|
|
if (type & LEFT) type &= ~ZEROPAD;
|
|
|
|
|
|
|
|
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;
|
|
|
|
if (num == 0) tmp[i++]='0';
|
|
|
|
else
|
|
|
|
{
|
|
|
|
while (num != 0) tmp[i++] = digits[divide(&num, base)];
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_PRINTF_PRECISION
|
|
|
|
if (i > precision) precision = i;
|
|
|
|
size -= precision;
|
|
|
|
#else
|
|
|
|
size -= i;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (!(type&(ZEROPAD | LEFT)))
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
while (size-->0)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
if (buf <= end) *buf = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (sign)
|
|
|
|
{
|
|
|
|
if (buf <= end)
|
|
|
|
{
|
|
|
|
*buf = sign;
|
2011-09-21 11:56:42 +08:00
|
|
|
-- size;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_PRINTF_SPECIAL
|
|
|
|
if (type & SPECIAL)
|
|
|
|
{
|
|
|
|
if (base==8)
|
|
|
|
{
|
|
|
|
if (buf <= end) *buf = '0';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
2011-09-21 11:56:42 +08:00
|
|
|
else if (base == 16)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
if (buf <= end) *buf = '0';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
if (buf <= end)
|
|
|
|
{
|
|
|
|
*buf = type & LARGE? 'X' : 'x';
|
|
|
|
}
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* no align to the left */
|
|
|
|
if (!(type & LEFT))
|
|
|
|
{
|
|
|
|
while (size-- > 0)
|
|
|
|
{
|
|
|
|
if (buf <= end) *buf = c;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef RT_PRINTF_PRECISION
|
|
|
|
while (i < precision--)
|
|
|
|
{
|
|
|
|
if (buf <= end) *buf = '0';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* put number in the temporary buffer */
|
|
|
|
while (i-- > 0)
|
|
|
|
{
|
|
|
|
if (buf <= end) *buf = tmp[i];
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
while (size-- > 0)
|
|
|
|
{
|
|
|
|
if (buf <= end) *buf = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ buf;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
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 */
|
|
|
|
rt_int32_t field_width; /* width of output field */
|
|
|
|
|
|
|
|
#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 */
|
2009-12-25 20:18:53 +08:00
|
|
|
if (end < buf)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
end = ((char *)-1);
|
|
|
|
size = end - buf;
|
|
|
|
}
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
for (; *fmt ; ++fmt)
|
|
|
|
{
|
|
|
|
if (*fmt != '%')
|
|
|
|
{
|
|
|
|
if (str <= end) *str = *fmt;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* process flags */
|
|
|
|
flags = 0;
|
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
while (1)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
/* skips the first '%' also */
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
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 == '*')
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
/* 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 == '.')
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
if (isdigit(*fmt)) precision = skip_atoi(&fmt);
|
|
|
|
else if (*fmt == '*')
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
/* it's the next argument */
|
|
|
|
precision = va_arg(args, int);
|
|
|
|
}
|
|
|
|
if (precision < 0) precision = 0;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
/* get the conversion qualifier */
|
|
|
|
qualifier = 0;
|
|
|
|
if (*fmt == 'h' || *fmt == 'l'
|
|
|
|
#ifdef RT_PRINTF_LONGLONG
|
|
|
|
|| *fmt == 'L'
|
|
|
|
#endif
|
|
|
|
)
|
|
|
|
{
|
|
|
|
qualifier = *fmt;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
#ifdef RT_PRINTF_LONGLONG
|
|
|
|
if (qualifier == 'l' && *fmt == 'l')
|
|
|
|
{
|
|
|
|
qualifier = 'L';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* the default base */
|
|
|
|
base = 10;
|
|
|
|
|
|
|
|
switch (*fmt)
|
|
|
|
{
|
|
|
|
case 'c':
|
|
|
|
if (!(flags & LEFT))
|
|
|
|
{
|
|
|
|
while (--field_width > 0)
|
|
|
|
{
|
|
|
|
if (str <= end) *str = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* get character */
|
2011-09-21 11:56:42 +08:00
|
|
|
c = (rt_uint8_t)va_arg(args, int);
|
2009-07-03 06:48:23 +08:00
|
|
|
if (str <= end) *str = c;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
/* put width */
|
|
|
|
while (--field_width > 0)
|
|
|
|
{
|
|
|
|
if (str <= end) *str = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
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 = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < len; ++i)
|
|
|
|
{
|
|
|
|
if (str <= end) *str = *s;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
|
|
|
++ s;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
while (len < field_width--)
|
|
|
|
{
|
|
|
|
if (str <= end) *str = ' ';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
continue;
|
|
|
|
|
|
|
|
case 'p':
|
|
|
|
if (field_width == -1)
|
|
|
|
{
|
|
|
|
field_width = sizeof(void *) << 1;
|
|
|
|
flags |= ZEROPAD;
|
|
|
|
}
|
|
|
|
#ifdef RT_PRINTF_PRECISION
|
|
|
|
str = print_number(str, end,
|
2011-09-21 11:56:42 +08:00
|
|
|
(long)va_arg(args, void *),
|
2009-07-03 06:48:23 +08:00
|
|
|
16, field_width, precision, flags);
|
|
|
|
#else
|
|
|
|
str = print_number(str, end,
|
2011-09-21 11:56:42 +08:00
|
|
|
(long)va_arg(args, void *),
|
2009-07-03 06:48:23 +08:00
|
|
|
16, field_width, flags);
|
|
|
|
#endif
|
|
|
|
continue;
|
|
|
|
|
|
|
|
case '%':
|
|
|
|
if (str <= end) *str = '%';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
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 = '%';
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
if (*fmt)
|
|
|
|
{
|
|
|
|
if (str <= end) *str = *fmt;
|
2011-09-21 11:56:42 +08:00
|
|
|
++ str;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
-- fmt;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
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);
|
2011-09-21 11:56:42 +08:00
|
|
|
if (flags & SIGN) num = (rt_int32_t)num;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
else if (qualifier == 'h')
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
num = (rt_uint16_t)va_arg(args, rt_int32_t);
|
|
|
|
if (flags & SIGN) num = (rt_int16_t)num;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
num = va_arg(args, rt_uint32_t);
|
2011-09-21 11:56:42 +08:00
|
|
|
if (flags & SIGN) num = (rt_int32_t)num;
|
2009-07-03 06:48:23 +08:00
|
|
|
}
|
|
|
|
#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;
|
|
|
|
*/
|
|
|
|
return str-buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* This function will fill a formatted string to buffer
|
|
|
|
*
|
|
|
|
* @param buf the buffer to save formatted string
|
2009-12-25 20:18:53 +08:00
|
|
|
* @param arg_ptr the arg_ptr
|
2009-07-03 06:48:23 +08:00
|
|
|
* @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);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* This function will fill a formatted string to buffer
|
|
|
|
*
|
|
|
|
* @param buf the buffer to save formatted string
|
|
|
|
* @param format the format
|
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_int32_t rt_sprintf(char *buf, const char *format, ...)
|
2009-07-03 06:48:23 +08:00
|
|
|
{
|
|
|
|
rt_int32_t n;
|
|
|
|
va_list arg_ptr;
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
va_start(arg_ptr, format);
|
2011-09-21 11:56:42 +08:00
|
|
|
n = rt_vsprintf(buf ,format, arg_ptr);
|
|
|
|
va_end(arg_ptr);
|
2009-12-25 20:18:53 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
return n;
|
|
|
|
}
|
2010-03-17 12:19:17 +08:00
|
|
|
|
2011-06-09 18:48:59 +08:00
|
|
|
#ifdef RT_USING_CONSOLE
|
|
|
|
|
2011-01-24 21:40:42 +08:00
|
|
|
#ifdef RT_USING_DEVICE
|
2011-09-25 10:28:07 +08:00
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
|
2010-03-09 07:09:40 +08:00
|
|
|
/**
|
2010-11-29 08:04:55 +08:00
|
|
|
* This function will set a device as console device.
|
2010-03-09 07:09:40 +08:00
|
|
|
* After set a device to console, all output of rt_kprintf will be
|
2010-11-29 08:04:55 +08:00
|
|
|
* redirected to this new device.
|
2010-03-09 07:09:40 +08:00
|
|
|
*
|
2010-11-29 08:04:55 +08:00
|
|
|
* @param name the name of new console device
|
2010-03-09 07:09:40 +08:00
|
|
|
*
|
2010-11-29 08:04:55 +08:00
|
|
|
* @return the old console device handler
|
2010-03-09 07:09:40 +08:00
|
|
|
*/
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_device_t rt_console_set_device(const char *name)
|
2010-03-09 07:09:40 +08:00
|
|
|
{
|
|
|
|
rt_device_t new, old;
|
|
|
|
|
|
|
|
/* save old device */
|
|
|
|
old = _console_device;
|
2009-07-03 06:48:23 +08:00
|
|
|
|
2010-03-09 07:09:40 +08:00
|
|
|
/* 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;
|
2010-03-17 12:19:17 +08:00
|
|
|
}
|
2011-01-24 21:40:42 +08:00
|
|
|
#endif
|
2010-03-09 07:09:40 +08:00
|
|
|
|
|
|
|
#if defined(__GNUC__)
|
2011-09-21 11:56:42 +08:00
|
|
|
void rt_hw_console_output(const char *str) __attribute__((weak));
|
|
|
|
void rt_hw_console_output(const char *str)
|
2010-03-17 12:19:17 +08:00
|
|
|
#elif defined(__CC_ARM)
|
2011-09-21 11:56:42 +08:00
|
|
|
__weak void rt_hw_console_output(const char *str)
|
2010-06-29 17:08:24 +08:00
|
|
|
#elif defined(__IAR_SYSTEMS_ICC__)
|
2010-12-09 07:17:23 +08:00
|
|
|
#if __VER__ > 540
|
2011-06-09 18:48:59 +08:00
|
|
|
__weak
|
2010-12-09 07:17:23 +08:00
|
|
|
#endif
|
2011-09-21 11:56:42 +08:00
|
|
|
void rt_hw_console_output(const char *str)
|
2010-03-09 07:09:40 +08:00
|
|
|
#endif
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
/* empty console output */
|
2010-03-09 07:09:40 +08:00
|
|
|
}
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
/**
|
|
|
|
* This function will print a formatted string on system console
|
|
|
|
*
|
|
|
|
* @param fmt the format
|
|
|
|
*/
|
|
|
|
void rt_kprintf(const char *fmt, ...)
|
|
|
|
{
|
2010-04-12 00:44:54 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
va_list args;
|
2010-03-17 12:19:17 +08:00
|
|
|
rt_size_t length;
|
|
|
|
static char rt_log_buf[RT_CONSOLEBUF_SIZE];
|
2010-03-09 07:09:40 +08:00
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
va_start(args, fmt);
|
2010-03-09 07:09:40 +08:00
|
|
|
length = vsnprintf(rt_log_buf, sizeof(rt_log_buf), fmt, args);
|
2011-01-24 21:40:42 +08:00
|
|
|
#ifdef RT_USING_DEVICE
|
2010-03-09 07:09:40 +08:00
|
|
|
if (_console_device == RT_NULL)
|
|
|
|
{
|
2011-09-21 11:56:42 +08:00
|
|
|
rt_hw_console_output(rt_log_buf);
|
2010-03-17 12:19:17 +08:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
rt_device_write(_console_device, 0, rt_log_buf, length);
|
2010-03-09 07:09:40 +08:00
|
|
|
}
|
2011-01-24 21:40:42 +08:00
|
|
|
#else
|
|
|
|
rt_hw_console_output(rt_log_buf);
|
|
|
|
#endif
|
2009-07-03 06:48:23 +08:00
|
|
|
va_end(args);
|
|
|
|
}
|
2011-03-12 08:08:47 +08:00
|
|
|
#else
|
|
|
|
void rt_kprintf(const char *fmt, ...)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
#endif
|
2009-07-03 06:48:23 +08:00
|
|
|
|
|
|
|
#if !defined (RT_USING_NEWLIB) && defined (RT_USING_MINILIBC) && defined (__GNUC__)
|
|
|
|
#include <sys/types.h>
|
2011-09-21 11:56:42 +08:00
|
|
|
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")));
|
2009-07-03 06:48:23 +08:00
|
|
|
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")));
|
2010-03-16 21:37:14 +08:00
|
|
|
char *strstr(const char *s1,const char *s2) __attribute__((weak, alias("rt_strstr")));
|
2009-07-03 06:48:23 +08:00
|
|
|
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")));
|
2010-03-16 21:37:14 +08:00
|
|
|
int strncmp(const char *cs, const char *ct, size_t count) __attribute__((weak, alias("rt_strncmp")));
|
2009-07-03 06:48:23 +08:00
|
|
|
#ifdef RT_USING_HEAP
|
2010-03-16 21:37:14 +08:00
|
|
|
char *strdup(const char *s) __attribute__((weak, alias("rt_strdup")));
|
2009-07-03 06:48:23 +08:00
|
|
|
#endif
|
2011-03-12 08:08:47 +08:00
|
|
|
|
2011-09-21 11:56:42 +08:00
|
|
|
int sprintf(char *buf, const char *format, ...) __attribute__((weak, alias("rt_sprintf")));
|
2011-03-12 08:08:47 +08:00
|
|
|
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")));
|
|
|
|
|
2009-07-03 06:48:23 +08:00
|
|
|
#endif
|
|
|
|
|
|
|
|
/*@}*/
|