CAvl_impl.h 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771
  1. /**
  2. * @file CAvl_impl.h
  3. * @author Ambroz Bizjak <ambrop7@gmail.com>
  4. *
  5. * @section LICENSE
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions are met:
  9. * 1. Redistributions of source code must retain the above copyright
  10. * notice, this list of conditions and the following disclaimer.
  11. * 2. Redistributions in binary form must reproduce the above copyright
  12. * notice, this list of conditions and the following disclaimer in the
  13. * documentation and/or other materials provided with the distribution.
  14. * 3. Neither the name of the author nor the
  15. * names of its contributors may be used to endorse or promote products
  16. * derived from this software without specific prior written permission.
  17. *
  18. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
  19. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  20. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  21. * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  22. * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  23. * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  24. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  25. * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  27. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28. */
  29. #include "CAvl_header.h"
  30. static CAvlLink CAvl_nulllink (void)
  31. {
  32. return CAVL_PARAM_VALUE_NULL;
  33. }
  34. static CAvlRef CAvl_nullref (void)
  35. {
  36. CAvlRef n;
  37. n.link = CAVL_PARAM_VALUE_NULL;
  38. n.ptr = NULL;
  39. return n;
  40. }
  41. #if !CAVL_PARAM_FEATURE_KEYS_ARE_INDICES
  42. static int CAvl_compare_entries (CAvlArg arg, CAvlRef node1, CAvlRef node2)
  43. {
  44. int res = CAVL_PARAM_FUN_COMPARE_ENTRIES(arg, node1, node2);
  45. ASSERT(res >= -1)
  46. ASSERT(res <= 1)
  47. return res;
  48. }
  49. #if !CAVL_PARAM_FEATURE_NOKEYS
  50. static int CAvl_compare_key_entry (CAvlArg arg, CAvlKey key1, CAvlRef node2)
  51. {
  52. int res = CAVL_PARAM_FUN_COMPARE_KEY_ENTRY(arg, key1, node2);
  53. ASSERT(res >= -1)
  54. ASSERT(res <= 1)
  55. return res;
  56. }
  57. #endif
  58. #endif
  59. static int CAvl_check_parent (CAvlRef p, CAvlRef c)
  60. {
  61. return (p.link == CAvl_parent(c)) && (p.link == CAvl_nulllink() || c.link == CAvl_link(p)[0] || c.link == CAvl_link(p)[1]);
  62. }
  63. static int CAvl_verify_recurser (CAvlArg arg, CAvlRef n)
  64. {
  65. ASSERT_FORCE(CAvl_balance(n) >= -1)
  66. ASSERT_FORCE(CAvl_balance(n) <= 1)
  67. int height_left = 0;
  68. int height_right = 0;
  69. #if CAVL_PARAM_FEATURE_COUNTS
  70. CAvlCount count_left = 0;
  71. CAvlCount count_right = 0;
  72. #endif
  73. // check left subtree
  74. if (CAvl_link(n)[0] != CAvl_nulllink()) {
  75. // check parent link
  76. ASSERT_FORCE(CAvl_parent(CAvlDeref(arg, CAvl_link(n)[0])) == n.link)
  77. // check binary search tree
  78. #if !CAVL_PARAM_FEATURE_KEYS_ARE_INDICES
  79. ASSERT_FORCE(CAvl_compare_entries(arg, CAvlDeref(arg, CAvl_link(n)[0]), n) == -1)
  80. #endif
  81. // recursively calculate height
  82. height_left = CAvl_verify_recurser(arg, CAvlDeref(arg, CAvl_link(n)[0]));
  83. #if CAVL_PARAM_FEATURE_COUNTS
  84. count_left = CAvl_count(CAvlDeref(arg, CAvl_link(n)[0]));
  85. #endif
  86. }
  87. // check right subtree
  88. if (CAvl_link(n)[1] != CAvl_nulllink()) {
  89. // check parent link
  90. ASSERT_FORCE(CAvl_parent(CAvlDeref(arg, CAvl_link(n)[1])) == n.link)
  91. // check binary search tree
  92. #if !CAVL_PARAM_FEATURE_KEYS_ARE_INDICES
  93. ASSERT_FORCE(CAvl_compare_entries(arg, CAvlDeref(arg, CAvl_link(n)[1]), n) == 1)
  94. #endif
  95. // recursively calculate height
  96. height_right = CAvl_verify_recurser(arg, CAvlDeref(arg, CAvl_link(n)[1]));
  97. #if CAVL_PARAM_FEATURE_COUNTS
  98. count_right = CAvl_count(CAvlDeref(arg, CAvl_link(n)[1]));
  99. #endif
  100. }
  101. // check balance factor
  102. ASSERT_FORCE(CAvl_balance(n) == height_right - height_left)
  103. #if CAVL_PARAM_FEATURE_COUNTS
  104. // check count
  105. ASSERT_FORCE(CAvl_count(n) == 1 + count_left + count_right)
  106. #endif
  107. return CAvl_MAX(height_left, height_right) + 1;
  108. }
  109. static void CAvl_assert_tree (CAvl *o, CAvlArg arg)
  110. {
  111. #ifdef CAVL_PARAM_VERIFY
  112. CAvl_Verify(o, arg);
  113. #endif
  114. }
  115. #if CAVL_PARAM_FEATURE_COUNTS
  116. static void CAvl_update_count_from_children (CAvlArg arg, CAvlRef n)
  117. {
  118. CAvlCount left_count = CAvl_link(n)[0] != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, CAvl_link(n)[0])) : 0;
  119. CAvlCount right_count = CAvl_link(n)[1] != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, CAvl_link(n)[1])) : 0;
  120. CAvl_count(n) = 1 + left_count + right_count;
  121. }
  122. #endif
  123. static void CAvl_rotate (CAvl *o, CAvlArg arg, CAvlRef r, uint8_t dir, CAvlRef r_parent)
  124. {
  125. ASSERT(CAvl_check_parent(r_parent, r))
  126. CAvlRef nr = CAvlDeref(arg, CAvl_link(r)[!dir]);
  127. CAvl_link(r)[!dir] = CAvl_link(nr)[dir];
  128. if (CAvl_link(r)[!dir] != CAvl_nulllink()) {
  129. CAvl_parent(CAvlDeref(arg, CAvl_link(r)[!dir])) = r.link;
  130. }
  131. CAvl_link(nr)[dir] = r.link;
  132. CAvl_parent(nr) = r_parent.link;
  133. if (r_parent.link != CAvl_nulllink()) {
  134. CAvl_link(r_parent)[r.link == CAvl_link(r_parent)[1]] = nr.link;
  135. } else {
  136. o->root = nr.link;
  137. }
  138. CAvl_parent(r) = nr.link;
  139. #if CAVL_PARAM_FEATURE_COUNTS
  140. CAvl_update_count_from_children(arg, r);
  141. CAvl_update_count_from_children(arg, nr);
  142. #endif
  143. }
  144. static CAvlRef CAvl_subtree_min (CAvlArg arg, CAvlRef n)
  145. {
  146. ASSERT(n.link != CAvl_nulllink())
  147. while (CAvl_link(n)[0] != CAvl_nulllink()) {
  148. n = CAvlDeref(arg, CAvl_link(n)[0]);
  149. }
  150. return n;
  151. }
  152. static CAvlRef CAvl_subtree_max (CAvlArg arg, CAvlRef n)
  153. {
  154. ASSERT(n.link != CAvl_nulllink())
  155. while (CAvl_link(n)[1] != CAvl_nulllink()) {
  156. n = CAvlDeref(arg, CAvl_link(n)[1]);
  157. }
  158. return n;
  159. }
  160. static void CAvl_replace_subtree_fix_counts (CAvl *o, CAvlArg arg, CAvlRef dest, CAvlRef n, CAvlRef dest_parent)
  161. {
  162. ASSERT(dest.link != CAvl_nulllink())
  163. ASSERT(CAvl_check_parent(dest_parent, dest))
  164. if (dest_parent.link != CAvl_nulllink()) {
  165. CAvl_link(dest_parent)[dest.link == CAvl_link(dest_parent)[1]] = n.link;
  166. } else {
  167. o->root = n.link;
  168. }
  169. if (n.link != CAvl_nulllink()) {
  170. CAvl_parent(n) = CAvl_parent(dest);
  171. }
  172. #if CAVL_PARAM_FEATURE_COUNTS
  173. for (CAvlRef c = dest_parent; c.link != CAvl_nulllink(); c = CAvlDeref(arg, CAvl_parent(c))) {
  174. ASSERT(CAvl_count(c) >= CAvl_count(dest))
  175. CAvl_count(c) -= CAvl_count(dest);
  176. if (n.link != CAvl_nulllink()) {
  177. ASSERT(CAvl_count(n) <= CAVL_PARAM_VALUE_COUNT_MAX - CAvl_count(c))
  178. CAvl_count(c) += CAvl_count(n);
  179. }
  180. }
  181. #endif
  182. }
  183. static void CAvl_swap_entries (CAvl *o, CAvlArg arg, CAvlRef n1, CAvlRef n2, CAvlRef n1_parent, CAvlRef n2_parent)
  184. {
  185. ASSERT(CAvl_check_parent(n1_parent, n1))
  186. ASSERT(CAvl_check_parent(n2_parent, n2))
  187. if (n2_parent.link == n1.link || n1_parent.link == n2.link) {
  188. // when the nodes are directly connected we need special handling
  189. // make sure n1 is above n2
  190. if (n1_parent.link == n2.link) {
  191. CAvlRef t = n1;
  192. n1 = n2;
  193. n2 = t;
  194. t = n1_parent;
  195. n1_parent = n2_parent;
  196. n2_parent = t;
  197. }
  198. uint8_t side = (n2.link == CAvl_link(n1)[1]);
  199. CAvlRef c = CAvlDeref(arg, CAvl_link(n1)[!side]);
  200. if ((CAvl_link(n1)[0] = CAvl_link(n2)[0]) != CAvl_nulllink()) {
  201. CAvl_parent(CAvlDeref(arg, CAvl_link(n1)[0])) = n1.link;
  202. }
  203. if ((CAvl_link(n1)[1] = CAvl_link(n2)[1]) != CAvl_nulllink()) {
  204. CAvl_parent(CAvlDeref(arg, CAvl_link(n1)[1])) = n1.link;
  205. }
  206. CAvl_parent(n2) = CAvl_parent(n1);
  207. if (n1_parent.link != CAvl_nulllink()) {
  208. CAvl_link(n1_parent)[n1.link == CAvl_link(n1_parent)[1]] = n2.link;
  209. } else {
  210. o->root = n2.link;
  211. }
  212. CAvl_link(n2)[side] = n1.link;
  213. CAvl_parent(n1) = n2.link;
  214. if ((CAvl_link(n2)[!side] = c.link) != CAvl_nulllink()) {
  215. CAvl_parent(c) = n2.link;
  216. }
  217. } else {
  218. CAvlRef temp;
  219. // swap parents
  220. temp = n1_parent;
  221. CAvl_parent(n1) = CAvl_parent(n2);
  222. if (n2_parent.link != CAvl_nulllink()) {
  223. CAvl_link(n2_parent)[n2.link == CAvl_link(n2_parent)[1]] = n1.link;
  224. } else {
  225. o->root = n1.link;
  226. }
  227. CAvl_parent(n2) = temp.link;
  228. if (temp.link != CAvl_nulllink()) {
  229. CAvl_link(temp)[n1.link == CAvl_link(temp)[1]] = n2.link;
  230. } else {
  231. o->root = n2.link;
  232. }
  233. // swap left children
  234. temp = CAvlDeref(arg, CAvl_link(n1)[0]);
  235. if ((CAvl_link(n1)[0] = CAvl_link(n2)[0]) != CAvl_nulllink()) {
  236. CAvl_parent(CAvlDeref(arg, CAvl_link(n1)[0])) = n1.link;
  237. }
  238. if ((CAvl_link(n2)[0] = temp.link) != CAvl_nulllink()) {
  239. CAvl_parent(CAvlDeref(arg, CAvl_link(n2)[0])) = n2.link;
  240. }
  241. // swap right children
  242. temp = CAvlDeref(arg, CAvl_link(n1)[1]);
  243. if ((CAvl_link(n1)[1] = CAvl_link(n2)[1]) != CAvl_nulllink()) {
  244. CAvl_parent(CAvlDeref(arg, CAvl_link(n1)[1])) = n1.link;
  245. }
  246. if ((CAvl_link(n2)[1] = temp.link) != CAvl_nulllink()) {
  247. CAvl_parent(CAvlDeref(arg, CAvl_link(n2)[1])) = n2.link;
  248. }
  249. }
  250. // swap balance factors
  251. int8_t b = CAvl_balance(n1);
  252. CAvl_balance(n1) = CAvl_balance(n2);
  253. CAvl_balance(n2) = b;
  254. #if CAVL_PARAM_FEATURE_COUNTS
  255. // swap counts
  256. CAvlCount c = CAvl_count(n1);
  257. CAvl_count(n1) = CAvl_count(n2);
  258. CAvl_count(n2) = c;
  259. #endif
  260. }
  261. static void CAvl_rebalance (CAvl *o, CAvlArg arg, CAvlRef node, uint8_t side, int8_t deltac)
  262. {
  263. ASSERT(side == 0 || side == 1)
  264. ASSERT(deltac >= -1 && deltac <= 1)
  265. ASSERT(CAvl_balance(node) >= -1 && CAvl_balance(node) <= 1)
  266. // if no subtree changed its height, no more rebalancing is needed
  267. if (deltac == 0) {
  268. return;
  269. }
  270. // calculate how much our height changed
  271. int8_t delta = CAvl_MAX(deltac, CAvl_OPTNEG(CAvl_balance(node), side)) - CAvl_MAX(0, CAvl_OPTNEG(CAvl_balance(node), side));
  272. ASSERT(delta >= -1 && delta <= 1)
  273. // update our balance factor
  274. CAvl_balance(node) -= CAvl_OPTNEG(deltac, side);
  275. CAvlRef child;
  276. CAvlRef gchild;
  277. // perform transformations if the balance factor is wrong
  278. if (CAvl_balance(node) == 2 || CAvl_balance(node) == -2) {
  279. uint8_t bside;
  280. int8_t bsidef;
  281. if (CAvl_balance(node) == 2) {
  282. bside = 1;
  283. bsidef = 1;
  284. } else {
  285. bside = 0;
  286. bsidef = -1;
  287. }
  288. ASSERT(CAvl_link(node)[bside] != CAvl_nulllink())
  289. child = CAvlDeref(arg, CAvl_link(node)[bside]);
  290. switch (CAvl_balance(child) * bsidef) {
  291. case 1:
  292. CAvl_rotate(o, arg, node, !bside, CAvlDeref(arg, CAvl_parent(node)));
  293. CAvl_balance(node) = 0;
  294. CAvl_balance(child) = 0;
  295. node = child;
  296. delta -= 1;
  297. break;
  298. case 0:
  299. CAvl_rotate(o, arg, node, !bside, CAvlDeref(arg, CAvl_parent(node)));
  300. CAvl_balance(node) = 1 * bsidef;
  301. CAvl_balance(child) = -1 * bsidef;
  302. node = child;
  303. break;
  304. case -1:
  305. ASSERT(CAvl_link(child)[!bside] != CAvl_nulllink())
  306. gchild = CAvlDeref(arg, CAvl_link(child)[!bside]);
  307. CAvl_rotate(o, arg, child, bside, node);
  308. CAvl_rotate(o, arg, node, !bside, CAvlDeref(arg, CAvl_parent(node)));
  309. CAvl_balance(node) = -CAvl_MAX(0, CAvl_balance(gchild) * bsidef) * bsidef;
  310. CAvl_balance(child) = CAvl_MAX(0, -CAvl_balance(gchild) * bsidef) * bsidef;
  311. CAvl_balance(gchild) = 0;
  312. node = gchild;
  313. delta -= 1;
  314. break;
  315. default:
  316. ASSERT(0);
  317. }
  318. }
  319. ASSERT(delta >= -1 && delta <= 1)
  320. // Transformations above preserve this. Proof:
  321. // - if a child subtree gained 1 height and rebalancing was needed,
  322. // it was the heavier subtree. Then delta was was originally 1, because
  323. // the heaviest subtree gained one height. If the transformation reduces
  324. // delta by one, it becomes 0.
  325. // - if a child subtree lost 1 height and rebalancing was needed, it
  326. // was the lighter subtree. Then delta was originally 0, because
  327. // the height of the heaviest subtree was unchanged. If the transformation
  328. // reduces delta by one, it becomes -1.
  329. if (CAvl_parent(node) != CAvl_nulllink()) {
  330. CAvlRef node_parent = CAvlDeref(arg, CAvl_parent(node));
  331. CAvl_rebalance(o, arg, node_parent, node.link == CAvl_link(node_parent)[1], delta);
  332. }
  333. }
  334. #if CAVL_PARAM_FEATURE_KEYS_ARE_INDICES
  335. static CAvlCount CAvl_child_count (CAvlArg arg, CAvlRef n, int dir)
  336. {
  337. return (CAvl_link(n)[dir] != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, CAvl_link(n)[dir])) : 0);
  338. }
  339. #endif
  340. static int CAvlIsNullRef (CAvlRef node)
  341. {
  342. return node.link == CAvl_nulllink();
  343. }
  344. static int CAvlIsValidRef (CAvlRef node)
  345. {
  346. return node.link != CAvl_nulllink();
  347. }
  348. static CAvlRef CAvlDeref (CAvlArg arg, CAvlLink link)
  349. {
  350. if (link == CAvl_nulllink()) {
  351. return CAvl_nullref();
  352. }
  353. CAvlRef n;
  354. n.ptr = CAVL_PARAM_FUN_DEREF(arg, link);
  355. n.link = link;
  356. ASSERT(n.ptr)
  357. return n;
  358. }
  359. static void CAvl_Init (CAvl *o)
  360. {
  361. o->root = CAvl_nulllink();
  362. }
  363. #if !CAVL_PARAM_FEATURE_KEYS_ARE_INDICES
  364. static int CAvl_Insert (CAvl *o, CAvlArg arg, CAvlRef node, CAvlRef *out_ref)
  365. {
  366. ASSERT(node.link != CAvl_nulllink())
  367. #if CAVL_PARAM_FEATURE_COUNTS
  368. ASSERT(CAvl_Count(o, arg) < CAVL_PARAM_VALUE_COUNT_MAX)
  369. #endif
  370. // insert to root?
  371. if (o->root == CAvl_nulllink()) {
  372. o->root = node.link;
  373. CAvl_parent(node) = CAvl_nulllink();
  374. CAvl_link(node)[0] = CAvl_nulllink();
  375. CAvl_link(node)[1] = CAvl_nulllink();
  376. CAvl_balance(node) = 0;
  377. #if CAVL_PARAM_FEATURE_COUNTS
  378. CAvl_count(node) = 1;
  379. #endif
  380. CAvl_assert_tree(o, arg);
  381. if (out_ref) {
  382. *out_ref = CAvl_nullref();
  383. }
  384. return 1;
  385. }
  386. CAvlRef c = CAvlDeref(arg, o->root);
  387. int side;
  388. while (1) {
  389. int comp = CAvl_compare_entries(arg, node, c);
  390. if (comp == 0) {
  391. if (out_ref) {
  392. *out_ref = c;
  393. }
  394. return 0;
  395. }
  396. side = (comp == 1);
  397. if (CAvl_link(c)[side] == CAvl_nulllink()) {
  398. break;
  399. }
  400. c = CAvlDeref(arg, CAvl_link(c)[side]);
  401. }
  402. CAvl_link(c)[side] = node.link;
  403. CAvl_parent(node) = c.link;
  404. CAvl_link(node)[0] = CAvl_nulllink();
  405. CAvl_link(node)[1] = CAvl_nulllink();
  406. CAvl_balance(node) = 0;
  407. #if CAVL_PARAM_FEATURE_COUNTS
  408. CAvl_count(node) = 1;
  409. #endif
  410. #if CAVL_PARAM_FEATURE_COUNTS
  411. for (CAvlRef p = c; p.link != CAvl_nulllink(); p = CAvlDeref(arg, CAvl_parent(p))) {
  412. CAvl_count(p)++;
  413. }
  414. #endif
  415. CAvl_rebalance(o, arg, c, side, 1);
  416. CAvl_assert_tree(o, arg);
  417. if (out_ref) {
  418. *out_ref = c;
  419. }
  420. return 1;
  421. }
  422. #else
  423. static void CAvl_InsertAt (CAvl *o, CAvlArg arg, CAvlRef node, CAvlCount index)
  424. {
  425. ASSERT(node.link != CAvl_nulllink())
  426. ASSERT(index <= CAvl_Count(o, arg))
  427. ASSERT(CAvl_Count(o, arg) < CAVL_PARAM_VALUE_COUNT_MAX)
  428. // insert to root?
  429. if (o->root == CAvl_nulllink()) {
  430. o->root = node.link;
  431. CAvl_parent(node) = CAvl_nulllink();
  432. CAvl_link(node)[0] = CAvl_nulllink();
  433. CAvl_link(node)[1] = CAvl_nulllink();
  434. CAvl_balance(node) = 0;
  435. CAvl_count(node) = 1;
  436. CAvl_assert_tree(o, arg);
  437. return;
  438. }
  439. CAvlRef c = CAvlDeref(arg, o->root);
  440. CAvlCount c_idx = CAvl_child_count(arg, c, 0);
  441. int side;
  442. while (1) {
  443. side = (index > c_idx);
  444. if (CAvl_link(c)[side] == CAvl_nulllink()) {
  445. break;
  446. }
  447. c = CAvlDeref(arg, CAvl_link(c)[side]);
  448. if (side == 0) {
  449. c_idx -= 1 + CAvl_child_count(arg, c, 1);
  450. } else {
  451. c_idx += 1 + CAvl_child_count(arg, c, 0);
  452. }
  453. }
  454. CAvl_link(c)[side] = node.link;
  455. CAvl_parent(node) = c.link;
  456. CAvl_link(node)[0] = CAvl_nulllink();
  457. CAvl_link(node)[1] = CAvl_nulllink();
  458. CAvl_balance(node) = 0;
  459. CAvl_count(node) = 1;
  460. for (CAvlRef p = c; p.link != CAvl_nulllink(); p = CAvlDeref(arg, CAvl_parent(p))) {
  461. CAvl_count(p)++;
  462. }
  463. CAvl_rebalance(o, arg, c, side, 1);
  464. CAvl_assert_tree(o, arg);
  465. return;
  466. }
  467. #endif
  468. static void CAvl_Remove (CAvl *o, CAvlArg arg, CAvlRef node)
  469. {
  470. ASSERT(node.link != CAvl_nulllink())
  471. ASSERT(o->root != CAvl_nulllink())
  472. if (CAvl_link(node)[0] != CAvl_nulllink() && CAvl_link(node)[1] != CAvl_nulllink()) {
  473. CAvlRef max = CAvl_subtree_max(arg, CAvlDeref(arg, CAvl_link(node)[0]));
  474. CAvl_swap_entries(o, arg, node, max, CAvlDeref(arg, CAvl_parent(node)), CAvlDeref(arg, CAvl_parent(max)));
  475. }
  476. ASSERT(CAvl_link(node)[0] == CAvl_nulllink() || CAvl_link(node)[1] == CAvl_nulllink())
  477. CAvlRef paren = CAvlDeref(arg, CAvl_parent(node));
  478. CAvlRef child = (CAvl_link(node)[0] != CAvl_nulllink() ? CAvlDeref(arg, CAvl_link(node)[0]) : CAvlDeref(arg, CAvl_link(node)[1]));
  479. if (paren.link != CAvl_nulllink()) {
  480. int side = (node.link == CAvl_link(paren)[1]);
  481. CAvl_replace_subtree_fix_counts(o, arg, node, child, paren);
  482. CAvl_rebalance(o, arg, paren, side, -1);
  483. } else {
  484. CAvl_replace_subtree_fix_counts(o, arg, node, child, paren);
  485. }
  486. CAvl_assert_tree(o, arg);
  487. }
  488. #if !CAVL_PARAM_FEATURE_KEYS_ARE_INDICES && !CAVL_PARAM_FEATURE_NOKEYS
  489. static CAvlRef CAvl_Lookup (const CAvl *o, CAvlArg arg, CAvlKey key)
  490. {
  491. if (o->root == CAvl_nulllink()) {
  492. return CAvl_nullref();
  493. }
  494. CAvlRef c = CAvlDeref(arg, o->root);
  495. while (1) {
  496. // compare
  497. int comp = CAvl_compare_key_entry(arg, key, c);
  498. // have we found a node that compares equal?
  499. if (comp == 0) {
  500. return c;
  501. }
  502. int side = (comp == 1);
  503. // have we reached a leaf?
  504. if (CAvl_link(c)[side] == CAvl_nulllink()) {
  505. return c;
  506. }
  507. c = CAvlDeref(arg, CAvl_link(c)[side]);
  508. }
  509. }
  510. static CAvlRef CAvl_LookupExact (const CAvl *o, CAvlArg arg, CAvlKey key)
  511. {
  512. if (o->root == CAvl_nulllink()) {
  513. return CAvl_nullref();
  514. }
  515. CAvlRef c = CAvlDeref(arg, o->root);
  516. while (1) {
  517. // compare
  518. int comp = CAvl_compare_key_entry(arg, key, c);
  519. // have we found a node that compares equal?
  520. if (comp == 0) {
  521. return c;
  522. }
  523. int side = (comp == 1);
  524. // have we reached a leaf?
  525. if (CAvl_link(c)[side] == CAvl_nulllink()) {
  526. return CAvl_nullref();
  527. }
  528. c = CAvlDeref(arg, CAvl_link(c)[side]);
  529. }
  530. }
  531. #endif
  532. static CAvlRef CAvl_GetFirst (const CAvl *o, CAvlArg arg)
  533. {
  534. if (o->root == CAvl_nulllink()) {
  535. return CAvl_nullref();
  536. }
  537. return CAvl_subtree_min(arg, CAvlDeref(arg, o->root));
  538. }
  539. static CAvlRef CAvl_GetLast (const CAvl *o, CAvlArg arg)
  540. {
  541. if (o->root == CAvl_nulllink()) {
  542. return CAvl_nullref();
  543. }
  544. return CAvl_subtree_max(arg, CAvlDeref(arg, o->root));
  545. }
  546. static CAvlRef CAvl_GetNext (const CAvl *o, CAvlArg arg, CAvlRef node)
  547. {
  548. ASSERT(node.link != CAvl_nulllink())
  549. ASSERT(o->root != CAvl_nulllink())
  550. if (CAvl_link(node)[1] != CAvl_nulllink()) {
  551. node = CAvlDeref(arg, CAvl_link(node)[1]);
  552. while (CAvl_link(node)[0] != CAvl_nulllink()) {
  553. node = CAvlDeref(arg, CAvl_link(node)[0]);
  554. }
  555. } else {
  556. while (CAvl_parent(node) != CAvl_nulllink() && node.link == CAvl_link(CAvlDeref(arg, CAvl_parent(node)))[1]) {
  557. node = CAvlDeref(arg, CAvl_parent(node));
  558. }
  559. node = CAvlDeref(arg, CAvl_parent(node));
  560. }
  561. return node;
  562. }
  563. static CAvlRef CAvl_GetPrev (const CAvl *o, CAvlArg arg, CAvlRef node)
  564. {
  565. ASSERT(node.link != CAvl_nulllink())
  566. ASSERT(o->root != CAvl_nulllink())
  567. if (CAvl_link(node)[0] != CAvl_nulllink()) {
  568. node = CAvlDeref(arg, CAvl_link(node)[0]);
  569. while (CAvl_link(node)[1] != CAvl_nulllink()) {
  570. node = CAvlDeref(arg, CAvl_link(node)[1]);
  571. }
  572. } else {
  573. while (CAvl_parent(node) != CAvl_nulllink() && node.link == CAvl_link(CAvlDeref(arg, CAvl_parent(node)))[0]) {
  574. node = CAvlDeref(arg, CAvl_parent(node));
  575. }
  576. node = CAvlDeref(arg, CAvl_parent(node));
  577. }
  578. return node;
  579. }
  580. static int CAvl_IsEmpty (const CAvl *o)
  581. {
  582. return o->root == CAvl_nulllink();
  583. }
  584. static void CAvl_Verify (const CAvl *o, CAvlArg arg)
  585. {
  586. if (o->root != CAvl_nulllink()) {
  587. CAvlRef root = CAvlDeref(arg, o->root);
  588. ASSERT(CAvl_parent(root) == CAvl_nulllink())
  589. CAvl_verify_recurser(arg, root);
  590. }
  591. }
  592. #if CAVL_PARAM_FEATURE_COUNTS
  593. static CAvlCount CAvl_Count (const CAvl *o, CAvlArg arg)
  594. {
  595. return (o->root != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, o->root)) : 0);
  596. }
  597. static CAvlCount CAvl_IndexOf (const CAvl *o, CAvlArg arg, CAvlRef node)
  598. {
  599. ASSERT(node.link != CAvl_nulllink())
  600. ASSERT(o->root != CAvl_nulllink())
  601. CAvlCount index = (CAvl_link(node)[0] != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, CAvl_link(node)[0])) : 0);
  602. CAvlRef paren = CAvlDeref(arg, CAvl_parent(node));
  603. for (CAvlRef c = node; paren.link != CAvl_nulllink(); c = paren, paren = CAvlDeref(arg, CAvl_parent(c))) {
  604. if (c.link == CAvl_link(paren)[1]) {
  605. ASSERT(CAvl_count(paren) > CAvl_count(c))
  606. ASSERT(CAvl_count(paren) - CAvl_count(c) <= CAVL_PARAM_VALUE_COUNT_MAX - index)
  607. index += CAvl_count(paren) - CAvl_count(c);
  608. }
  609. }
  610. return index;
  611. }
  612. static CAvlRef CAvl_GetAt (const CAvl *o, CAvlArg arg, CAvlCount index)
  613. {
  614. if (index >= CAvl_Count(o, arg)) {
  615. return CAvl_nullref();
  616. }
  617. CAvlRef c = CAvlDeref(arg, o->root);
  618. while (1) {
  619. ASSERT(c.link != CAvl_nulllink())
  620. ASSERT(index < CAvl_count(c))
  621. CAvlCount left_count = (CAvl_link(c)[0] != CAvl_nulllink() ? CAvl_count(CAvlDeref(arg, CAvl_link(c)[0])) : 0);
  622. if (index == left_count) {
  623. return c;
  624. }
  625. if (index < left_count) {
  626. c = CAvlDeref(arg, CAvl_link(c)[0]);
  627. } else {
  628. c = CAvlDeref(arg, CAvl_link(c)[1]);
  629. index -= left_count + 1;
  630. }
  631. }
  632. }
  633. #endif
  634. #include "CAvl_footer.h"