util.c 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166
  1. /**
  2. ******************************************************************************
  3. * @file util.c
  4. * @author StarFive Technology
  5. * @version V1.0
  6. * @date 07/24/2020
  7. * @brief
  8. ******************************************************************************
  9. * @copy
  10. *
  11. * THE PRESENT SOFTWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
  12. * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
  13. * TIME. AS A RESULT, STARFIVE SHALL NOT BE HELD LIABLE FOR ANY
  14. * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
  15. * FROM THE CONTENT OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
  16. * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
  17. *
  18. * COPYRIGHT 2020 Shanghai StarFive Technology Co., Ltd.
  19. */
  20. #include "ctype.h"
  21. #include "util.h"
  22. #include "comdef.h"
  23. #include "encoding.h"
  24. /*===========================================================================
  25. FUNCTION: sys_memcpy
  26. DESCRIPTION:
  27. copy one block memory to another position
  28. INPUT PARAMETER:
  29. void *p_des: destination address
  30. const void * p_src: source address
  31. unsigned long size: length of memory to copy (unit is byte)
  32. OUTPUT PARAMETER:
  33. RETURN VALUE:
  34. ===========================================================================*/
  35. void * sys_memcpy(void *p_des,const void * p_src,unsigned long size)
  36. {
  37. char *tmp = p_des;
  38. const char *s = p_src;
  39. while (size--)
  40. *tmp++ = *s++;
  41. return p_des;
  42. }
  43. int sys_memcmp(const void * cs,const void * ct,unsigned int count)
  44. {
  45. const unsigned char *su1, *su2;
  46. int res = 0;
  47. for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
  48. if ((res = *su1 - *su2) != 0)
  49. break;
  50. return res;
  51. }
  52. void * _memcpy(void * dest,const void *src,unsigned int count)
  53. {
  54. char *tmp = (char *) dest;
  55. const char *s = (char *) src;
  56. while (count--)
  57. *tmp++ = *s++;
  58. return dest;
  59. }
  60. /*===========================================================================
  61. FUNCTION: sys_memcpy_32
  62. DESCRIPTION:
  63. copy one block memory to another position
  64. caller guarantee the src/des address are DWORD allign
  65. INPUT PARAMETER:
  66. void *p_des: destination address
  67. const void * p_src: source address
  68. unsigned long size: length of memory to copy (unit is DWORD)
  69. OUTPUT PARAMETER:
  70. RETURN VALUE:
  71. ===========================================================================*/
  72. void sys_memcpy_32(void *p_des,const void * p_src,unsigned long size)
  73. {
  74. unsigned long i;
  75. for (i=0;i<size;i++)
  76. *((unsigned long*)p_des+i) = *((unsigned long*)p_src+i);
  77. }
  78. /*===========================================================================
  79. FUNCTION: sys_memset
  80. DESCRIPTION:
  81. fill memory with specifed value
  82. INPUT PARAMETER:
  83. void *p_des: destination address
  84. int c: value to set
  85. unsigned long size: length of memory
  86. OUTPUT PARAMETER:
  87. RETURN VALUE:
  88. ===========================================================================*/
  89. void sys_memset(void *p_des,unsigned char c,unsigned long size)
  90. {
  91. unsigned long i;
  92. for (i=0;i<size;i++)
  93. *((char*)p_des+i) = c;
  94. }
  95. /*===========================================================================
  96. FUNCTION: sys_memset32
  97. DESCRIPTION:
  98. fill memory with specifed value
  99. INPUT PARAMETER:
  100. void *p_des: destination address
  101. int c: value to set
  102. unsigned long size: length of memory in word(32bit)
  103. OUTPUT PARAMETER:
  104. RETURN VALUE:
  105. ===========================================================================*/
  106. void sys_memset32(void *p_des,int c,unsigned long size)
  107. {
  108. unsigned long i;
  109. for(i=0; i< size; i++)
  110. ((unsigned long*)p_des)[i] = c;
  111. }
  112. int atoi(const char *nptr)
  113. {
  114. int c; /* current char */
  115. int total; /* current total */
  116. int sign; /* if '-', then negative, otherwise positive */
  117. /* skip whitespace */
  118. while ( isspace((int)(unsigned char)*nptr) )
  119. ++nptr;
  120. c = (int)(unsigned char)*nptr++;
  121. sign = c; /* save sign indication */
  122. if (c == '-' || c == '+')
  123. c = (int)(unsigned char)*nptr++; /* skip sign */
  124. total = 0;
  125. while (isdigit(c)) {
  126. total = 10 * total + (c - '0'); /* accumulate digit */
  127. c = (int)(unsigned char)*nptr++; /* get next char */
  128. }
  129. if (sign == '-')
  130. return -total;
  131. else
  132. return total; /* return result, negated if necessary */
  133. }