util.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140
  1. /**
  2. ******************************************************************************
  3. * @file util.c
  4. * @author StarFive Technology
  5. * @version V1.0
  6. * @date 06/25/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 "util.h"
  21. #include "comdef.h"
  22. //#include "stdio.h"
  23. #include "encoding.h"
  24. //unsigned int funcpll_432 = 0;
  25. //unsigned int osc_clk = 0;
  26. /*===========================================================================
  27. FUNCTION: sys_memcpy
  28. DESCRIPTION:
  29. copy one block memory to another position
  30. INPUT PARAMETER:
  31. void *p_des: destination address
  32. const void * p_src: source address
  33. unsigned long size: length of memory to copy (unit is byte)
  34. OUTPUT PARAMETER:
  35. RETURN VALUE:
  36. ===========================================================================*/
  37. extern unsigned int test_flag;
  38. void * sys_memcpy(void *p_des,const void * p_src,unsigned long size)
  39. {
  40. char *tmp = p_des;
  41. const char *s = p_src;
  42. while (size--)
  43. *tmp++ = *s++;
  44. return p_des;
  45. }
  46. int sys_memcmp(const void * cs,const void * ct,unsigned int count)
  47. {
  48. const unsigned char *su1, *su2;
  49. int res = 0;
  50. for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
  51. if ((res = *su1 - *su2) != 0)
  52. break;
  53. return res;
  54. }
  55. void * _memcpy(void * dest,const void *src,unsigned int count)
  56. {
  57. char *tmp = (char *) dest;
  58. const char *s = (char *) src;
  59. while (count--)
  60. *tmp++ = *s++;
  61. return dest;
  62. }
  63. /*===========================================================================
  64. FUNCTION: sys_memcpy_32
  65. DESCRIPTION:
  66. copy one block memory to another position
  67. caller guarantee the src/des address are DWORD allign
  68. INPUT PARAMETER:
  69. void *p_des: destination address
  70. const void * p_src: source address
  71. unsigned long size: length of memory to copy (unit is DWORD)
  72. OUTPUT PARAMETER:
  73. RETURN VALUE:
  74. ===========================================================================*/
  75. void sys_memcpy_32(void *p_des,const void * p_src,unsigned long size)
  76. {
  77. unsigned long i;
  78. for (i=0;i<size;i++)
  79. *((unsigned long*)p_des+i) = *((unsigned long*)p_src+i);
  80. }
  81. /*===========================================================================
  82. FUNCTION: sys_memset
  83. DESCRIPTION:
  84. fill memory with specifed value
  85. INPUT PARAMETER:
  86. void *p_des: destination address
  87. int c: value to set
  88. unsigned long size: length of memory
  89. OUTPUT PARAMETER:
  90. RETURN VALUE:
  91. ===========================================================================*/
  92. void sys_memset(void *p_des,unsigned char c,unsigned long size)
  93. {
  94. unsigned long i;
  95. for (i=0;i<size;i++)
  96. *((char*)p_des+i) = c;
  97. }
  98. /*===========================================================================
  99. FUNCTION: sys_memset32
  100. DESCRIPTION:
  101. fill memory with specifed value
  102. INPUT PARAMETER:
  103. void *p_des: destination address
  104. int c: value to set
  105. unsigned long size: length of memory in word(32bit)
  106. OUTPUT PARAMETER:
  107. RETURN VALUE:
  108. ===========================================================================*/
  109. void sys_memset32(void *p_des,int c,unsigned long size)
  110. {
  111. unsigned long i;
  112. for(i=0; i< size; i++)
  113. ((unsigned long*)p_des)[i] = c;
  114. }