bh_vector.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205
  1. /*
  2. * Copyright (C) 2019 Intel Corporation. All rights reserved.
  3. * SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception
  4. */
  5. #include "bh_log.h"
  6. #include "bh_vector.h"
  7. static uint8*
  8. alloc_vector_data(uint32 length, uint32 size_elem)
  9. {
  10. uint64 total_size = ((uint64)size_elem) * length;
  11. uint8 *data;
  12. if (total_size > UINT32_MAX) {
  13. return NULL;
  14. }
  15. if ((data = BH_MALLOC((uint32)total_size))) {
  16. memset(data, 0, (uint32)total_size);
  17. }
  18. return data;
  19. }
  20. static bool
  21. extend_vector(Vector *vector, uint32 length)
  22. {
  23. uint8 *data;
  24. if (length <= vector->max_elements)
  25. return true;
  26. if (length < vector->size_elem * 3 / 2)
  27. length = vector->size_elem * 3 / 2;
  28. if (!(data = alloc_vector_data(length, vector->size_elem))) {
  29. return false;
  30. }
  31. memcpy(data, vector->data, vector->size_elem * vector->max_elements);
  32. BH_FREE(vector->data);
  33. vector->data = data;
  34. vector->max_elements = length;
  35. return true;
  36. }
  37. bool
  38. bh_vector_init(Vector *vector, uint32 init_length, uint32 size_elem)
  39. {
  40. if (!vector) {
  41. LOG_ERROR("Init vector failed: vector is NULL.\n");
  42. return false;
  43. }
  44. if (init_length == 0) {
  45. init_length = 4;
  46. }
  47. if (!(vector->data = alloc_vector_data(init_length, size_elem))) {
  48. LOG_ERROR("Init vector failed: alloc memory failed.\n");
  49. return false;
  50. }
  51. vector->size_elem = size_elem;
  52. vector->max_elements = init_length;
  53. vector->num_elements = 0;
  54. return true;
  55. }
  56. bool
  57. bh_vector_set(Vector *vector, uint32 index, const void *elem_buf)
  58. {
  59. if (!vector || !elem_buf) {
  60. LOG_ERROR("Set vector elem failed: vector or elem buf is NULL.\n");
  61. return false;
  62. }
  63. if (index >= vector->num_elements) {
  64. LOG_ERROR("Set vector elem failed: invalid elem index.\n");
  65. return false;
  66. }
  67. memcpy(vector->data + vector->size_elem * index,
  68. elem_buf, vector->size_elem);
  69. return true;
  70. }
  71. bool bh_vector_get(const Vector *vector, uint32 index, void *elem_buf)
  72. {
  73. if (!vector || !elem_buf) {
  74. LOG_ERROR("Get vector elem failed: vector or elem buf is NULL.\n");
  75. return false;
  76. }
  77. if (index >= vector->num_elements) {
  78. LOG_ERROR("Get vector elem failed: invalid elem index.\n");
  79. return false;
  80. }
  81. memcpy(elem_buf, vector->data + vector->size_elem * index,
  82. vector->size_elem);
  83. return true;
  84. }
  85. bool bh_vector_insert(Vector *vector, uint32 index, const void *elem_buf)
  86. {
  87. uint32 i;
  88. uint8 *p;
  89. if (!vector || !elem_buf) {
  90. LOG_ERROR("Insert vector elem failed: vector or elem buf is NULL.\n");
  91. return false;
  92. }
  93. if (index >= vector->num_elements) {
  94. LOG_ERROR("Insert vector elem failed: invalid elem index.\n");
  95. return false;
  96. }
  97. if (!extend_vector(vector, vector->num_elements + 1)) {
  98. LOG_ERROR("Insert vector elem failed: extend vector failed.\n");
  99. return false;
  100. }
  101. p = vector->data + vector->size_elem * vector->num_elements;
  102. for (i = vector->num_elements - 1; i > index; i--) {
  103. memcpy(p, p - vector->size_elem, vector->size_elem);
  104. p -= vector->size_elem;
  105. }
  106. memcpy(p, elem_buf, vector->size_elem);
  107. vector->num_elements++;
  108. return true;
  109. }
  110. bool bh_vector_append(Vector *vector, const void *elem_buf)
  111. {
  112. if (!vector || !elem_buf) {
  113. LOG_ERROR("Append vector elem failed: vector or elem buf is NULL.\n");
  114. return false;
  115. }
  116. if (!extend_vector(vector, vector->num_elements + 1)) {
  117. LOG_ERROR("Append ector elem failed: extend vector failed.\n");
  118. return false;
  119. }
  120. memcpy(vector->data + vector->size_elem * vector->num_elements,
  121. elem_buf, vector->size_elem);
  122. vector->num_elements++;
  123. return true;
  124. }
  125. bool
  126. bh_vector_remove(Vector *vector, uint32 index, void *old_elem_buf)
  127. {
  128. uint32 i;
  129. uint8 *p;
  130. if (!vector) {
  131. LOG_ERROR("Remove vector elem failed: vector is NULL.\n");
  132. return false;
  133. }
  134. if (index >= vector->num_elements) {
  135. LOG_ERROR("Remove vector elem failed: invalid elem index.\n");
  136. return false;
  137. }
  138. p = vector->data + vector->size_elem * index;
  139. if (old_elem_buf) {
  140. memcpy(old_elem_buf, p, vector->size_elem);
  141. }
  142. for (i = index; i < vector->num_elements - 1; i++) {
  143. memcpy(p, p + vector->size_elem, vector->size_elem);
  144. p += vector->size_elem;
  145. }
  146. vector->num_elements--;
  147. return true;
  148. }
  149. uint32
  150. bh_vector_size(const Vector *vector)
  151. {
  152. return vector ? vector->num_elements : 0;
  153. }
  154. bool
  155. bh_vector_destroy(Vector *vector)
  156. {
  157. if (!vector) {
  158. LOG_ERROR("Destroy vector elem failed: vector is NULL.\n");
  159. return false;
  160. }
  161. if (vector->data)
  162. BH_FREE(vector->data);
  163. memset(vector, 0, sizeof(Vector));
  164. return true;
  165. }