darray.h 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534
  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 thhe 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,
  70. struct darray *dst, 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, const size_t new_size)
  85. {
  86. size_t new_cap;
  87. void *ptr;
  88. if (new_size <= dst->capacity)
  89. return;
  90. new_cap = (!dst->capacity) ? new_size : dst->capacity*2;
  91. if (new_size > new_cap)
  92. new_cap = new_size;
  93. ptr = bmalloc(element_size*new_cap);
  94. if (dst->capacity)
  95. memcpy(ptr, dst->array, element_size*dst->capacity);
  96. if (dst->array)
  97. bfree(dst->array);
  98. dst->array = ptr;
  99. dst->capacity = new_cap;
  100. }
  101. static inline void darray_resize(const size_t element_size,
  102. struct darray *dst, const size_t size)
  103. {
  104. int b_clear;
  105. size_t old_num;
  106. if (size == dst->num) {
  107. return;
  108. } else if (size == 0) {
  109. dst->num = 0;
  110. return;
  111. }
  112. b_clear = size > dst->num;
  113. old_num = dst->num;
  114. darray_ensure_capacity(element_size, dst, size);
  115. dst->num = size;
  116. if (b_clear)
  117. memset(darray_item(element_size, dst, old_num), 0,
  118. element_size * (dst->num-old_num));
  119. }
  120. static inline void darray_copy(const size_t element_size, struct darray *dst,
  121. const struct darray *da)
  122. {
  123. if (da->num == 0) {
  124. darray_free(dst);
  125. } else {
  126. darray_resize(element_size, dst, da->num);
  127. memcpy(dst->array, da->array, element_size*da->num);
  128. }
  129. }
  130. static inline void darray_copy_array(const size_t element_size,
  131. struct darray *dst, const void *array, const size_t num)
  132. {
  133. darray_resize(element_size, dst, num);
  134. memcpy(dst->array, array, element_size*dst->num);
  135. }
  136. static inline void darray_move(struct darray *dst, struct darray *src)
  137. {
  138. darray_free(dst);
  139. memcpy(dst, src, sizeof(struct darray));
  140. src->array = NULL;
  141. src->capacity = 0;
  142. src->num = 0;
  143. }
  144. static inline size_t darray_find(const size_t element_size,
  145. const struct darray *da, const void *item, const size_t idx)
  146. {
  147. size_t i;
  148. assert(idx <= da->num);
  149. for (i = idx; i < da->num; i++) {
  150. void *compare = darray_item(element_size, da, i);
  151. if (memcmp(compare, item, element_size) == 0)
  152. return i;
  153. }
  154. return DARRAY_INVALID;
  155. }
  156. static inline size_t darray_push_back(const size_t element_size,
  157. struct darray *dst, const void *item)
  158. {
  159. darray_ensure_capacity(element_size, dst, ++dst->num);
  160. memcpy(darray_end(element_size, dst), item, element_size);
  161. return dst->num-1;
  162. }
  163. static inline void *darray_push_back_new(const size_t element_size,
  164. struct darray *dst)
  165. {
  166. void *last;
  167. darray_ensure_capacity(element_size, dst, ++dst->num);
  168. last = darray_end(element_size, dst);
  169. memset(last, 0, element_size);
  170. return last;
  171. }
  172. static inline size_t darray_push_back_array(const size_t element_size,
  173. struct darray *dst, const void *array, const size_t num)
  174. {
  175. size_t old_num = dst->num;
  176. assert(array != NULL);
  177. assert(num != 0);
  178. darray_resize(element_size, dst, dst->num+num);
  179. memcpy(darray_item(element_size, dst, old_num), array,
  180. element_size*num);
  181. return old_num;
  182. }
  183. static inline size_t darray_push_back_darray(const size_t element_size,
  184. struct darray *dst, const struct darray *da)
  185. {
  186. return darray_push_back_array(element_size, dst, da->array, da->num);
  187. }
  188. static inline void darray_insert(const size_t element_size, struct darray *dst,
  189. const size_t idx, const void *item)
  190. {
  191. void *new_item;
  192. size_t move_count;
  193. assert(idx <= dst->num);
  194. if (idx == dst->num) {
  195. darray_push_back(element_size, dst, item);
  196. return;
  197. }
  198. move_count = dst->num - idx;
  199. darray_ensure_capacity(element_size, dst, ++dst->num);
  200. new_item = darray_item(element_size, dst, idx);
  201. memmove(darray_item(element_size, dst, idx+1), new_item,
  202. move_count*element_size);
  203. memcpy(new_item, item, element_size);
  204. }
  205. static inline void *darray_insert_new(const size_t element_size,
  206. struct darray *dst, const size_t idx)
  207. {
  208. void *item;
  209. size_t move_count;
  210. assert(idx <= dst->num);
  211. if (idx == dst->num)
  212. return darray_push_back_new(element_size, dst);
  213. item = darray_item(element_size, dst, idx);
  214. move_count = dst->num - idx;
  215. darray_ensure_capacity(element_size, dst, ++dst->num);
  216. memmove(darray_item(element_size, dst, idx+1), item,
  217. move_count*element_size);
  218. memset(item, 0, element_size);
  219. return item;
  220. }
  221. static inline void darray_insert_array(const size_t element_size,
  222. struct darray *dst, const size_t idx,
  223. const void *array, const size_t num)
  224. {
  225. size_t old_num;
  226. assert(array != NULL);
  227. assert(num != 0);
  228. assert(idx < dst->num);
  229. old_num = dst->num;
  230. darray_resize(element_size, dst, dst->num+num);
  231. memmove(darray_item(element_size, dst, idx+num),
  232. darray_item(element_size, dst, idx),
  233. element_size*(old_num-idx));
  234. memcpy(darray_item(element_size, dst, idx), array, element_size*num);
  235. }
  236. static inline void darray_insert_darray(const size_t element_size,
  237. struct darray *dst, const size_t idx, const struct darray *da)
  238. {
  239. darray_insert_array(element_size, dst, idx, da->array, da->num);
  240. }
  241. static inline void darray_erase(const size_t element_size, struct darray *dst,
  242. const size_t idx)
  243. {
  244. assert(idx < dst->num);
  245. if (idx >= dst->num)
  246. return;
  247. if (!--dst->num) {
  248. dst->num = 0;
  249. return;
  250. }
  251. memcpy(darray_item(element_size, dst, idx),
  252. darray_item(element_size, dst, idx+1),
  253. element_size*(dst->num-idx));
  254. }
  255. static inline void darray_erase_item(const size_t element_size,
  256. struct darray *dst, const void *item)
  257. {
  258. size_t idx = darray_find(element_size, dst, item, 0);
  259. if (idx != DARRAY_INVALID)
  260. darray_erase(element_size, dst, idx);
  261. }
  262. static inline void darray_erase_range(const size_t element_size,
  263. struct darray *dst, const size_t start, const size_t end)
  264. {
  265. size_t count, move_count;
  266. assert(start <= dst->num);
  267. assert(end <= dst->num);
  268. assert(end > start);
  269. count = end-start;
  270. if (count == 1) {
  271. darray_erase(element_size, dst, start);
  272. return;
  273. } else if (count == dst->num) {
  274. dst->num = 0;
  275. return;
  276. }
  277. move_count = dst->num - end;
  278. if (move_count)
  279. memmove(darray_item(element_size, dst, start),
  280. darray_item(element_size, dst, end),
  281. move_count);
  282. dst->num -= count;
  283. }
  284. static inline void darray_pop_back(const size_t element_size,
  285. struct darray *dst)
  286. {
  287. assert(dst->num != 0);
  288. if (dst->num)
  289. darray_erase(element_size, dst, dst->num-1);
  290. }
  291. static inline void darray_join(const size_t element_size, struct darray *dst,
  292. struct darray *da)
  293. {
  294. darray_push_back_darray(element_size, dst, da);
  295. darray_free(da);
  296. }
  297. static inline void darray_split(const size_t element_size, struct darray *dst1,
  298. struct darray *dst2, const struct darray *da, const size_t idx)
  299. {
  300. struct darray temp;
  301. assert(da->num >= idx);
  302. assert(dst1 != dst2);
  303. darray_init(&temp);
  304. darray_copy(element_size, &temp, da);
  305. darray_free(dst1);
  306. darray_free(dst2);
  307. if (da->num) {
  308. if (idx)
  309. darray_copy_array(element_size, dst1, temp.array,
  310. temp.num);
  311. if (idx < temp.num-1)
  312. darray_copy_array(element_size, dst2,
  313. darray_item(element_size, &temp, idx),
  314. temp.num-idx);
  315. }
  316. darray_free(&temp);
  317. }
  318. static inline void darray_move_item(const size_t element_size,
  319. struct darray *dst, const size_t from, const size_t to)
  320. {
  321. void *temp, *p_from, *p_to;
  322. if (from == to)
  323. return;
  324. temp = bmalloc(element_size);
  325. p_from = darray_item(element_size, dst, from);
  326. p_to = darray_item(element_size, dst, to);
  327. memcpy(temp, p_from, element_size);
  328. if (to < from)
  329. memmove(darray_item(element_size, dst, to+1), p_to,
  330. element_size*(from-to));
  331. else
  332. memcpy(p_from, darray_item(element_size, dst, from+1),
  333. element_size*(to-from));
  334. memcpy(p_to, temp, element_size);
  335. bfree(temp);
  336. }
  337. static inline void darray_swap(const size_t element_size,
  338. struct darray *dst, const size_t a, const size_t b)
  339. {
  340. void *temp, *a_ptr, *b_ptr;
  341. assert(a < dst->num);
  342. assert(b < dst->num);
  343. if (a == b)
  344. return;
  345. temp = bmalloc(element_size);
  346. a_ptr = darray_item(element_size, dst, a);
  347. b_ptr = darray_item(element_size, dst, b);
  348. memcpy(temp, a_ptr, element_size);
  349. memcpy(a_ptr, b_ptr, element_size);
  350. memcpy(b_ptr, temp, element_size);
  351. bfree(temp);
  352. }
  353. /*
  354. * Defines to make dynamic arrays more type-safe.
  355. * Note: Still not 100% type-safe but much better than using darray directly
  356. * Makes it a little easier to use as well.
  357. *
  358. * I did -not- want to use a gigantic macro to generate a crapload of
  359. * typsafe inline functions per type. It just feels like a mess to me.
  360. */
  361. #define DARRAY(type) \
  362. union { \
  363. struct darray da; \
  364. struct { \
  365. type *array; \
  366. size_t num; \
  367. size_t capacity; \
  368. }; \
  369. }
  370. #define da_init(v) darray_init(&v.da)
  371. #define da_free(v) darray_free(&v.da)
  372. #define da_alloc_size(v) (sizeof(*v.array)*v.num)
  373. #define da_end(v) darray_end(sizeof(*v.array), &v.da)
  374. #define da_reserve(v, capacity) \
  375. darray_reserve(sizeof(*v.array), &v.da, capacity)
  376. #define da_resize(v, size) darray_resize(sizeof(*v.array), &v.da, size)
  377. #define da_copy(dst, src) \
  378. darray_copy(sizeof(*dst.array), &dst.da, &src.da)
  379. #define da_copy_array(dst, src_array, n) \
  380. darray_copy_array(sizeof(*dst.array), &dst.da, src_array, n)
  381. #define da_move(dst, src) darray_move(&dst.da, &src.da)
  382. #define da_find(v, item, idx) \
  383. darray_find(sizeof(*v.array), &v.da, item, idx)
  384. #define da_push_back(v, item) darray_push_back(sizeof(*v.array), &v.da, item)
  385. #define da_push_back_new(v) darray_push_back_new(sizeof(*v.array), &v.da)
  386. #define da_push_back_array(dst, src_array, n) \
  387. darray_push_back_array(sizeof(*dst.array), &dst.da, src_array, n)
  388. #define da_push_back_da(dst, src) \
  389. darray_push_back_darray(sizeof(*dst.array), &dst.da, &src.da)
  390. #define da_insert(v, idx, item) \
  391. darray_insert(sizeof(*v.array), &v.da, idx, item)
  392. #define da_insert_new(v, idx) \
  393. darray_insert_new(sizeof(*v.array), &v.da, idx)
  394. #define da_insert_array(dst, idx, src_array, n) \
  395. darray_insert_array(sizeof(*dst.array), &dst.da, idx, \
  396. src_array, n)
  397. #define da_insert_da(dst, idx, src) \
  398. darray_insert_darray(sizeof(*dst.array), &dst.da, idx, \
  399. &src.da)
  400. #define da_erase(dst, idx) \
  401. darray_erase(sizeof(*dst.array), &dst.da, idx)
  402. #define da_erase_item(dst, item) \
  403. darray_erase_item(sizeof(*dst.array), &dst.da, item)
  404. #define da_erase_range(dst, from, to) \
  405. darray_erase_range(sizeof(*dst.array), &dst.da, from, to)
  406. #define da_pop_back(dst) \
  407. darray_pop_back(sizeof(*dst.array), &dst.da);
  408. #define da_join(dst, src) \
  409. 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, \
  412. &src.da, idx)
  413. #define da_move_item(v, from, to) \
  414. darray_move_item(sizeof(*v.array), &v.da, from, to)
  415. #define da_swap_item(v, idx1, idx2) \
  416. darray_swap(sizeof(v.array), &v.da, idx1, idx2)
  417. #ifdef __cplusplus
  418. }
  419. #endif