CAvl_impl.h 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671
  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 CAvlNode CAvl_nullnode (void)
  31. {
  32. CAvlNode n;
  33. n.link = CAvlNullLink;
  34. n.ptr = NULL;
  35. return n;
  36. }
  37. static int CAvl_compare_nodes (CAvlArg arg, CAvlNode node1, CAvlNode node2)
  38. {
  39. int res = CAVL_PARAM_COMPARE_NODES(arg, node1, node2);
  40. ASSERT(res >= -1)
  41. ASSERT(res <= 1)
  42. return res;
  43. }
  44. static int CAvl_compare_key_node (CAvlArg arg, CAvlKey key1, CAvlNode node2)
  45. {
  46. int res = CAVL_PARAM_COMPARE_KEY_NODE(arg, key1, node2);
  47. ASSERT(res >= -1)
  48. ASSERT(res <= 1)
  49. return res;
  50. }
  51. static int CAvl_check_parent (CAvlNode p, CAvlNode c)
  52. {
  53. return (p.link == CAvl_parent(c)) && (p.link == CAvlNullLink || c.link == CAvl_link(p)[0] || c.link == CAvl_link(p)[1]);
  54. }
  55. static int CAvl_verify_recurser (CAvlArg arg, CAvlNode n)
  56. {
  57. ASSERT_FORCE(CAvl_balance(n) >= -1)
  58. ASSERT_FORCE(CAvl_balance(n) <= 1)
  59. int height_left = 0;
  60. int height_right = 0;
  61. #if CAVL_PARAM_USE_COUNTS
  62. CAvlCount count_left = 0;
  63. CAvlCount count_right = 0;
  64. #endif
  65. // check left subtree
  66. if (CAvl_link(n)[0] != CAvlNullLink) {
  67. // check parent link
  68. ASSERT_FORCE(CAvl_parent(CAvl_Deref(arg, CAvl_link(n)[0])) == n.link)
  69. // check binary search tree
  70. ASSERT_FORCE(CAvl_compare_nodes(arg, CAvl_Deref(arg, CAvl_link(n)[0]), n) == -1)
  71. // recursively calculate height
  72. height_left = CAvl_verify_recurser(arg, CAvl_Deref(arg, CAvl_link(n)[0]));
  73. #if CAVL_PARAM_USE_COUNTS
  74. count_left = CAvl_count(CAvl_Deref(arg, CAvl_link(n)[0]));
  75. #endif
  76. }
  77. // check right subtree
  78. if (CAvl_link(n)[1] != CAvlNullLink) {
  79. // check parent link
  80. ASSERT_FORCE(CAvl_parent(CAvl_Deref(arg, CAvl_link(n)[1])) == n.link)
  81. // check binary search tree
  82. ASSERT_FORCE(CAvl_compare_nodes(arg, CAvl_Deref(arg, CAvl_link(n)[1]), n) == 1)
  83. // recursively calculate height
  84. height_right = CAvl_verify_recurser(arg, CAvl_Deref(arg, CAvl_link(n)[1]));
  85. #if CAVL_PARAM_USE_COUNTS
  86. count_right = CAvl_count(CAvl_Deref(arg, CAvl_link(n)[1]));
  87. #endif
  88. }
  89. // check balance factor
  90. ASSERT_FORCE(CAvl_balance(n) == height_right - height_left)
  91. #if CAVL_PARAM_USE_COUNTS
  92. // check count
  93. ASSERT(CAvl_count(n) == 1 + count_left + count_right)
  94. #endif
  95. return CAvl_MAX(height_left, height_right) + 1;
  96. }
  97. static void CAvl_assert_tree (CAvl *o, CAvlArg arg)
  98. {
  99. #ifdef CAVL_PARAM_VERIFY
  100. CAvl_Verify(o, arg);
  101. #endif
  102. }
  103. #if CAVL_PARAM_USE_COUNTS
  104. static void CAvl_update_count_from_children (CAvlArg arg, CAvlNode n)
  105. {
  106. CAvlCount left_count = CAvl_link(n)[0] != CAvlNullLink ? CAvl_count(CAvl_Deref(arg, CAvl_link(n)[0])) : 0;
  107. CAvlCount right_count = CAvl_link(n)[1] != CAvlNullLink ? CAvl_count(CAvl_Deref(arg, CAvl_link(n)[1])) : 0;
  108. CAvl_count(n) = 1 + left_count + right_count;
  109. }
  110. #endif
  111. static void CAvl_rotate (CAvl *o, CAvlArg arg, CAvlNode r, uint8_t dir, CAvlNode r_parent)
  112. {
  113. ASSERT(CAvl_check_parent(r_parent, r))
  114. CAvlNode nr = CAvl_Deref(arg, CAvl_link(r)[!dir]);
  115. CAvl_link(r)[!dir] = CAvl_link(nr)[dir];
  116. if (CAvl_link(r)[!dir] != CAvlNullLink) {
  117. CAvl_parent(CAvl_Deref(arg, CAvl_link(r)[!dir])) = r.link;
  118. }
  119. CAvl_link(nr)[dir] = r.link;
  120. CAvl_parent(nr) = r_parent.link;
  121. if (r_parent.link != CAvlNullLink) {
  122. CAvl_link(r_parent)[r.link == CAvl_link(r_parent)[1]] = nr.link;
  123. } else {
  124. o->root = nr.link;
  125. }
  126. CAvl_parent(r) = nr.link;
  127. #if CAVL_PARAM_USE_COUNTS
  128. CAvl_update_count_from_children(arg, r);
  129. CAvl_update_count_from_children(arg, nr);
  130. #endif
  131. }
  132. static CAvlNode CAvl_subtree_min (CAvlArg arg, CAvlNode n)
  133. {
  134. ASSERT(n.link != CAvlNullLink)
  135. while (CAvl_link(n)[0] != CAvlNullLink) {
  136. n = CAvl_Deref(arg, CAvl_link(n)[0]);
  137. }
  138. return n;
  139. }
  140. static CAvlNode CAvl_subtree_max (CAvlArg arg, CAvlNode n)
  141. {
  142. ASSERT(n.link != CAvlNullLink)
  143. while (CAvl_link(n)[1] != CAvlNullLink) {
  144. n = CAvl_Deref(arg, CAvl_link(n)[1]);
  145. }
  146. return n;
  147. }
  148. static void CAvl_replace_subtree_fix_counts (CAvl *o, CAvlArg arg, CAvlNode dest, CAvlNode n, CAvlNode dest_parent)
  149. {
  150. ASSERT(dest.link != CAvlNullLink)
  151. ASSERT(CAvl_check_parent(dest_parent, dest))
  152. if (dest_parent.link != CAvlNullLink) {
  153. CAvl_link(dest_parent)[dest.link == CAvl_link(dest_parent)[1]] = n.link;
  154. } else {
  155. o->root = n.link;
  156. }
  157. if (n.link != CAvlNullLink) {
  158. CAvl_parent(n) = CAvl_parent(dest);
  159. }
  160. #if CAVL_PARAM_USE_COUNTS
  161. for (CAvlNode c = dest_parent; c.link != CAvlNullLink; c = CAvl_Deref(arg, CAvl_parent(c))) {
  162. ASSERT(CAvl_count(c) >= CAvl_count(dest))
  163. CAvl_count(c) -= CAvl_count(dest);
  164. if (n.link != CAvlNullLink) {
  165. ASSERT(CAvl_count(n) <= CAVL_PARAM_COUNT_MAX - CAvl_count(c))
  166. CAvl_count(c) += CAvl_count(n);
  167. }
  168. }
  169. #endif
  170. }
  171. static void CAvl_swap_nodes (CAvl *o, CAvlArg arg, CAvlNode n1, CAvlNode n2, CAvlNode n1_parent, CAvlNode n2_parent)
  172. {
  173. ASSERT(CAvl_check_parent(n1_parent, n1))
  174. ASSERT(CAvl_check_parent(n2_parent, n2))
  175. if (n2_parent.link == n1.link || n1_parent.link == n2.link) {
  176. // when the nodes are directly connected we need special handling
  177. // make sure n1 is above n2
  178. if (n1_parent.link == n2.link) {
  179. CAvlNode t = n1;
  180. n1 = n2;
  181. n2 = t;
  182. t = n1_parent;
  183. n1_parent = n2_parent;
  184. n2_parent = t;
  185. }
  186. uint8_t side = (n2.link == CAvl_link(n1)[1]);
  187. CAvlNode c = CAvl_Deref(arg, CAvl_link(n1)[!side]);
  188. if ((CAvl_link(n1)[0] = CAvl_link(n2)[0]) != CAvlNullLink) {
  189. CAvl_parent(CAvl_Deref(arg, CAvl_link(n1)[0])) = n1.link;
  190. }
  191. if ((CAvl_link(n1)[1] = CAvl_link(n2)[1]) != CAvlNullLink) {
  192. CAvl_parent(CAvl_Deref(arg, CAvl_link(n1)[1])) = n1.link;
  193. }
  194. CAvl_parent(n2) = CAvl_parent(n1);
  195. if (n1_parent.link != CAvlNullLink) {
  196. CAvl_link(n1_parent)[n1.link == CAvl_link(n1_parent)[1]] = n2.link;
  197. } else {
  198. o->root = n2.link;
  199. }
  200. CAvl_link(n2)[side] = n1.link;
  201. CAvl_parent(n1) = n2.link;
  202. if ((CAvl_link(n2)[!side] = c.link) != CAvlNullLink) {
  203. CAvl_parent(c) = n2.link;
  204. }
  205. } else {
  206. CAvlNode temp;
  207. // swap parents
  208. temp = n1_parent;
  209. CAvl_parent(n1) = CAvl_parent(n2);
  210. if (n2_parent.link != CAvlNullLink) {
  211. CAvl_link(n2_parent)[n2.link == CAvl_link(n2_parent)[1]] = n1.link;
  212. } else {
  213. o->root = n1.link;
  214. }
  215. CAvl_parent(n2) = temp.link;
  216. if (temp.link != CAvlNullLink) {
  217. CAvl_link(temp)[n1.link == CAvl_link(temp)[1]] = n2.link;
  218. } else {
  219. o->root = n2.link;
  220. }
  221. // swap left children
  222. temp = CAvl_Deref(arg, CAvl_link(n1)[0]);
  223. if ((CAvl_link(n1)[0] = CAvl_link(n2)[0]) != CAvlNullLink) {
  224. CAvl_parent(CAvl_Deref(arg, CAvl_link(n1)[0])) = n1.link;
  225. }
  226. if ((CAvl_link(n2)[0] = temp.link) != CAvlNullLink) {
  227. CAvl_parent(CAvl_Deref(arg, CAvl_link(n2)[0])) = n2.link;
  228. }
  229. // swap right children
  230. temp = CAvl_Deref(arg, CAvl_link(n1)[1]);
  231. if ((CAvl_link(n1)[1] = CAvl_link(n2)[1]) != CAvlNullLink) {
  232. CAvl_parent(CAvl_Deref(arg, CAvl_link(n1)[1])) = n1.link;
  233. }
  234. if ((CAvl_link(n2)[1] = temp.link) != CAvlNullLink) {
  235. CAvl_parent(CAvl_Deref(arg, CAvl_link(n2)[1])) = n2.link;
  236. }
  237. }
  238. // swap balance factors
  239. int8_t b = CAvl_balance(n1);
  240. CAvl_balance(n1) = CAvl_balance(n2);
  241. CAvl_balance(n2) = b;
  242. #if CAVL_PARAM_USE_COUNTS
  243. // swap counts
  244. CAvlCount c = CAvl_count(n1);
  245. CAvl_count(n1) = CAvl_count(n2);
  246. CAvl_count(n2) = c;
  247. #endif
  248. }
  249. static void CAvl_rebalance (CAvl *o, CAvlArg arg, CAvlNode node, uint8_t side, int8_t deltac)
  250. {
  251. ASSERT(side == 0 || side == 1)
  252. ASSERT(deltac >= -1 && deltac <= 1)
  253. ASSERT(CAvl_balance(node) >= -1 && CAvl_balance(node) <= 1)
  254. // if no subtree changed its height, no more rebalancing is needed
  255. if (deltac == 0) {
  256. return;
  257. }
  258. // calculate how much our height changed
  259. int8_t delta = CAvl_MAX(deltac, CAvl_OPTNEG(CAvl_balance(node), side)) - CAvl_MAX(0, CAvl_OPTNEG(CAvl_balance(node), side));
  260. ASSERT(delta >= -1 && delta <= 1)
  261. // update our balance factor
  262. CAvl_balance(node) -= CAvl_OPTNEG(deltac, side);
  263. CAvlNode child;
  264. CAvlNode gchild;
  265. // perform transformations if the balance factor is wrong
  266. if (CAvl_balance(node) == 2 || CAvl_balance(node) == -2) {
  267. uint8_t bside;
  268. int8_t bsidef;
  269. if (CAvl_balance(node) == 2) {
  270. bside = 1;
  271. bsidef = 1;
  272. } else {
  273. bside = 0;
  274. bsidef = -1;
  275. }
  276. ASSERT(CAvl_link(node)[bside] != CAvlNullLink)
  277. child = CAvl_Deref(arg, CAvl_link(node)[bside]);
  278. switch (CAvl_balance(child) * bsidef) {
  279. case 1:
  280. CAvl_rotate(o, arg, node, !bside, CAvl_Deref(arg, CAvl_parent(node)));
  281. CAvl_balance(node) = 0;
  282. CAvl_balance(child) = 0;
  283. node = child;
  284. delta -= 1;
  285. break;
  286. case 0:
  287. CAvl_rotate(o, arg, node, !bside, CAvl_Deref(arg, CAvl_parent(node)));
  288. CAvl_balance(node) = 1 * bsidef;
  289. CAvl_balance(child) = -1 * bsidef;
  290. node = child;
  291. break;
  292. case -1:
  293. ASSERT(CAvl_link(child)[!bside] != CAvlNullLink)
  294. gchild = CAvl_Deref(arg, CAvl_link(child)[!bside]);
  295. CAvl_rotate(o, arg, child, bside, node);
  296. CAvl_rotate(o, arg, node, !bside, CAvl_Deref(arg, CAvl_parent(node)));
  297. CAvl_balance(node) = -CAvl_MAX(0, CAvl_balance(gchild) * bsidef) * bsidef;
  298. CAvl_balance(child) = CAvl_MAX(0, -CAvl_balance(gchild) * bsidef) * bsidef;
  299. CAvl_balance(gchild) = 0;
  300. node = gchild;
  301. delta -= 1;
  302. break;
  303. default:
  304. ASSERT(0);
  305. }
  306. }
  307. ASSERT(delta >= -1 && delta <= 1)
  308. // Transformations above preserve this. Proof:
  309. // - if a child subtree gained 1 height and rebalancing was needed,
  310. // it was the heavier subtree. Then delta was was originally 1, because
  311. // the heaviest subtree gained one height. If the transformation reduces
  312. // delta by one, it becomes 0.
  313. // - if a child subtree lost 1 height and rebalancing was needed, it
  314. // was the lighter subtree. Then delta was originally 0, because
  315. // the height of the heaviest subtree was unchanged. If the transformation
  316. // reduces delta by one, it becomes -1.
  317. if (CAvl_parent(node) != CAvlNullLink) {
  318. CAvlNode node_parent = CAvl_Deref(arg, CAvl_parent(node));
  319. CAvl_rebalance(o, arg, node_parent, node.link == CAvl_link(node_parent)[1], delta);
  320. }
  321. }
  322. static void CAvl_Init (CAvl *o)
  323. {
  324. o->root = CAvlNullLink;
  325. }
  326. static CAvlNode CAvl_Deref (CAvlArg arg, CAvlLink link)
  327. {
  328. if (link == CAvlNullLink) {
  329. return CAvl_nullnode();
  330. }
  331. CAvlNode n;
  332. n.ptr = CAVL_PARAM_DEREF(arg, link);
  333. n.link = link;
  334. ASSERT(n.ptr)
  335. return n;
  336. }
  337. static int CAvl_Insert (CAvl *o, CAvlArg arg, CAvlNode node, CAvlNode *out_ref)
  338. {
  339. ASSERT(node.link != CAvlNullLink)
  340. // insert to root?
  341. if (o->root == CAvlNullLink) {
  342. o->root = node.link;
  343. CAvl_parent(node) = CAvlNullLink;
  344. CAvl_link(node)[0] = CAvlNullLink;
  345. CAvl_link(node)[1] = CAvlNullLink;
  346. CAvl_balance(node) = 0;
  347. #if CAVL_PARAM_USE_COUNTS
  348. CAvl_count(node) = 1;
  349. #endif
  350. CAvl_assert_tree(o, arg);
  351. if (out_ref) {
  352. *out_ref = CAvl_nullnode();
  353. }
  354. return 1;
  355. }
  356. CAvlNode c = CAvl_Deref(arg, o->root);
  357. int side;
  358. while (1) {
  359. int comp = CAvl_compare_nodes(arg, node, c);
  360. if (comp == 0) {
  361. if (out_ref) {
  362. *out_ref = c;
  363. }
  364. return 0;
  365. }
  366. side = (comp == 1);
  367. if (CAvl_link(c)[side] == CAvlNullLink) {
  368. break;
  369. }
  370. c = CAvl_Deref(arg, CAvl_link(c)[side]);
  371. }
  372. CAvl_link(c)[side] = node.link;
  373. CAvl_parent(node) = c.link;
  374. CAvl_link(node)[0] = CAvlNullLink;
  375. CAvl_link(node)[1] = CAvlNullLink;
  376. CAvl_balance(node) = 0;
  377. #if CAVL_PARAM_USE_COUNTS
  378. CAvl_count(node) = 1;
  379. #endif
  380. #if CAVL_PARAM_USE_COUNTS
  381. for (CAvlNode p = c; p.link != CAvlNullLink; p = CAvl_Deref(arg, CAvl_parent(p))) {
  382. CAvl_count(p)++;
  383. }
  384. #endif
  385. CAvl_rebalance(o, arg, c, side, 1);
  386. CAvl_assert_tree(o, arg);
  387. if (out_ref) {
  388. *out_ref = c;
  389. }
  390. return 1;
  391. }
  392. static void CAvl_Remove (CAvl *o, CAvlArg arg, CAvlNode node)
  393. {
  394. ASSERT(node.link != CAvlNullLink)
  395. ASSERT(o->root != CAvlNullLink)
  396. if (CAvl_link(node)[0] != CAvlNullLink && CAvl_link(node)[1] != CAvlNullLink) {
  397. CAvlNode max = CAvl_subtree_max(arg, CAvl_Deref(arg, CAvl_link(node)[0]));
  398. CAvl_swap_nodes(o, arg, node, max, CAvl_Deref(arg, CAvl_parent(node)), CAvl_Deref(arg, CAvl_parent(max)));
  399. }
  400. ASSERT(CAvl_link(node)[0] == CAvlNullLink || CAvl_link(node)[1] == CAvlNullLink)
  401. CAvlNode paren = CAvl_Deref(arg, CAvl_parent(node));
  402. CAvlNode child = (CAvl_link(node)[0] != CAvlNullLink ? CAvl_Deref(arg, CAvl_link(node)[0]) : CAvl_Deref(arg, CAvl_link(node)[1]));
  403. if (paren.link != CAvlNullLink) {
  404. int side = (node.link == CAvl_link(paren)[1]);
  405. CAvl_replace_subtree_fix_counts(o, arg, node, child, paren);
  406. CAvl_rebalance(o, arg, paren, side, -1);
  407. } else {
  408. CAvl_replace_subtree_fix_counts(o, arg, node, child, paren);
  409. }
  410. CAvl_assert_tree(o, arg);
  411. }
  412. static CAvlNode CAvl_Lookup (const CAvl *o, CAvlArg arg, CAvlKey key)
  413. {
  414. if (o->root == CAvlNullLink) {
  415. return CAvl_nullnode();
  416. }
  417. CAvlNode c = CAvl_Deref(arg, o->root);
  418. while (1) {
  419. // compare
  420. int comp = CAvl_compare_key_node(arg, key, c);
  421. // have we found a node that compares equal?
  422. if (comp == 0) {
  423. return c;
  424. }
  425. int side = (comp == 1);
  426. // have we reached a leaf?
  427. if (CAvl_link(c)[side] == CAvlNullLink) {
  428. return c;
  429. }
  430. c = CAvl_Deref(arg, CAvl_link(c)[side]);
  431. }
  432. }
  433. static CAvlNode CAvl_LookupExact (const CAvl *o, CAvlArg arg, CAvlKey key)
  434. {
  435. if (o->root == CAvlNullLink) {
  436. return CAvl_nullnode();
  437. }
  438. CAvlNode c = CAvl_Deref(arg, o->root);
  439. while (1) {
  440. // compare
  441. int comp = CAvl_compare_key_node(arg, key, c);
  442. // have we found a node that compares equal?
  443. if (comp == 0) {
  444. return c;
  445. }
  446. int side = (comp == 1);
  447. // have we reached a leaf?
  448. if (CAvl_link(c)[side] == CAvlNullLink) {
  449. return CAvl_nullnode();
  450. }
  451. c = CAvl_Deref(arg, CAvl_link(c)[side]);
  452. }
  453. }
  454. static CAvlNode CAvl_GetFirst (const CAvl *o, CAvlArg arg)
  455. {
  456. if (o->root == CAvlNullLink) {
  457. return CAvl_nullnode();
  458. }
  459. return CAvl_subtree_min(arg, CAvl_Deref(arg, o->root));
  460. }
  461. static CAvlNode CAvl_GetLast (const CAvl *o, CAvlArg arg)
  462. {
  463. if (o->root == CAvlNullLink) {
  464. return CAvl_nullnode();
  465. }
  466. return CAvl_subtree_max(arg, CAvl_Deref(arg, o->root));
  467. }
  468. static CAvlNode CAvl_GetNext (const CAvl *o, CAvlArg arg, CAvlNode node)
  469. {
  470. ASSERT(node.link != CAvlNullLink)
  471. ASSERT(o->root != CAvlNullLink)
  472. if (CAvl_link(node)[1] != CAvlNullLink) {
  473. node = CAvl_Deref(arg, CAvl_link(node)[1]);
  474. while (CAvl_link(node)[0] != CAvlNullLink) {
  475. node = CAvl_Deref(arg, CAvl_link(node)[0]);
  476. }
  477. } else {
  478. while (CAvl_parent(node) != CAvlNullLink && node.link == CAvl_link(CAvl_Deref(arg, CAvl_parent(node)))[1]) {
  479. node = CAvl_Deref(arg, CAvl_parent(node));
  480. }
  481. node = CAvl_Deref(arg, CAvl_parent(node));
  482. }
  483. return node;
  484. }
  485. static CAvlNode CAvl_GetPrev (const CAvl *o, CAvlArg arg, CAvlNode node)
  486. {
  487. ASSERT(node.link != CAvlNullLink)
  488. ASSERT(o->root != CAvlNullLink)
  489. if (CAvl_link(node)[0] != CAvlNullLink) {
  490. node = CAvl_Deref(arg, CAvl_link(node)[0]);
  491. while (CAvl_link(node)[1] != CAvlNullLink) {
  492. node = CAvl_Deref(arg, CAvl_link(node)[1]);
  493. }
  494. } else {
  495. while (CAvl_parent(node) != CAvlNullLink && node.link == CAvl_link(CAvl_Deref(arg, CAvl_parent(node)))[0]) {
  496. node = CAvl_Deref(arg, CAvl_parent(node));
  497. }
  498. node = CAvl_Deref(arg, CAvl_parent(node));
  499. }
  500. return node;
  501. }
  502. static int CAvl_IsEmpty (const CAvl *o)
  503. {
  504. return o->root == CAvlNullLink;
  505. }
  506. static void CAvl_Verify (const CAvl *o, CAvlArg arg)
  507. {
  508. if (o->root != CAvlNullLink) {
  509. CAvlNode root = CAvl_Deref(arg, o->root);
  510. ASSERT(CAvl_parent(root) == CAvlNullLink)
  511. CAvl_verify_recurser(arg, root);
  512. }
  513. }
  514. #if CAVL_PARAM_USE_COUNTS
  515. static CAvlCount CAvl_Count (const CAvl *o, CAvlArg arg)
  516. {
  517. return (o->root != CAvlNullLink ? CAvl_count(CAvl_Deref(arg, o->root)) : 0);
  518. }
  519. static CAvlCount CAvl_IndexOf (const CAvl *o, CAvlArg arg, CAvlNode node)
  520. {
  521. ASSERT(node.link != CAvlNullLink)
  522. ASSERT(o->root != CAvlNullLink)
  523. CAvlCount index = (CAvl_link(node)[0] != CAvlNullLink ? CAvl_count(CAvl_Deref(arg, CAvl_link(node)[0])) : 0);
  524. CAvlNode paren = CAvl_Deref(arg, CAvl_parent(node));
  525. for (CAvlNode c = node; paren.link != CAvlNullLink; c = paren) {
  526. if (c.link == CAvl_link(paren)[1]) {
  527. ASSERT(CAvl_count(paren) > CAvl_count(c))
  528. ASSERT(CAvl_count(paren) - CAvl_count(c) <= CAVL_PARAM_COUNT_MAX - index)
  529. index += CAvl_count(paren) - CAvl_count(c);
  530. }
  531. paren = CAvl_Deref(arg, CAvl_parent(c));
  532. }
  533. return index;
  534. }
  535. static CAvlNode CAvl_GetAt (const CAvl *o, CAvlArg arg, CAvlCount index)
  536. {
  537. if (index >= CAvl_Count(o, arg)) {
  538. return CAvl_nullnode();
  539. }
  540. CAvlNode c = CAvl_Deref(arg, o->root);
  541. while (1) {
  542. ASSERT(c.link != CAvlNullLink)
  543. ASSERT(index < CAvl_count(c))
  544. CAvlCount left_count = (CAvl_link(c)[0] != CAvlNullLink ? CAvl_count(CAvl_Deref(arg, CAvl_link(c)[0])) : 0);
  545. if (index == left_count) {
  546. return c;
  547. }
  548. if (index < left_count) {
  549. c = CAvl_Deref(arg, CAvl_link(c)[0]);
  550. } else {
  551. c = CAvl_Deref(arg, CAvl_link(c)[1]);
  552. index -= left_count + 1;
  553. }
  554. }
  555. }
  556. #endif
  557. #include "CAvl_footer.h"