darray.h 13 KB

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