darray.h 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530
  1. /*
  2. * Copyright (c) 2013 Hugh Bailey <[email protected]>
  3. *
  4. * Permission to use, copy, modify, and distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #pragma once
  17. #include "c99defs.h"
  18. #include <string.h>
  19. #include <stdlib.h>
  20. #include <assert.h>
  21. #include "bmem.h"
  22. #ifdef __cplusplus
  23. extern "C" {
  24. #endif
  25. /*
  26. * Dynamic array.
  27. *
  28. * NOTE: Not type-safe when using directly.
  29. * Specifying size per call with inline maximizes compiler optimizations
  30. *
  31. * See DARRAY macro at the bottom of the file for slightly safer usage.
  32. */
  33. #define DARRAY_INVALID ((size_t)-1)
  34. struct darray {
  35. void *array;
  36. size_t num;
  37. size_t capacity;
  38. };
  39. static inline void darray_init(struct darray *dst)
  40. {
  41. dst->array = NULL;
  42. dst->num = 0;
  43. dst->capacity = 0;
  44. }
  45. static inline void darray_free(struct darray *dst)
  46. {
  47. bfree(dst->array);
  48. dst->array = NULL;
  49. dst->num = 0;
  50. dst->capacity = 0;
  51. }
  52. static inline size_t darray_alloc_size(const size_t element_size,
  53. const struct darray *da)
  54. {
  55. return element_size * da->num;
  56. }
  57. static inline void *darray_item(const size_t element_size,
  58. const struct darray *da, size_t idx)
  59. {
  60. return (void *)(((uint8_t *)da->array) + element_size * idx);
  61. }
  62. static inline void *darray_end(const size_t element_size,
  63. const struct darray *da)
  64. {
  65. if (!da->num)
  66. return NULL;
  67. return darray_item(element_size, da, da->num - 1);
  68. }
  69. static inline void darray_reserve(const size_t element_size, struct darray *dst,
  70. const size_t capacity)
  71. {
  72. void *ptr;
  73. if (capacity == 0 || capacity <= dst->num)
  74. return;
  75. ptr = bmalloc(element_size * capacity);
  76. if (dst->num)
  77. memcpy(ptr, dst->array, element_size * dst->num);
  78. if (dst->array)
  79. bfree(dst->array);
  80. dst->array = ptr;
  81. dst->capacity = capacity;
  82. }
  83. static inline void darray_ensure_capacity(const size_t element_size,
  84. struct darray *dst,
  85. const size_t new_size)
  86. {
  87. size_t new_cap;
  88. void *ptr;
  89. if (new_size <= dst->capacity)
  90. return;
  91. new_cap = (!dst->capacity) ? new_size : dst->capacity * 2;
  92. if (new_size > new_cap)
  93. new_cap = new_size;
  94. ptr = bmalloc(element_size * new_cap);
  95. if (dst->capacity)
  96. memcpy(ptr, dst->array, element_size * dst->capacity);
  97. if (dst->array)
  98. bfree(dst->array);
  99. dst->array = ptr;
  100. dst->capacity = new_cap;
  101. }
  102. static inline void darray_resize(const size_t element_size, struct darray *dst,
  103. const size_t size)
  104. {
  105. int b_clear;
  106. size_t old_num;
  107. if (size == dst->num) {
  108. return;
  109. } else if (size == 0) {
  110. dst->num = 0;
  111. return;
  112. }
  113. b_clear = size > dst->num;
  114. old_num = dst->num;
  115. darray_ensure_capacity(element_size, dst, size);
  116. dst->num = size;
  117. if (b_clear)
  118. memset(darray_item(element_size, dst, old_num), 0,
  119. element_size * (dst->num - old_num));
  120. }
  121. static inline void darray_copy(const size_t element_size, struct darray *dst,
  122. const struct darray *da)
  123. {
  124. if (da->num == 0) {
  125. darray_free(dst);
  126. } else {
  127. darray_resize(element_size, dst, da->num);
  128. memcpy(dst->array, da->array, element_size * da->num);
  129. }
  130. }
  131. static inline void darray_copy_array(const size_t element_size,
  132. struct darray *dst, const void *array,
  133. const size_t num)
  134. {
  135. darray_resize(element_size, dst, num);
  136. memcpy(dst->array, array, element_size * dst->num);
  137. }
  138. static inline void darray_move(struct darray *dst, struct darray *src)
  139. {
  140. darray_free(dst);
  141. memcpy(dst, src, sizeof(struct darray));
  142. src->array = NULL;
  143. src->capacity = 0;
  144. src->num = 0;
  145. }
  146. static inline size_t darray_find(const size_t element_size,
  147. const struct darray *da, const void *item,
  148. const size_t idx)
  149. {
  150. size_t i;
  151. assert(idx <= da->num);
  152. for (i = idx; i < da->num; i++) {
  153. void *compare = darray_item(element_size, da, i);
  154. if (memcmp(compare, item, element_size) == 0)
  155. return i;
  156. }
  157. return DARRAY_INVALID;
  158. }
  159. static inline size_t darray_push_back(const size_t element_size,
  160. struct darray *dst, const void *item)
  161. {
  162. darray_ensure_capacity(element_size, dst, ++dst->num);
  163. memcpy(darray_end(element_size, dst), item, element_size);
  164. return dst->num - 1;
  165. }
  166. static inline void *darray_push_back_new(const size_t element_size,
  167. struct darray *dst)
  168. {
  169. void *last;
  170. darray_ensure_capacity(element_size, dst, ++dst->num);
  171. last = darray_end(element_size, dst);
  172. memset(last, 0, element_size);
  173. return last;
  174. }
  175. static inline size_t darray_push_back_array(const size_t element_size,
  176. struct darray *dst,
  177. const void *array, const size_t num)
  178. {
  179. size_t old_num;
  180. if (!dst)
  181. return 0;
  182. if (!array || !num)
  183. return dst->num;
  184. old_num = dst->num;
  185. darray_resize(element_size, dst, dst->num + num);
  186. memcpy(darray_item(element_size, dst, old_num), array,
  187. element_size * num);
  188. return old_num;
  189. }
  190. static inline size_t darray_push_back_darray(const size_t element_size,
  191. struct darray *dst,
  192. const struct darray *da)
  193. {
  194. return darray_push_back_array(element_size, dst, da->array, da->num);
  195. }
  196. static inline void darray_insert(const size_t element_size, struct darray *dst,
  197. const size_t idx, const void *item)
  198. {
  199. void *new_item;
  200. size_t move_count;
  201. assert(idx <= dst->num);
  202. if (idx == dst->num) {
  203. darray_push_back(element_size, dst, item);
  204. return;
  205. }
  206. move_count = dst->num - idx;
  207. darray_ensure_capacity(element_size, dst, ++dst->num);
  208. new_item = darray_item(element_size, dst, idx);
  209. memmove(darray_item(element_size, dst, idx + 1), new_item,
  210. move_count * element_size);
  211. memcpy(new_item, item, element_size);
  212. }
  213. static inline void *darray_insert_new(const size_t element_size,
  214. struct darray *dst, const size_t idx)
  215. {
  216. void *item;
  217. size_t move_count;
  218. assert(idx <= dst->num);
  219. if (idx == dst->num)
  220. return darray_push_back_new(element_size, dst);
  221. item = darray_item(element_size, dst, idx);
  222. move_count = dst->num - idx;
  223. darray_ensure_capacity(element_size, dst, ++dst->num);
  224. memmove(darray_item(element_size, dst, idx + 1), item,
  225. move_count * element_size);
  226. memset(item, 0, element_size);
  227. return item;
  228. }
  229. static inline void darray_insert_array(const size_t element_size,
  230. struct darray *dst, const size_t idx,
  231. const void *array, const size_t num)
  232. {
  233. size_t old_num;
  234. assert(array != NULL);
  235. assert(num != 0);
  236. assert(idx <= dst->num);
  237. old_num = dst->num;
  238. darray_resize(element_size, dst, dst->num + num);
  239. memmove(darray_item(element_size, dst, idx + num),
  240. darray_item(element_size, dst, idx),
  241. element_size * (old_num - idx));
  242. memcpy(darray_item(element_size, dst, idx), array, element_size * num);
  243. }
  244. static inline void darray_insert_darray(const size_t element_size,
  245. struct darray *dst, const size_t idx,
  246. const struct darray *da)
  247. {
  248. darray_insert_array(element_size, dst, idx, da->array, da->num);
  249. }
  250. static inline void darray_erase(const size_t element_size, struct darray *dst,
  251. const size_t idx)
  252. {
  253. assert(idx < dst->num);
  254. if (idx >= dst->num || !--dst->num)
  255. return;
  256. memmove(darray_item(element_size, dst, idx),
  257. darray_item(element_size, dst, idx + 1),
  258. element_size * (dst->num - idx));
  259. }
  260. static inline void darray_erase_item(const size_t element_size,
  261. struct darray *dst, const void *item)
  262. {
  263. size_t idx = darray_find(element_size, dst, item, 0);
  264. if (idx != DARRAY_INVALID)
  265. darray_erase(element_size, dst, idx);
  266. }
  267. static inline void darray_erase_range(const size_t element_size,
  268. struct darray *dst, const size_t start,
  269. const size_t end)
  270. {
  271. size_t count, move_count;
  272. assert(start <= dst->num);
  273. assert(end <= dst->num);
  274. assert(end > start);
  275. count = end - start;
  276. if (count == 1) {
  277. darray_erase(element_size, dst, start);
  278. return;
  279. } else if (count == dst->num) {
  280. dst->num = 0;
  281. return;
  282. }
  283. move_count = dst->num - end;
  284. if (move_count)
  285. memmove(darray_item(element_size, dst, start),
  286. darray_item(element_size, dst, end),
  287. move_count * element_size);
  288. dst->num -= count;
  289. }
  290. static inline void darray_pop_back(const size_t element_size,
  291. struct darray *dst)
  292. {
  293. assert(dst->num != 0);
  294. if (dst->num)
  295. darray_erase(element_size, dst, dst->num - 1);
  296. }
  297. static inline void darray_join(const size_t element_size, struct darray *dst,
  298. struct darray *da)
  299. {
  300. darray_push_back_darray(element_size, dst, da);
  301. darray_free(da);
  302. }
  303. static inline void darray_split(const size_t element_size, struct darray *dst1,
  304. struct darray *dst2, const struct darray *da,
  305. const size_t idx)
  306. {
  307. struct darray temp;
  308. assert(da->num >= idx);
  309. assert(dst1 != dst2);
  310. darray_init(&temp);
  311. darray_copy(element_size, &temp, da);
  312. darray_free(dst1);
  313. darray_free(dst2);
  314. if (da->num) {
  315. if (idx)
  316. darray_copy_array(element_size, dst1, temp.array,
  317. temp.num);
  318. if (idx < temp.num - 1)
  319. darray_copy_array(element_size, dst2,
  320. darray_item(element_size, &temp, idx),
  321. temp.num - idx);
  322. }
  323. darray_free(&temp);
  324. }
  325. static inline void darray_move_item(const size_t element_size,
  326. struct darray *dst, const size_t from,
  327. const size_t to)
  328. {
  329. void *temp, *p_from, *p_to;
  330. if (from == to)
  331. return;
  332. temp = malloc(element_size);
  333. p_from = darray_item(element_size, dst, from);
  334. p_to = darray_item(element_size, dst, to);
  335. memcpy(temp, p_from, element_size);
  336. if (to < from)
  337. memmove(darray_item(element_size, dst, to + 1), p_to,
  338. element_size * (from - to));
  339. else
  340. memmove(p_from, darray_item(element_size, dst, from + 1),
  341. element_size * (to - from));
  342. memcpy(p_to, temp, element_size);
  343. free(temp);
  344. }
  345. static inline void darray_swap(const size_t element_size, struct darray *dst,
  346. const size_t a, const size_t b)
  347. {
  348. void *temp, *a_ptr, *b_ptr;
  349. assert(a < dst->num);
  350. assert(b < dst->num);
  351. if (a == b)
  352. return;
  353. temp = malloc(element_size);
  354. a_ptr = darray_item(element_size, dst, a);
  355. b_ptr = darray_item(element_size, dst, b);
  356. memcpy(temp, a_ptr, element_size);
  357. memcpy(a_ptr, b_ptr, element_size);
  358. memcpy(b_ptr, temp, element_size);
  359. free(temp);
  360. }
  361. /*
  362. * Defines to make dynamic arrays more type-safe.
  363. * Note: Still not 100% type-safe but much better than using darray directly
  364. * Makes it a little easier to use as well.
  365. *
  366. * I did -not- want to use a gigantic macro to generate a crapload of
  367. * typesafe inline functions per type. It just feels like a mess to me.
  368. */
  369. #define DARRAY(type) \
  370. union { \
  371. struct darray da; \
  372. struct { \
  373. type *array; \
  374. size_t num; \
  375. size_t capacity; \
  376. }; \
  377. }
  378. #define da_init(v) darray_init(&v.da)
  379. #define da_free(v) darray_free(&v.da)
  380. #define da_alloc_size(v) (sizeof(*v.array) * v.num)
  381. #define da_end(v) darray_end(sizeof(*v.array), &v.da)
  382. #define da_reserve(v, capacity) \
  383. darray_reserve(sizeof(*v.array), &v.da, capacity)
  384. #define da_resize(v, size) darray_resize(sizeof(*v.array), &v.da, size)
  385. #define da_copy(dst, src) darray_copy(sizeof(*dst.array), &dst.da, &src.da)
  386. #define da_copy_array(dst, src_array, n) \
  387. darray_copy_array(sizeof(*dst.array), &dst.da, src_array, n)
  388. #define da_move(dst, src) darray_move(&dst.da, &src.da)
  389. #define da_find(v, item, idx) darray_find(sizeof(*v.array), &v.da, item, idx)
  390. #define da_push_back(v, item) darray_push_back(sizeof(*v.array), &v.da, item)
  391. #define da_push_back_new(v) darray_push_back_new(sizeof(*v.array), &v.da)
  392. #define da_push_back_array(dst, src_array, n) \
  393. darray_push_back_array(sizeof(*dst.array), &dst.da, src_array, n)
  394. #define da_push_back_da(dst, src) \
  395. darray_push_back_darray(sizeof(*dst.array), &dst.da, &src.da)
  396. #define da_insert(v, idx, item) \
  397. darray_insert(sizeof(*v.array), &v.da, idx, item)
  398. #define da_insert_new(v, idx) darray_insert_new(sizeof(*v.array), &v.da, idx)
  399. #define da_insert_array(dst, idx, src_array, n) \
  400. darray_insert_array(sizeof(*dst.array), &dst.da, idx, src_array, n)
  401. #define da_insert_da(dst, idx, src) \
  402. darray_insert_darray(sizeof(*dst.array), &dst.da, idx, &src.da)
  403. #define da_erase(dst, idx) darray_erase(sizeof(*dst.array), &dst.da, idx)
  404. #define da_erase_item(dst, item) \
  405. darray_erase_item(sizeof(*dst.array), &dst.da, item)
  406. #define da_erase_range(dst, from, to) \
  407. darray_erase_range(sizeof(*dst.array), &dst.da, from, to)
  408. #define da_pop_back(dst) darray_pop_back(sizeof(*dst.array), &dst.da);
  409. #define da_join(dst, src) darray_join(sizeof(*dst.array), &dst.da, &src.da)
  410. #define da_split(dst1, dst2, src, idx) \
  411. darray_split(sizeof(*src.array), &dst1.da, &dst2.da, &src.da, idx)
  412. #define da_move_item(v, from, to) \
  413. darray_move_item(sizeof(*v.array), &v.da, from, to)
  414. #define da_swap(v, idx1, idx2) darray_swap(sizeof(*v.array), &v.da, idx1, idx2)
  415. #ifdef __cplusplus
  416. }
  417. #endif