idr.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880
  1. #include <common/idr.h>
  2. #include <mm/slab.h>
  3. /**
  4. * @brief 更换两个idr_layer指针
  5. *
  6. * @param a
  7. * @param b
  8. */
  9. static void __swap(struct idr_layer **a, struct idr_layer **b)
  10. {
  11. struct idr_layer *t = *a;
  12. *a = *b, *b = t;
  13. }
  14. /**
  15. * @brief 初始化idr - 你需要保证函数调用之前 free_list指针 为空
  16. *
  17. * @param idp
  18. */
  19. void idr_init(struct idr *idp)
  20. {
  21. memset(idp, 0, sizeof(struct idr));
  22. spin_init(&idp->lock);
  23. }
  24. /**
  25. * @brief 向idr的free_list中添加一个节点(空节点)
  26. *
  27. * @param idp
  28. * @param p
  29. */
  30. static void __move_to_free_list(struct idr *idp, struct idr_layer *p)
  31. {
  32. spin_lock(&idp->lock);
  33. // 插入free_list
  34. p->ary[0] = idp->free_list;
  35. idp->free_list = p;
  36. ++(idp->id_free_cnt);
  37. spin_unlock(&idp->lock);
  38. }
  39. /**
  40. * @brief Get the free_idr_layer from free list object
  41. *
  42. * @param idp
  43. * @return void*
  44. */
  45. static void *__get_from_free_list(struct idr *idp)
  46. {
  47. if (idp->id_free_cnt == 0)
  48. {
  49. if (idr_pre_get(idp, 0) != 0)
  50. {
  51. kBUG("idr-module find a BUG: get free node fail.(Possible ENOMEM error)");
  52. return NULL;
  53. }
  54. }
  55. spin_lock(&idp->lock);
  56. // free_list还有节点
  57. struct idr_layer *item = idp->free_list;
  58. idp->free_list = idp->free_list->ary[0];
  59. item->ary[0] = NULL; // 记得清空原来的数据
  60. --(idp->id_free_cnt);
  61. spin_unlock(&idp->lock);
  62. return item;
  63. }
  64. /**
  65. * @brief 为idr预分配空间
  66. *
  67. * @param idp
  68. * @param gfp_mask
  69. * @return int (如果分配成功,将返回0; 否则返回负数 -ENOMEM, 有可能是内存空间不够)
  70. */
  71. int idr_pre_get(struct idr *idp, gfp_t gfp_mask)
  72. {
  73. int timer = 0;
  74. while (idp->id_free_cnt < IDR_FREE_MAX)
  75. {
  76. struct idr_layer *new_one;
  77. new_one = kzalloc(sizeof(struct idr_layer), gfp_mask); // 默认清空?
  78. if (NULL == new_one)
  79. return -ENOMEM;
  80. __move_to_free_list(idp, new_one);
  81. timer++;
  82. }
  83. return 0;
  84. }
  85. /**
  86. * @brief 释放一个layer的空间
  87. *
  88. * @param p
  89. */
  90. static void __idr_layer_free(struct idr_layer *p)
  91. {
  92. kfree(p);
  93. }
  94. /**
  95. * @brief 向上生长一层idr_layer
  96. *
  97. * @param idp
  98. * @return int (0生长成功, 否则返回错误码)
  99. */
  100. static int __idr_grow(struct idr *idp)
  101. {
  102. struct idr_layer *new_node = __get_from_free_list(idp);
  103. if (NULL == new_node)
  104. return -ENOMEM;
  105. __swap(&new_node, &idp->top);
  106. idp->top->ary[0] = new_node;
  107. idp->top->layer = new_node ? (new_node->layer + 1) : 0; // 注意特判空指针
  108. idp->top->bitmap = 0;
  109. idp->top->full = 0; // clear
  110. if (new_node != NULL) // 设置第0位 = 1, 同时维护树的大小
  111. {
  112. idp->top->bitmap = 1;
  113. }
  114. if (new_node != NULL && new_node->full == IDR_FULL)
  115. {
  116. idp->top->full = 1; // 别忘了初始化 full
  117. }
  118. return 0;
  119. }
  120. /**
  121. * @brief 获取一个没有被占领的ID
  122. *
  123. * @param idp
  124. * @param stk 栈空间
  125. * @return int (负数表示获取ID失败, [0 <= id && id <= INT_MAX] 则获取ID成功)
  126. */
  127. static int __idr_get_empty_slot(struct idr *idp, struct idr_layer **stk)
  128. {
  129. // 注意特判 idp->top == NULL
  130. while (NULL == idp->top || idp->top->full == IDR_FULL)
  131. if (__idr_grow(idp) != 0)
  132. return -ENOMEM;
  133. int id = 0;
  134. int layer = idp->top->layer;
  135. stk[layer + 1] = NULL; // 标志为数组末尾
  136. struct idr_layer *cur_layer = idp->top;
  137. while (layer >= 0)
  138. {
  139. stk[layer] = cur_layer;
  140. int pos = __lowbit_id(~cur_layer->full);
  141. if (unlikely(pos < 0))
  142. {
  143. kBUG("Value 'cur_layer->full' had been full;"
  144. "but __idr_get_empty_slot still try to insert a value.");
  145. }
  146. id = (id << IDR_BITS) | pos;
  147. cur_layer = cur_layer->ary[pos];
  148. if (layer > 0 && NULL == cur_layer) // 只有非叶子节点才需要开辟儿子节点
  149. {
  150. // 初始化儿子节点
  151. cur_layer = __get_from_free_list(idp);
  152. if (NULL == cur_layer)
  153. return -ENOMEM;
  154. cur_layer->layer = layer - 1; // 儿子节点的layer
  155. cur_layer->full = 0;
  156. cur_layer->bitmap = 0;
  157. stk[layer]->ary[pos] = cur_layer; // 最后别忘了记录儿子节点
  158. }
  159. --layer;
  160. }
  161. return id;
  162. }
  163. /**
  164. * @brief 更新full对象 (辅助函数,内部没有边界特判)
  165. *
  166. * @param idp
  167. * @param id
  168. * @param stk 需要保证stk数组末尾是NULL
  169. * @param mark 0代表叶子空, 1代表叶子非空但未满, 2代表满
  170. */
  171. static __always_inline void __idr_mark_full(struct idr *idp, int id, struct idr_layer **stk, int mark)
  172. {
  173. if (unlikely(NULL == stk[0] || NULL == idp->top))
  174. {
  175. kBUG("idr-module find a BUG: idp->top can't be NULL.");
  176. return;
  177. }
  178. // 处理叶子节点的full/bitmap标记
  179. int layer_id = id & IDR_MASK;
  180. if (mark == 2)
  181. stk[0]->full |= (1ull << layer_id);
  182. if (mark >= 1)
  183. stk[0]->bitmap |= (1ull << layer_id);
  184. for (int i = 1; stk[i]; ++i)
  185. {
  186. id >>= IDR_BITS;
  187. layer_id = id & IDR_MASK;
  188. stk[i]->bitmap |= (1ull << layer_id);
  189. if (stk[i - 1]->full == IDR_FULL)
  190. stk[i]->full |= (1ull << layer_id);
  191. }
  192. }
  193. /**
  194. * @brief 提取一条已存在的路径
  195. *
  196. * @param idp
  197. * @param id
  198. * @param stk
  199. * @return int (0表示没有这条路径, 1表示找到这条路径)
  200. */
  201. static __always_inline int __idr_get_path(struct idr *idp, int id, struct idr_layer **stk)
  202. {
  203. if (unlikely(idp->top == NULL || id < 0))
  204. {
  205. kBUG("idr-module find a BUG: idp->top can't be NULL and id must be non-negative.");
  206. return 0;
  207. }
  208. struct idr_layer *cur_layer = idp->top;
  209. int layer = cur_layer->layer;
  210. stk[layer + 1] = NULL; // 标志数组结尾
  211. // 提取路径
  212. while (layer >= 0)
  213. {
  214. stk[layer] = cur_layer;
  215. int layer_id = (id >> (layer * IDR_BITS)) & IDR_MASK;
  216. if (unlikely(((cur_layer->bitmap >> layer_id) & 1) == 0))
  217. {
  218. kBUG("idr-module find a BUG: no-such son.");
  219. return 0; // 没有这一个儿子
  220. }
  221. cur_layer = cur_layer->ary[layer_id];
  222. --layer;
  223. }
  224. return 1;
  225. }
  226. /**
  227. * @brief 更新full对象 (辅助函数,内部没有边界特判)
  228. *
  229. * @param idp
  230. * @param id
  231. * @param stk 需要保证stk数组末尾是NULL
  232. * @param mark 0代表叶子空, 1代表叶子非空但未满, 2代表满
  233. */
  234. static __always_inline void __idr_erase_full(struct idr *idp, int id, struct idr_layer **stk, int mark)
  235. {
  236. if (unlikely(NULL == stk[0] || NULL == idp->top))
  237. {
  238. kBUG("idr-module find a BUG: idp->top can't be NULL.");
  239. return;
  240. }
  241. // 处理叶子节点的full/bitmap标记
  242. int layer_id = id & IDR_MASK;
  243. if (mark == 0) // 叶子的某个插槽为空
  244. {
  245. stk[0]->ary[layer_id] = NULL;
  246. stk[0]->bitmap ^= (1ull << layer_id);
  247. }
  248. if (mark != 2 && ((stk[0]->full >> layer_id) & 1))
  249. stk[0]->full ^= (1ull << layer_id);
  250. // 删除节点
  251. for (int layer = 1; stk[layer]; ++layer)
  252. {
  253. id >>= IDR_BITS;
  254. layer_id = id & IDR_MASK;
  255. if (NULL == stk[layer - 1]->bitmap) // 儿子是空节点
  256. {
  257. stk[layer]->ary[layer_id] = NULL;
  258. stk[layer]->bitmap ^= (1ull << layer_id);
  259. if ((stk[layer]->full >> layer_id) & 1)
  260. stk[layer]->full ^= (1ull << layer_id);
  261. __idr_layer_free(stk[layer - 1]);
  262. stk[layer - 1] = NULL; // 释放空间记得设置为 NULL
  263. }
  264. else if (stk[layer - 1]->full != IDR_FULL)
  265. {
  266. if ((stk[layer]->full >> layer_id) & 1)
  267. stk[layer]->full ^= (1ull << layer_id);
  268. }
  269. }
  270. // 特判根节点是否只剩0号儿子节点 (注意还要layer > 0)
  271. // (注意,有可能出现idp->top=NULL)
  272. // bitmap: 1000...000/00.....000
  273. while (idp->top != NULL && ((idp->top->bitmap <= 1 && idp->top->layer > 0) || // 一条链的情况
  274. (idp->top->layer == 0 && idp->top->bitmap == 0))) // 最后一个点的情况
  275. {
  276. struct idr_layer *t = idp->top->layer ? idp->top->ary[0] : NULL;
  277. __idr_layer_free(idp->top);
  278. idp->top = t;
  279. }
  280. }
  281. /**
  282. * @brief 内部的分配ID函数 (辅助函数)
  283. *
  284. * @param idp
  285. * @param ptr
  286. * @param starting_id 暂时没用
  287. * @return (0 <= id <= INT_MAX 表示申请的ID;否则是负数错误码, 可能是内存空间不够或者程序逻辑有误);
  288. */
  289. static int __idr_get_new_above_int(struct idr *idp, void *ptr, int starting_id)
  290. {
  291. struct idr_layer *stk[MAX_LEVEL + 1]; // 你可以选择memset(0)
  292. int id = __idr_get_empty_slot(idp, stk);
  293. if (id >= 0)
  294. {
  295. stk[0]->ary[IDR_MASK & id] = ptr;
  296. __idr_mark_full(idp, id, stk, 2);
  297. }
  298. return id;
  299. }
  300. /**
  301. * @brief 从[0,INT_MAX]区间内返回一个最小的空闲ID
  302. *
  303. * @param idp
  304. * @param ptr - id 所对应的指针
  305. * @param int* id - 传入int指针,获取到的NEW_ID存在id里
  306. * @return int (0表示获取id成功, 负数代表错误 - 可能是内存空间不够)
  307. */
  308. int idr_get_new(struct idr *idp, void *ptr, int *id)
  309. {
  310. int rv = __idr_get_new_above_int(idp, ptr, 0);
  311. if (rv < 0)
  312. return rv; // error
  313. *id = rv;
  314. return 0;
  315. }
  316. /**
  317. * @brief 删除一个id,但是不释放对应的ptr指向的空间
  318. *
  319. * @param idp
  320. * @param id
  321. */
  322. void idr_remove(struct idr *idp, int id)
  323. {
  324. if (unlikely(idp->top == NULL || id < 0))
  325. return;
  326. struct idr_layer *stk[MAX_LEVEL + 1];
  327. if (0 == __idr_get_path(idp, id, stk))
  328. return; // 找不到路径
  329. __idr_erase_full(idp, id, stk, 0);
  330. }
  331. /**
  332. * @brief 移除IDR中所有的节点,如果free=true,则同时释放所有数据指针的空间(kfree)
  333. *
  334. * @param idp
  335. * @param free
  336. */
  337. static void __idr_remove_all_with_free(struct idr *idp, bool free)
  338. {
  339. if (unlikely(NULL == idp->top))
  340. {
  341. kBUG("idr-module find a BUG: idp->top can't be NULL.");
  342. return;
  343. }
  344. int sz = sizeof(struct idr_layer);
  345. struct idr_layer *stk[MAX_LEVEL + 1];
  346. struct idr_layer *cur_layer = idp->top;
  347. int layer = cur_layer->layer;
  348. stk[layer + 1] = NULL; // 标记数组结尾
  349. while (cur_layer != NULL)
  350. {
  351. if (layer > 0 && cur_layer->bitmap) // 非叶子节点
  352. {
  353. stk[layer] = cur_layer; // 入栈
  354. int id = __lowbit_id(cur_layer->bitmap);
  355. cur_layer->bitmap ^= (1ull << id);
  356. cur_layer = cur_layer->ary[id];
  357. stk[layer]->ary[id] = NULL;
  358. --layer;
  359. }
  360. else
  361. {
  362. if (free)
  363. {
  364. for (int i = 0; i < IDR_SIZE; i++) // 释放数据指针的空间
  365. {
  366. kfree(cur_layer->ary[i]);
  367. cur_layer->ary[i] = NULL;
  368. }
  369. }
  370. __idr_layer_free(cur_layer); // 释放空间记得设置为NULL
  371. ++layer;
  372. cur_layer = stk[layer]; // 出栈
  373. }
  374. }
  375. idp->top = NULL;
  376. }
  377. /**
  378. * @brief 删除idr的所有节点,同时释放数据指针的空间,回收free_list的所有空间 - (数据指针指ID所绑定的pointer)
  379. * @param idp
  380. */
  381. static void __idr_destroy_with_free(struct idr *idp)
  382. {
  383. if (likely(idp->top))
  384. __idr_remove_all_with_free(idp, 1);
  385. idp->top = NULL;
  386. while (idp->id_free_cnt)
  387. __idr_layer_free(__get_from_free_list(idp));
  388. idp->free_list = NULL;
  389. }
  390. /**
  391. * @brief 删除所有的ID
  392. *
  393. * @param idp
  394. */
  395. void idr_remove_all(struct idr *idp)
  396. {
  397. if (unlikely(NULL == idp->top))
  398. return;
  399. __idr_remove_all_with_free(idp, 0);
  400. }
  401. /**
  402. * @brief 释放一个idr占用的所有空间
  403. *
  404. * @param idp
  405. */
  406. void idr_destroy(struct idr *idp)
  407. {
  408. idr_remove_all(idp);
  409. idp->top = NULL;
  410. while (idp->id_free_cnt)
  411. __idr_layer_free(__get_from_free_list(idp));
  412. idp->free_list = NULL;
  413. }
  414. /**
  415. * @brief 返回id对应的数据指针
  416. *
  417. * @param idp
  418. * @param id
  419. * @return void* (如果id不存在返回NULL;否则返回对应的指针ptr; 注意: 有可能用户的数据本来就是NULL)
  420. */
  421. void *idr_find(struct idr *idp, int id)
  422. {
  423. if (unlikely(idp->top == NULL || id < 0))
  424. return NULL;
  425. struct idr_layer *cur_layer = idp->top;
  426. int layer = cur_layer->layer; // 特判NULL
  427. // 如果查询的ID的bit数量比layer*IDR_BITS还大, 直接返回NULL
  428. if ((id >> ((layer + 1) * IDR_BITS)) > 0)
  429. return NULL;
  430. while (layer >= 0 && cur_layer)
  431. {
  432. int layer_id = (id >> (IDR_BITS * layer)) & IDR_MASK;
  433. cur_layer = cur_layer->ary[layer_id];
  434. --layer;
  435. }
  436. return cur_layer;
  437. }
  438. /**
  439. * @brief 返回id大于 start_id 的数据指针(即非空闲id对应的指针), 如果没有则返回NULL; 可以传入nextid指针,获取下一个id;
  440. * 时间复杂度O(log_64(n)), 空间复杂度O(log_64(n)) 约为 6;
  441. *
  442. * @param idp
  443. * @param start_id
  444. * @param nextid
  445. * @return void*
  446. */
  447. void *idr_find_next_getid(struct idr *idp, int start_id, int *nextid)
  448. {
  449. if (unlikely(idp->top == NULL))
  450. {
  451. *nextid = -1;
  452. return NULL;
  453. }
  454. ++start_id;
  455. start_id = max(0, start_id); // 特判负数
  456. *nextid = 0;
  457. struct idr_layer *stk[MAX_LEVEL + 1];
  458. bool state[MAX_LEVEL + 1]; // 标记是否大于等于]
  459. int pos_i[MAX_LEVEL + 1];
  460. memset(pos_i, 0, sizeof(pos_i)); // 必须清空
  461. struct idr_layer *cur_layer = idp->top;
  462. bool cur_state = false;
  463. bool init_flag = true;
  464. int layer = cur_layer->layer;
  465. stk[layer + 1] = NULL; // 标记数组结尾
  466. // 如果查询的ID的bit数量比layer*IDR_BITS还大, 直接返回NULL
  467. if ((start_id >> ((layer + 1) * IDR_BITS)) > 0)
  468. {
  469. *nextid = -1;
  470. return NULL;
  471. }
  472. while (cur_layer) // layer < top->layer + 1
  473. {
  474. if (init_flag) // 第一次入栈
  475. {
  476. stk[layer] = cur_layer;
  477. state[layer] = cur_state;
  478. pos_i[layer] = cur_state ? 0 : ((start_id >> (layer * IDR_BITS)) & IDR_MASK);
  479. }
  480. else
  481. {
  482. pos_i[layer]++;
  483. state[layer] = cur_state = true;
  484. }
  485. unsigned long t_bitmap = (cur_layer->bitmap >> pos_i[layer]);
  486. if (t_bitmap) // 进一步递归到儿子下面去
  487. {
  488. int layer_id = __lowbit_id(t_bitmap) + pos_i[layer];
  489. // 特别情况
  490. if (NULL == cur_state && layer_id > pos_i[layer] > 0)
  491. cur_state = true;
  492. pos_i[layer] = layer_id;
  493. *nextid = (((uint64_t)*nextid) << IDR_BITS) | layer_id; // 更新答案
  494. if (layer == 0)
  495. {
  496. // 找到下一个id: nextid
  497. return cur_layer->ary[layer_id];
  498. }
  499. cur_layer = cur_layer->ary[layer_id];
  500. init_flag = true; // 儿子节点第一次入栈, 需要init
  501. --layer;
  502. }
  503. else // 子树搜索完毕,向上回溯
  504. {
  505. (*nextid) >>= IDR_BITS; // 维护答案
  506. ++layer;
  507. cur_layer = stk[layer];
  508. init_flag = false; // 不是第一次入栈, 不需要init
  509. }
  510. }
  511. *nextid = -1;
  512. return NULL; // 找不到
  513. }
  514. /**
  515. * @brief 返回id大于 start_id 的数据指针(即非空闲id对应的指针), 如果没有则返回NULL
  516. *
  517. * @param idp
  518. * @param start_id
  519. * @return void*
  520. */
  521. void *idr_find_next(struct idr *idp, int start_id)
  522. {
  523. int nextid;
  524. void *ptr = idr_find_next_getid(idp, start_id, &nextid);
  525. return ptr; // 当 nextid == -1 时, 出现错误
  526. }
  527. /**
  528. * @brief 根据id替换指针,你需要保证这个id存在于idr中,否则将会出现错误
  529. *
  530. * @param idp
  531. * @param ptr (要替换旧指针的新指针 - new_ptr)
  532. * @param id
  533. * @param old_ptr (返回旧指针, 注意NULL不一定是出现错误,有可能是数据本来就是NULL)
  534. * @return int (0代表成功,否则就是负数 - 代表错误)
  535. */
  536. int idr_replace_get_old(struct idr *idp, void *ptr, int id, void **old_ptr)
  537. {
  538. *old_ptr = NULL;
  539. if (unlikely(idp->top == NULL || id < 0))
  540. return -EDOM; // 参数错误
  541. struct idr_layer *cur_layer = idp->top;
  542. int layer = cur_layer->layer;
  543. // 如果查询的ID的bit数量比layer*IDR_BITS还大, 直接返回NULL
  544. if ((id >> ((layer + 1) * IDR_BITS)) > 0)
  545. return -EDOM;
  546. while (layer > 0)
  547. {
  548. int layer_id = (id >> (layer * IDR_BITS)) & IDR_MASK;
  549. if (unlikely(NULL == cur_layer->ary[layer_id]))
  550. return -ENOMEM;
  551. cur_layer = cur_layer->ary[layer_id];
  552. layer--;
  553. }
  554. id &= IDR_MASK;
  555. *old_ptr = cur_layer->ary[id];
  556. cur_layer->ary[id] = ptr;
  557. return 0;
  558. }
  559. /**
  560. * @brief 根据id替换指针,你需要保证这个id存在于idr中,否则将会出现错误
  561. *
  562. * @param idp
  563. * @param ptr (要替换 '旧数据指针' 的 '新数据指针' - new_ptr)
  564. * @param id
  565. * @return int (0代表成功,否则就是错误码 - 代表错误)
  566. */
  567. int idr_replace(struct idr *idp, void *ptr, int id)
  568. {
  569. if (id < 0)
  570. return -EDOM;
  571. void *old_ptr;
  572. int flags = idr_replace_get_old(idp, ptr, id, &old_ptr);
  573. return flags;
  574. }
  575. /**
  576. * @brief 初始化IDA, 你需要保证调用函数之前, ida的free_list为空, 否则会导致内存泄漏
  577. * @param ida_p
  578. */
  579. void ida_init(struct ida *ida_p)
  580. {
  581. memset(ida_p, 0, sizeof(struct ida));
  582. idr_init(&ida_p->idr);
  583. }
  584. /**
  585. * @brief 释放bitmap空间
  586. *
  587. */
  588. static void __ida_bitmap_free(struct ida_bitmap *bitmap)
  589. {
  590. kfree(bitmap);
  591. }
  592. /**
  593. * @brief 为ida预分配空间
  594. *
  595. * @param ida_p
  596. * @param gfp_mask
  597. * @return int (如果分配成功,将返回0; 否则返回负数错误码, 有可能是内存空间不够)
  598. */
  599. int ida_pre_get(struct ida *ida_p, gfp_t gfp_mask)
  600. {
  601. if (idr_pre_get(&ida_p->idr, gfp_mask) != 0)
  602. return -ENOMEM;
  603. spin_lock(&ida_p->idr.lock);
  604. if (NULL == ida_p->free_list)
  605. {
  606. struct ida_bitmap *bitmap;
  607. bitmap = kzalloc(sizeof(struct ida_bitmap), gfp_mask);
  608. if (NULL == bitmap)
  609. {
  610. spin_unlock(&ida_p->idr.lock);
  611. return -ENOMEM;
  612. }
  613. ida_p->free_list = bitmap;
  614. }
  615. spin_unlock(&ida_p->idr.lock);
  616. return 0;
  617. }
  618. /**
  619. * @brief Get the ida bitmap object
  620. *
  621. * @param ida_p
  622. * @return void*
  623. */
  624. static void *__get_ida_bitmap(struct ida *ida_p, gfp_t gfp_mask)
  625. {
  626. if (NULL == ida_p->free_list)
  627. if (ida_pre_get(ida_p, gfp_mask) < 0)
  628. return NULL;
  629. struct ida_bitmap *tmp = ida_p->free_list;
  630. ida_p->free_list = NULL;
  631. return tmp;
  632. }
  633. /**
  634. * @brief 从bitmap中获取id, 并且标记这个ID已经被使用
  635. * @return int
  636. */
  637. static int __get_id_from_bitmap(struct ida_bitmap *bmp)
  638. {
  639. int ret = 0;
  640. for (int ary_id = 0; ary_id < IDA_BITMAP_LONGS; ary_id++)
  641. {
  642. if (bmp->bitmap[ary_id] != IDR_FULL)
  643. {
  644. int bmp_id = __lowbit_id(~bmp->bitmap[ary_id]);
  645. bmp->bitmap[ary_id] |= (1ull << bmp_id);
  646. bmp->count++; // 注意, 这里已经标记这一位已经使用, 同时更新了ida_count
  647. if (unlikely((unsigned long long)ary_id * IDA_BMP_SIZE + bmp_id > INT32_MAX))
  648. {
  649. kBUG("ida设置id范围为[0, INT32_MAX], 但ida获取的id数值超过INT32_MAX.");
  650. return -EDOM;
  651. }
  652. return ary_id * IDA_BMP_SIZE + bmp_id;
  653. }
  654. }
  655. return -EDOM; // 不合法
  656. }
  657. /**
  658. * @brief 获取一个ID
  659. *
  660. * @param ida_p
  661. * @param p_id
  662. * @return int (0表示获取ID成功, 否则是负数 - 错误码)
  663. */
  664. int ida_get_new(struct ida *ida_p, int *p_id)
  665. {
  666. *p_id = -1;
  667. struct idr_layer *stk[MAX_LEVEL + 1]; // 你可以选择memset(0)
  668. memset(stk, 0, sizeof(stk));
  669. int idr_id = __idr_get_empty_slot(&ida_p->idr, stk);
  670. // 如果stk[0]=NULL,可能是idr内部出错/内存空间不够
  671. if (unlikely(NULL == stk[0]))
  672. return -ENOMEM;
  673. if (unlikely(idr_id < 0))
  674. return idr_id;
  675. int layer_id = idr_id & IDR_MASK;
  676. if (NULL == stk[0]->ary[layer_id])
  677. stk[0]->ary[layer_id] = __get_ida_bitmap(ida_p, 0);
  678. if (unlikely(NULL == stk[0]->ary[layer_id]))
  679. return -ENOMEM;
  680. struct ida_bitmap *bmp = (struct ida_bitmap *)stk[0]->ary[layer_id];
  681. int low_id = __get_id_from_bitmap(bmp);
  682. if (unlikely(low_id < 0))
  683. return low_id;
  684. *p_id = idr_id * IDA_BITMAP_BITS + low_id;
  685. __idr_mark_full(&ida_p->idr, idr_id, stk, (bmp->count == IDA_FULL ? 2 : 1));
  686. return 0;
  687. }
  688. /**
  689. * @brief 查询ID是否已经被分配
  690. *
  691. * @param ida_p
  692. * @param id
  693. * @return true
  694. * @return false
  695. */
  696. bool ida_count(struct ida *ida_p, int id)
  697. {
  698. if (unlikely(NULL == ida_p || NULL == ida_p->idr.top || id < 0))
  699. return false;
  700. int idr_id = id / IDA_BITMAP_BITS;
  701. int ary_id = (id % IDA_BITMAP_BITS) / IDA_BMP_SIZE;
  702. int bmp_id = (id % IDA_BITMAP_BITS) % IDA_BMP_SIZE;
  703. struct ida_bitmap *bmp = idr_find(&ida_p->idr, idr_id);
  704. if (NULL == bmp)
  705. return false;
  706. return ((bmp->bitmap[ary_id] >> bmp_id) & 1);
  707. }
  708. /**
  709. * @brief 删除一个ID
  710. *
  711. * @param ida_p
  712. * @param id
  713. */
  714. void ida_remove(struct ida *ida_p, int id)
  715. {
  716. if (unlikely(NULL == ida_p || NULL == ida_p->idr.top || id < 0))
  717. return;
  718. int idr_id = id / IDA_BITMAP_BITS;
  719. int ary_id = (id % IDA_BITMAP_BITS) / IDA_BMP_SIZE;
  720. int bmp_id = (id % IDA_BITMAP_BITS) % IDA_BMP_SIZE;
  721. struct idr_layer *stk[MAX_LEVEL + 1];
  722. memset(stk, 0, sizeof(stk));
  723. if (0 == __idr_get_path(&ida_p->idr, idr_id, stk))
  724. return;
  725. struct ida_bitmap *b_p = (struct ida_bitmap *)stk[0]->ary[idr_id & IDR_MASK];
  726. // 不存在这个ID 或者 b_p == NULL
  727. if (unlikely(NULL == b_p || 0 == ((b_p->bitmap[ary_id] >> bmp_id) & 1)))
  728. return;
  729. b_p->count--; // 更新了ida_count
  730. b_p->bitmap[ary_id] ^= (1ull << bmp_id);
  731. __idr_erase_full(&ida_p->idr, idr_id, stk, (b_p->count > 0 ? 1 : 0));
  732. if (0 == b_p->count)
  733. {
  734. __ida_bitmap_free(b_p);
  735. if (stk[0]) // stk[0] 有可能在 __idr_erase_full 里面已经kfree了
  736. stk[0]->ary[idr_id & IDR_MASK] = NULL; // 记得设置为空
  737. }
  738. }
  739. /**
  740. * @brief 释放所有空间(包括: idr + ida_bitmap + free_list)
  741. * @param ida_p
  742. */
  743. void ida_destroy(struct ida *ida_p)
  744. {
  745. if (unlikely(ida_p == NULL))
  746. return;
  747. __idr_destroy_with_free(&ida_p->idr);
  748. ida_p->idr.top = NULL;
  749. __ida_bitmap_free(ida_p->free_list);
  750. ida_p->free_list = NULL;
  751. }