shim_ipc_nsimpl.h 49 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884
  1. /* -*- mode:c; c-file-style:"k&r"; c-basic-offset: 4; tab-width:4; indent-tabs-mode:nil; mode:auto-fill; fill-column:78; -*- */
  2. /* vim: set ts=4 sw=4 et tw=78 fo=cqt wm=0: */
  3. /* Copyright (C) 2014 Stony Brook University
  4. This file is part of Graphene Library OS.
  5. Graphene Library OS is free software: you can redistribute it and/or
  6. modify it under the terms of the GNU Lesser General Public License
  7. as published by the Free Software Foundation, either version 3 of the
  8. License, or (at your option) any later version.
  9. Graphene Library OS is distributed in the hope that it will be useful,
  10. but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. GNU Lesser General Public License for more details.
  13. You should have received a copy of the GNU Lesser General Public License
  14. along with this program. If not, see <http://www.gnu.org/licenses/>. */
  15. /*
  16. * shim_ipc_nsimpl.h
  17. *
  18. * This file contains a template for generic functions and callbacks to
  19. * implement a namespace.
  20. */
  21. #include <shim_internal.h>
  22. #include <shim_ipc.h>
  23. #include <shim_utils.h>
  24. #include <shim_profile.h>
  25. #include <errno.h>
  26. #warning "be sure before including this file"
  27. #if !defined(NS) || !defined(NS_CAP)
  28. # error "NS or NS_CAP is not defined"
  29. #endif
  30. #define NS_STR XSTRINGIFY(NS)
  31. #define NS_CAP_STR XSTRINGIFY(NS_CAP)
  32. #define RANGE_SIZE CONCAT2(NS_CAP, RANGE_SIZE)
  33. #define BITS (sizeof(unsigned char) * 8)
  34. struct idx_bitmap {
  35. unsigned char map[RANGE_SIZE / BITS];
  36. };
  37. struct subrange {
  38. struct shim_ipc_info * owner;
  39. LEASETYPE lease;
  40. };
  41. struct sub_map {
  42. struct subrange * map[RANGE_SIZE];
  43. };
  44. DEFINE_LIST(range);
  45. struct range {
  46. LIST_TYPE(range) hlist;
  47. LIST_TYPE(range) list;
  48. int offset;
  49. struct shim_ipc_info * owner;
  50. LEASETYPE lease;
  51. struct idx_bitmap * used;
  52. struct sub_map * subranges;
  53. };
  54. struct range_bitmap {
  55. int map_size;
  56. unsigned char map[];
  57. };
  58. static struct range_bitmap * range_map;
  59. static LOCKTYPE range_map_lock;
  60. #define RANGE_HASH_LEN 6
  61. #define RANGE_HASH_NUM (1 << RANGE_HASH_LEN)
  62. #define RANGE_HASH_MASK (RANGE_HASH_NUM - 1)
  63. #define RANGE_HASH(off) (((off - 1) / RANGE_SIZE) & RANGE_HASH_MASK)
  64. /* This hash table organizes range structs by hlist */
  65. DEFINE_LISTP(range);
  66. static LISTP_TYPE(range) range_table [RANGE_HASH_NUM];
  67. /* These lists organizes range structs by list
  68. */
  69. static LISTP_TYPE(range) owned_ranges;
  70. static LISTP_TYPE(range) offered_ranges;
  71. static int nowned = 0;
  72. static int noffered = 0;
  73. static int nsubed = 0;
  74. DEFINE_LIST(ns_query);
  75. struct ns_query {
  76. IDTYPE dest;
  77. unsigned long seq;
  78. struct shim_ipc_port * port;
  79. LIST_TYPE(ns_query) list;
  80. };
  81. DEFINE_LISTP(ns_query);
  82. static LISTP_TYPE(ns_query) ns_queries;
  83. static inline LEASETYPE get_lease (void)
  84. {
  85. return DkSystemTimeQuery() + CONCAT2(NS_CAP, LEASE_TIME);
  86. }
  87. void CONCAT3(debug_print, NS, ranges) (void)
  88. {
  89. lock(range_map_lock);
  90. sys_printf(NS_STR " ranges in process %010u:\n", cur_process.vmid);
  91. if (!range_map) {
  92. unlock(range_map_lock);
  93. return;
  94. }
  95. for (int i = 0 ; i < range_map->map_size ; i++) {
  96. unsigned char map = range_map->map[i];
  97. if (!map)
  98. continue;
  99. for (int j = 0 ; j < BITS ; map >>= 1, j++) {
  100. if (!(map & 1))
  101. continue;
  102. int off = i * BITS + j;
  103. LISTP_TYPE(range) * head = range_table + RANGE_HASH(off);
  104. struct range * tmp, * r = NULL;
  105. listp_for_each_entry(tmp, head, hlist)
  106. if (tmp->offset == off) {
  107. r = tmp;
  108. break;
  109. }
  110. assert(r);
  111. IDTYPE base = RANGE_SIZE * off + 1;
  112. struct shim_ipc_info * p = r->owner;
  113. sys_printf("%04u - %04u: owner %010u, port \"%s\" lease %u\n",
  114. base, base + RANGE_SIZE - 1,
  115. p->vmid, qstrgetstr(&p->uri), r->lease);
  116. if (!r->subranges)
  117. continue;
  118. for (int k = 0 ; k < RANGE_SIZE ; k++) {
  119. struct subrange * s = r->subranges->map[j];
  120. if (!s)
  121. continue;
  122. p = s->owner;
  123. sys_printf(" %04u: owner %010u, port \"%s\" lease %u\n",
  124. base + k, p->vmid,
  125. qstrgetstr(&p->uri), s->lease);
  126. }
  127. }
  128. }
  129. unlock(range_map_lock);
  130. }
  131. #define INIT_RANGE_MAP_SIZE 32
  132. static int __extend_range_bitmap (int expected)
  133. {
  134. int size = INIT_RANGE_MAP_SIZE;
  135. if (range_map)
  136. size = range_map->map_size;
  137. while(size <= expected)
  138. size *= 2;
  139. struct range_bitmap * new_map = malloc(sizeof(struct range_bitmap) +
  140. size / BITS);
  141. if (!new_map)
  142. return -ENOMEM;
  143. if (range_map) {
  144. memcpy(new_map->map, range_map->map, range_map->map_size / BITS);
  145. memset(new_map->map + range_map->map_size / BITS, 0,
  146. (size - range_map->map_size) / BITS);
  147. free(range_map);
  148. } else {
  149. memset(new_map->map, 0, size / BITS);
  150. }
  151. new_map->map_size = size;
  152. range_map = new_map;
  153. return 0;
  154. }
  155. static int __set_range_bitmap (int off, bool unset)
  156. {
  157. int i = off / BITS;
  158. int j = off - i * BITS;
  159. unsigned char * m = range_map->map + i;
  160. unsigned char f = 1U << j;
  161. if (unset) {
  162. if (!((*m) & f))
  163. return -ENOENT;
  164. (*m) &= ~f;
  165. } else {
  166. if ((*m) & f)
  167. return -EEXIST;
  168. (*m) |= f;
  169. }
  170. return 0;
  171. }
  172. static bool __check_range_bitmap (int off)
  173. {
  174. int i = off / BITS;
  175. int j = off - i * BITS;
  176. unsigned char * m = range_map->map + i;
  177. unsigned char f = 1U << j;
  178. return (*m) && ((*m) & f);
  179. }
  180. static struct range * __get_range (int off)
  181. {
  182. LISTP_TYPE(range) * head = range_table + RANGE_HASH(off);
  183. if (!range_map || off >= range_map->map_size)
  184. return NULL;
  185. if (!__check_range_bitmap(off))
  186. return NULL;
  187. struct range * r;
  188. listp_for_each_entry(r, head, hlist)
  189. if (r->offset == off)
  190. return r;
  191. return NULL;
  192. }
  193. static int __add_range (struct range * r, int off, IDTYPE owner,
  194. const char * uri, LEASETYPE lease)
  195. {
  196. LISTP_TYPE(range) * head = range_table + RANGE_HASH(off);
  197. int ret = 0;
  198. if (!range_map || range_map->map_size <= off) {
  199. ret = __extend_range_bitmap(off);
  200. if (ret < 0)
  201. return ret;
  202. }
  203. r->owner = NULL;
  204. r->offset = off;
  205. r->lease = lease;
  206. r->used = NULL;
  207. r->subranges = NULL;
  208. if (owner) {
  209. r->owner = lookup_and_alloc_client(owner, uri);
  210. if (!r->owner)
  211. return -ENOMEM;
  212. }
  213. ret = __set_range_bitmap(off, false);
  214. if (ret == -EEXIST) {
  215. struct range * tmp;
  216. listp_for_each_entry(tmp, head, hlist)
  217. if (tmp->offset == off) {
  218. listp_del(tmp, head, hlist);
  219. /* Chia-Che Tsai 10/17/17: only when tmp->owner is non-NULL,
  220. * and tmp->owner->vmid == cur_process.vmid, tmp is on the
  221. * owned list, otherwise it is an offered. */
  222. if (tmp->owner && tmp->owner->vmid == cur_process.vmid)
  223. listp_del(tmp, &owned_ranges, list);
  224. else
  225. listp_del(tmp, &offered_ranges, list);
  226. if (tmp->owner)
  227. put_client(tmp->owner);
  228. r->used = tmp->used;
  229. r->subranges = tmp->subranges;
  230. free(tmp);
  231. break;
  232. }
  233. }
  234. INIT_LIST_HEAD(r, hlist);
  235. listp_add(r, head, hlist);
  236. INIT_LIST_HEAD(r, list);
  237. LISTP_TYPE(range)* list = (owner == cur_process.vmid) ? &owned_ranges
  238. : &offered_ranges;
  239. struct range * prev = listp_first_entry(list, range, list);
  240. struct range * tmp;
  241. listp_for_each_entry(tmp, list, list) {
  242. if (tmp->offset >= off)
  243. break;
  244. prev = tmp;
  245. }
  246. listp_add_after(r, prev, list, list);
  247. if (owner == cur_process.vmid)
  248. nowned++;
  249. else
  250. noffered++;
  251. return 0;
  252. }
  253. int CONCAT3(add, NS, range) (IDTYPE base, IDTYPE owner,
  254. const char * uri, LEASETYPE lease)
  255. {
  256. int off = (base - 1) / RANGE_SIZE;
  257. int ret;
  258. struct range * r = malloc(sizeof(struct range));
  259. if (!r)
  260. return -ENOMEM;
  261. lock(range_map_lock);
  262. r->owner = NULL;
  263. ret = __add_range(r, off, owner, uri, lease);
  264. if (ret < 0)
  265. free(r);
  266. unlock(range_map_lock);
  267. return ret;
  268. }
  269. static void CONCAT3(__del, NS, subrange) (struct subrange ** ptr)
  270. {
  271. struct subrange * s = *ptr;
  272. *ptr = NULL;
  273. put_ipc_info(s->owner);
  274. free(s);
  275. nsubed--;
  276. }
  277. int CONCAT3(add, NS, subrange) (IDTYPE idx, IDTYPE owner,
  278. const char * uri, LEASETYPE * lease)
  279. {
  280. int off = (idx - 1) / RANGE_SIZE, err = 0;
  281. IDTYPE base = off * RANGE_SIZE + 1;
  282. struct subrange * s = malloc(sizeof(struct subrange));
  283. if (!s)
  284. return -ENOMEM;
  285. assert(owner);
  286. lock(range_map_lock);
  287. s->owner = lookup_and_alloc_client(owner, uri);
  288. if (!s->owner) {
  289. err = -ENOMEM;
  290. goto failed;
  291. }
  292. s->lease = (lease && (*lease)) ? (*lease) : get_lease();
  293. struct range * r = __get_range(off);
  294. if (!r) {
  295. r = malloc(sizeof(struct range));
  296. if (!r) {
  297. err = -ENOMEM;
  298. goto failed;
  299. }
  300. if ((err == __add_range(r, off, 0, NULL, 0)) < 0) {
  301. free(r);
  302. goto failed;
  303. }
  304. }
  305. if (!r->subranges) {
  306. r->subranges = malloc(sizeof(struct sub_map));
  307. if (!r->subranges) {
  308. err = -ENOMEM;
  309. goto failed;
  310. }
  311. memset(r->subranges, 0, sizeof(struct sub_map));
  312. }
  313. struct subrange ** m = &r->subranges->map[idx - base];
  314. if (*m)
  315. CONCAT3(__del, NS, subrange)(m);
  316. (*m) = s;
  317. nsubed++;
  318. if (lease)
  319. *lease = s->lease;
  320. unlock(range_map_lock);
  321. return 0;
  322. failed:
  323. if (s->owner)
  324. put_ipc_info(s->owner);
  325. unlock(range_map_lock);
  326. free(s);
  327. return err;
  328. }
  329. int CONCAT3(alloc, NS, range) (IDTYPE owner, const char * uri,
  330. IDTYPE * base, LEASETYPE * lease)
  331. {
  332. struct range * r = malloc(sizeof(struct range));
  333. if (!r)
  334. return -ENOMEM;
  335. int ret = 0;
  336. lock(range_map_lock);
  337. r->owner = NULL;
  338. int i = 0, j = 0;
  339. if (range_map)
  340. for (i = 0 ; i < range_map->map_size ; i++) {
  341. unsigned char map = range_map->map[i];
  342. if (map < 255U) {
  343. for (j = 0 ; j < BITS ; map >>= 1, j++)
  344. if (!(map & 1U))
  345. break;
  346. assert(j < BITS);
  347. break;
  348. }
  349. }
  350. LEASETYPE l = get_lease();
  351. ret = __add_range(r, i * BITS + j, owner, uri, l);
  352. if (ret < 0) {
  353. if (r->owner)
  354. put_ipc_info(r->owner);
  355. free(r);
  356. goto out;
  357. }
  358. if (base)
  359. *base = (i * BITS + j) * RANGE_SIZE + 1;
  360. if (lease)
  361. *lease = l;
  362. out:
  363. unlock(range_map_lock);
  364. return ret;
  365. }
  366. int CONCAT3(get, NS, range) (IDTYPE idx,
  367. struct CONCAT2(NS, range) * range,
  368. struct shim_ipc_info ** info)
  369. {
  370. int off = (idx - 1) / RANGE_SIZE;
  371. lock(range_map_lock);
  372. struct range * r = __get_range(off);
  373. if (!r) {
  374. unlock(range_map_lock);
  375. return -ESRCH;
  376. }
  377. IDTYPE base = r->offset * RANGE_SIZE + 1;
  378. IDTYPE sz = RANGE_SIZE;
  379. LEASETYPE l = r->lease;
  380. struct shim_ipc_info * p = r->owner;
  381. if (r->subranges && r->subranges->map[idx - base]) {
  382. struct subrange * s = r->subranges->map[idx - base];
  383. base = idx;
  384. sz = 1;
  385. l = s->lease;
  386. p = s->owner;
  387. }
  388. if (!p) {
  389. unlock(range_map_lock);
  390. return -ESRCH;
  391. }
  392. if (p->port)
  393. get_ipc_port(p->port);
  394. range->base = base;
  395. range->size = sz;
  396. range->lease = l;
  397. range->owner = p->vmid;
  398. qstrcopy(&range->uri, &p->uri);
  399. range->port = p->port;
  400. if (info) {
  401. get_ipc_info(p);
  402. *info = p;
  403. }
  404. unlock(range_map_lock);
  405. return 0;
  406. }
  407. int CONCAT3(del, NS, range) (IDTYPE idx)
  408. {
  409. int off = (idx - 1) / RANGE_SIZE;
  410. int ret = -ESRCH;
  411. lock(range_map_lock);
  412. struct range * r = __get_range(off);
  413. if (!r)
  414. goto failed;
  415. ret = __set_range_bitmap(off, true);
  416. if (ret < 0)
  417. goto failed;
  418. if (r->subranges) {
  419. for (int i = 0 ; i < RANGE_SIZE ; i++)
  420. if (r->subranges->map[i]) {
  421. ret = -EBUSY;
  422. goto failed;
  423. }
  424. free(r->subranges);
  425. }
  426. if (r->owner->vmid == cur_process.vmid)
  427. nowned--;
  428. else
  429. noffered--;
  430. if (r->used)
  431. free(r->used);
  432. // Re-acquire the head; kind of ugly
  433. LISTP_TYPE(range) * head = range_table + RANGE_HASH(off);
  434. listp_del(r, head, hlist);
  435. /* Chia-Che Tsai 10/17/17: only when r->owner is non-NULL,
  436. * and r->owner->vmid == cur_process.vmid, r is on the
  437. * owned list, otherwise it is an offered. */
  438. if (r->owner && r->owner->vmid == cur_process.vmid)
  439. listp_del(r, &owned_ranges, list);
  440. else
  441. listp_del(r, &offered_ranges, list);
  442. put_ipc_info(r->owner);
  443. free(r);
  444. ret = 0;
  445. failed:
  446. unlock(range_map_lock);
  447. return ret;
  448. }
  449. int CONCAT3(del, NS, subrange) (IDTYPE idx)
  450. {
  451. int off = (idx - 1) / RANGE_SIZE;
  452. IDTYPE base = off * RANGE_SIZE + 1;
  453. int ret = -ESRCH;
  454. lock(range_map_lock);
  455. struct range * r = __get_range(off);
  456. if (!r)
  457. goto failed;
  458. if (!r->subranges || !r->subranges->map[idx - base])
  459. goto failed;
  460. CONCAT3(__del, NS, subrange) (&r->subranges->map[idx - base]);
  461. ret = 0;
  462. failed:
  463. unlock(range_map_lock);
  464. return ret;
  465. }
  466. int CONCAT3(renew, NS, range) (IDTYPE idx, LEASETYPE * lease)
  467. {
  468. int off = (idx - 1) / RANGE_SIZE;
  469. lock(range_map_lock);
  470. struct range * r = __get_range(off);
  471. if (!r) {
  472. unlock(range_map_lock);
  473. return -ESRCH;
  474. }
  475. r->lease = get_lease();
  476. if (lease)
  477. *lease = r->lease;
  478. unlock(range_map_lock);
  479. return 0;
  480. }
  481. int CONCAT3(renew, NS, subrange) (IDTYPE idx, LEASETYPE * lease)
  482. {
  483. int off = (idx - 1) / RANGE_SIZE;
  484. IDTYPE base = off * RANGE_SIZE + 1;
  485. lock(range_map_lock);
  486. struct range * r = __get_range(off);
  487. if (!r) {
  488. unlock(range_map_lock);
  489. return -ESRCH;
  490. }
  491. if (!r->subranges || !r->subranges->map[idx - base]) {
  492. unlock(range_map_lock);
  493. return -ESRCH;
  494. }
  495. struct subrange * s = r->subranges->map[idx - base];
  496. s->lease = get_lease();
  497. if (lease)
  498. *lease = s->lease;
  499. unlock(range_map_lock);
  500. return 0;
  501. }
  502. IDTYPE CONCAT2(allocate, NS) (IDTYPE min, IDTYPE max)
  503. {
  504. IDTYPE idx = min;
  505. struct range * r;
  506. lock(range_map_lock);
  507. listp_for_each_entry (r, &owned_ranges, list) {
  508. if (max && idx >= max)
  509. break;
  510. IDTYPE base = r->offset * RANGE_SIZE + 1;
  511. if (idx >= base + RANGE_SIZE)
  512. continue;
  513. if (idx < base)
  514. idx = base;
  515. if (!r->used) {
  516. r->used = malloc(sizeof(struct idx_bitmap));
  517. if (!r->used)
  518. continue;
  519. memset(r->used, 0, sizeof(struct idx_bitmap));
  520. }
  521. int i = (idx - base) / BITS;
  522. int j = (idx - base) - i * BITS;
  523. unsigned char * m = r->used->map + i;
  524. unsigned char f = 1U << j;
  525. for ( ; i < RANGE_SIZE / BITS ; i++, j = 0, f = 1U, m++) {
  526. unsigned char map = (*m) ^ (f - 1);
  527. if (map < 255U) {
  528. for ( ; j < BITS ; f <<= 1, j++)
  529. if (!(map & f)) {
  530. (*m) |= f;
  531. idx = base + i * BITS + j;
  532. debug("allocated " NS_STR ": %u\n", idx);
  533. goto out;
  534. }
  535. }
  536. }
  537. }
  538. idx = 0;
  539. out:
  540. unlock(range_map_lock);
  541. return idx;
  542. }
  543. void CONCAT2(release, NS) (IDTYPE idx)
  544. {
  545. int off = (idx - 1) / RANGE_SIZE;
  546. IDTYPE base = off * RANGE_SIZE + 1;
  547. lock(range_map_lock);
  548. struct range * r = __get_range(off);
  549. if (!r)
  550. goto out;
  551. if (r->subranges && r->subranges->map[idx - base])
  552. CONCAT3(__del, NS, subrange) (&r->subranges->map[idx - base]);
  553. if (!r->used)
  554. goto out;
  555. if (idx < base || idx >= base + RANGE_SIZE)
  556. goto out;
  557. int i = (idx - base) / BITS;
  558. int j = (idx - base) - i * BITS;
  559. unsigned char * m = r->used->map + i;
  560. unsigned char f = 1U << j;
  561. if ((*m) & f) {
  562. debug("released " NS_STR ": %u\n", idx);
  563. (*m) &= ~f;
  564. }
  565. out:
  566. unlock(range_map_lock);
  567. }
  568. static inline void init_namespace (void)
  569. {
  570. create_lock(range_map_lock);
  571. }
  572. #define _NS_ID(ns) __NS_ID(ns)
  573. #define __NS_ID(ns) ns##_NS
  574. #define NS_ID _NS_ID(NS_CAP)
  575. #define NS_LEADER cur_process.ns[NS_ID]
  576. #define NS_SEND(t) CONCAT3(ipc, NS, t##_send)
  577. #define NS_CALLBACK(t) CONCAT3(ipc, NS, t##_callback)
  578. #define NS_CODE(t) CONCAT3(IPC, NS_CAP, t)
  579. #define NS_CODE_STR(t) "IPC_" NS_CAP_STR "_" #t
  580. #define NS_MSG_TYPE(t) struct CONCAT3(shim_ipc, NS, t)
  581. #define PORT(ns, t) __PORT(ns, t)
  582. #define __PORT(ns, t) IPC_PORT_##ns##t
  583. #define IPC_PORT_CLT PORT(NS_CAP, CLT)
  584. #define IPC_PORT_LDR PORT(NS_CAP, LDR)
  585. #define IPC_PORT_CON PORT(NS_CAP, CON)
  586. #define IPC_PORT_OWN PORT(NS_CAP, OWN)
  587. static void ipc_leader_exit (struct shim_ipc_port * port, IDTYPE vmid,
  588. unsigned int exitcode)
  589. {
  590. lock(cur_process.lock);
  591. if (!NS_LEADER || NS_LEADER->port != port) {
  592. unlock(cur_process.lock);
  593. return;
  594. }
  595. struct shim_ipc_info * info = NS_LEADER;
  596. NS_LEADER = NULL;
  597. unlock(cur_process.lock);
  598. debug("ipc port %p of process %u closed suggests " NS_STR " leader exits\n",
  599. port, vmid);
  600. put_ipc_info(info);
  601. }
  602. static void __discover_ns (bool block, bool need_connect, bool need_locate)
  603. {
  604. if (NS_LEADER) {
  605. if (NS_LEADER->vmid == cur_process.vmid) {
  606. if (need_locate && qstrempty(&NS_LEADER->uri)) {
  607. struct shim_ipc_info * info = create_ipc_port(cur_process.vmid,
  608. true);
  609. if (info) {
  610. put_ipc_info(NS_LEADER);
  611. NS_LEADER = info;
  612. add_ipc_port(info->port, 0, IPC_PORT_CLT,
  613. &ipc_leader_exit);
  614. }
  615. }
  616. return;
  617. }
  618. if ((need_connect || need_locate) && !qstrempty(&NS_LEADER->uri))
  619. return;
  620. }
  621. unlock(cur_process.lock);
  622. /* now we have to discover the leader */
  623. if (!NS_SEND(findns)(block))
  624. return;
  625. lock(cur_process.lock);
  626. if (NS_LEADER && (!need_locate || !qstrempty(&NS_LEADER->uri)))
  627. return;
  628. /* if all other ways failed, the process become a manager */
  629. if (!need_locate) {
  630. NS_LEADER = get_new_ipc_info(cur_process.vmid, NULL, 0);
  631. return;
  632. }
  633. if (NS_LEADER)
  634. put_ipc_info(NS_LEADER);
  635. if (!(NS_LEADER = create_ipc_port(cur_process.vmid, true)))
  636. return;
  637. add_ipc_port(NS_LEADER->port, NS_LEADER->vmid, IPC_PORT_CLT,
  638. &ipc_leader_exit);
  639. }
  640. static int connect_ns (IDTYPE * vmid, struct shim_ipc_port ** portptr)
  641. {
  642. lock(cur_process.lock);
  643. __discover_ns(true, true, false);
  644. if (!NS_LEADER) {
  645. unlock(cur_process.lock);
  646. return -ESRCH;
  647. }
  648. if (NS_LEADER->vmid == cur_process.vmid) {
  649. if (vmid)
  650. *vmid = NS_LEADER->vmid;
  651. unlock(cur_process.lock);
  652. return 0;
  653. }
  654. if (!NS_LEADER->port) {
  655. if (qstrempty(&NS_LEADER->uri)) {
  656. unlock(cur_process.lock);
  657. return -ESRCH;
  658. }
  659. PAL_HANDLE pal_handle = DkStreamOpen(qstrgetstr(&NS_LEADER->uri),
  660. 0, 0, 0, 0);
  661. if (!pal_handle) {
  662. unlock(cur_process.lock);
  663. return -PAL_ERRNO;
  664. }
  665. add_ipc_port_by_id(NS_LEADER->vmid, pal_handle,
  666. IPC_PORT_LDR|IPC_PORT_LISTEN, &ipc_leader_exit,
  667. &NS_LEADER->port);
  668. }
  669. if (vmid)
  670. *vmid = NS_LEADER->vmid;
  671. if (portptr) {
  672. if (NS_LEADER->port)
  673. get_ipc_port(NS_LEADER->port);
  674. *portptr = NS_LEADER->port;
  675. }
  676. unlock(cur_process.lock);
  677. return 0;
  678. }
  679. static int disconnect_ns(struct shim_ipc_port * port)
  680. {
  681. lock(cur_process.lock);
  682. if (NS_LEADER && NS_LEADER->port == port) {
  683. NS_LEADER->port = NULL;
  684. put_ipc_port(port);
  685. }
  686. unlock(cur_process.lock);
  687. del_ipc_port(port, IPC_PORT_LDR);
  688. return 0;
  689. }
  690. int CONCAT3(prepare, NS, leader) (void)
  691. {
  692. lock(cur_process.lock);
  693. if (!NS_LEADER) {
  694. unlock(cur_process.lock);
  695. return 0;
  696. }
  697. __discover_ns(true, true, true);
  698. unlock(cur_process.lock);
  699. return 0;
  700. }
  701. static int connect_owner (IDTYPE idx, struct shim_ipc_port ** portptr,
  702. IDTYPE * owner)
  703. {
  704. struct shim_ipc_info * info = NULL;
  705. struct CONCAT2(NS, range) range;
  706. memset(&range, 0, sizeof(struct CONCAT2(NS, range)));
  707. int ret = CONCAT3(get, NS, range) (idx, &range, &info);
  708. if (ret == -ESRCH) {
  709. if ((ret = NS_SEND(query)(idx)) < 0)
  710. return -ESRCH;
  711. ret = CONCAT3(get, NS, range) (idx, &range, &info);
  712. }
  713. if (ret < 0)
  714. goto out;
  715. if (range.owner == cur_process.vmid) {
  716. ret = -ESRCH;
  717. assert(!range.port);
  718. goto out;
  719. }
  720. if (range.port)
  721. goto success;
  722. int type = IPC_PORT_OWN|IPC_PORT_LISTEN;
  723. if (!range.port) {
  724. PAL_HANDLE pal_handle = DkStreamOpen(qstrgetstr(&range.uri),
  725. 0, 0, 0, 0);
  726. if (!pal_handle) {
  727. ret = -PAL_ERRNO ? : -EACCES;
  728. goto out;
  729. }
  730. add_ipc_port_by_id(range.owner, pal_handle, type, NULL, &range.port);
  731. assert(range.port);
  732. }
  733. lock(range_map_lock);
  734. if (info->port)
  735. put_ipc_port(info->port);
  736. get_ipc_port(range.port);
  737. info->port = range.port;
  738. unlock(range_map_lock);
  739. success:
  740. if (portptr)
  741. *portptr = range.port;
  742. else
  743. put_ipc_port(range.port);
  744. if (owner)
  745. *owner = range.owner;
  746. out:
  747. if (info)
  748. put_ipc_info(info);
  749. assert(ret || range.port);
  750. return ret;
  751. }
  752. DEFINE_PROFILE_INTERVAL(NS_SEND(findns), ipc);
  753. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(findns), ipc);
  754. int NS_SEND(findns) (bool block)
  755. {
  756. BEGIN_PROFILE_INTERVAL();
  757. int ret = -ESRCH;
  758. lock(cur_process.lock);
  759. if (!cur_process.parent || !cur_process.parent->port) {
  760. unlock(cur_process.lock);
  761. goto out;
  762. }
  763. IDTYPE dest = cur_process.parent->vmid;
  764. struct shim_ipc_port * port = cur_process.parent->port;
  765. get_ipc_port(port);
  766. unlock(cur_process.lock);
  767. if (block) {
  768. struct shim_ipc_msg_obj * msg =
  769. create_ipc_msg_duplex_on_stack(NS_CODE(FINDNS), 0, dest);
  770. debug("ipc send to %u: " NS_CODE_STR(FINDNS) "\n", dest);
  771. ret = do_ipc_duplex(msg, port, NULL, NULL);
  772. goto out_port;
  773. }
  774. struct shim_ipc_msg * msg =
  775. create_ipc_msg_on_stack(NS_CODE(FINDNS), 0, dest);
  776. debug("ipc send to %u: " NS_CODE_STR(FINDNS) "\n", dest);
  777. ret = send_ipc_message(msg, port);
  778. out_port:
  779. put_ipc_port(port);
  780. out:
  781. SAVE_PROFILE_INTERVAL(NS_SEND(findns));
  782. return ret;
  783. }
  784. int NS_CALLBACK(findns) (IPC_CALLBACK_ARGS)
  785. {
  786. BEGIN_PROFILE_INTERVAL();
  787. debug("ipc callback from %u: " NS_CODE_STR(FINDNS) "\n",
  788. msg->src);
  789. int ret = 0;
  790. lock(cur_process.lock);
  791. __discover_ns(false, true, true);
  792. if (NS_LEADER) {
  793. ret = NS_SEND(tellns)(port, msg->src, NS_LEADER, msg->seq);
  794. } else {
  795. struct ns_query * query = malloc(sizeof(struct ns_query));
  796. if (query) {
  797. query->dest = msg->src;
  798. query->seq = msg->seq;
  799. get_ipc_port(port);
  800. query->port = port;
  801. INIT_LIST_HEAD(query, list);
  802. listp_add_tail(query, &ns_queries, list);
  803. } else {
  804. ret = -ENOMEM;
  805. }
  806. }
  807. unlock(cur_process.lock);
  808. SAVE_PROFILE_INTERVAL(NS_CALLBACK(findns));
  809. return ret;
  810. }
  811. DEFINE_PROFILE_INTERVAL(NS_SEND(tellns), ipc);
  812. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(tellns), ipc);
  813. int NS_SEND(tellns) (struct shim_ipc_port * port, IDTYPE dest,
  814. struct shim_ipc_info * leader, unsigned long seq)
  815. {
  816. BEGIN_PROFILE_INTERVAL();
  817. struct shim_ipc_msg * msg =
  818. create_ipc_msg_on_stack(NS_CODE(TELLNS),
  819. leader->uri.len + sizeof(NS_MSG_TYPE(tellns)),
  820. dest);
  821. NS_MSG_TYPE(tellns) * msgin = (void *) &msg->msg;
  822. msgin->vmid = leader->vmid;
  823. assert(!qstrempty(&leader->uri));
  824. memcpy(msgin->uri, qstrgetstr(&leader->uri), leader->uri.len + 1);
  825. msg->seq = seq;
  826. debug("ipc send to %u: " NS_CODE_STR(TELLNS) "(%u, %s)\n", dest,
  827. leader->vmid, msgin->uri);
  828. int ret = send_ipc_message(msg, port);
  829. SAVE_PROFILE_INTERVAL(NS_SEND(tellns));
  830. return ret;
  831. }
  832. int NS_CALLBACK(tellns) (IPC_CALLBACK_ARGS)
  833. {
  834. BEGIN_PROFILE_INTERVAL();
  835. NS_MSG_TYPE(tellns) * msgin = (void *) &msg->msg;
  836. int ret = 0;
  837. debug("ipc callback from %u: " NS_CODE_STR(TELLNS) "(%u, %s)\n",
  838. msg->src, msgin->vmid, msgin->uri);
  839. lock(cur_process.lock);
  840. if (NS_LEADER) {
  841. NS_LEADER->vmid = msgin->vmid;
  842. qstrsetstr(&NS_LEADER->uri, msgin->uri, strlen(msgin->uri));
  843. } else {
  844. NS_LEADER = get_new_ipc_info(msgin->vmid, msgin->uri,
  845. strlen(msgin->uri));
  846. if (!NS_LEADER) {
  847. ret = -ENOMEM;
  848. goto out;
  849. }
  850. }
  851. struct ns_query * query, * pos;
  852. listp_for_each_entry_safe(query, pos, &ns_queries, list) {
  853. listp_del(query, &ns_queries, list);
  854. NS_SEND(tellns)(query->port, query->dest, NS_LEADER, query->seq);
  855. put_ipc_port(query->port);
  856. free(query);
  857. }
  858. struct shim_ipc_msg_obj * obj = find_ipc_msg_duplex(port, msg->seq);
  859. if (obj && obj->thread)
  860. thread_wakeup(obj->thread);
  861. out:
  862. unlock(cur_process.lock);
  863. SAVE_PROFILE_INTERVAL(NS_CALLBACK(tellns));
  864. return ret;
  865. }
  866. DEFINE_PROFILE_INTERVAL(NS_SEND(lease), ipc);
  867. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(lease), ipc);
  868. int NS_SEND(lease) (LEASETYPE * lease)
  869. {
  870. BEGIN_PROFILE_INTERVAL();
  871. IDTYPE leader;
  872. struct shim_ipc_port * port = NULL;
  873. struct shim_ipc_info * self = NULL;
  874. int ret = 0;
  875. if ((ret = connect_ns(&leader, &port)) < 0)
  876. goto out;
  877. if ((ret = create_ipc_location(&self)) < 0)
  878. goto out;
  879. if (leader == cur_process.vmid) {
  880. ret = CONCAT3(alloc, NS, range)(cur_process.vmid,
  881. qstrgetstr(&self->uri),
  882. NULL, NULL);
  883. put_ipc_info(self);
  884. goto out;
  885. }
  886. int len = self->uri.len;
  887. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  888. NS_CODE(LEASE),
  889. len + sizeof(NS_MSG_TYPE(lease)),
  890. leader);
  891. NS_MSG_TYPE(lease) * msgin = (void *) &msg->msg.msg;
  892. assert(!qstrempty(&self->uri));
  893. memcpy(msgin->uri, qstrgetstr(&self->uri), len + 1);
  894. put_ipc_info(self);
  895. debug("ipc send to %u: " NS_CODE_STR(LEASE) "(%s)\n", leader,
  896. msgin->uri);
  897. ret = do_ipc_duplex(msg, port, NULL, lease);
  898. out:
  899. if (port)
  900. put_ipc_port(port);
  901. SAVE_PROFILE_INTERVAL(NS_SEND(lease));
  902. return ret;
  903. }
  904. int NS_CALLBACK(lease) (IPC_CALLBACK_ARGS)
  905. {
  906. BEGIN_PROFILE_INTERVAL();
  907. NS_MSG_TYPE(lease) * msgin = (void *) &msg->msg;
  908. debug("ipc callback from %u: " NS_CODE_STR(LEASE) "(%s)\n",
  909. msg->src, msgin->uri);
  910. IDTYPE base = 0;
  911. LEASETYPE lease = 0;
  912. int ret = CONCAT3(alloc, NS, range)(msg->src, msgin->uri, &base, &lease);
  913. if (ret < 0)
  914. goto out;
  915. ret = NS_SEND(offer)(port, msg->src, base, RANGE_SIZE, lease, msg->seq);
  916. out:
  917. SAVE_PROFILE_INTERVAL(NS_CALLBACK(lease));
  918. return ret;
  919. }
  920. DEFINE_PROFILE_INTERVAL(NS_SEND(offer), ipc);
  921. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(offer), ipc);
  922. int NS_SEND(offer) (struct shim_ipc_port * port, IDTYPE dest, IDTYPE base,
  923. IDTYPE size, LEASETYPE lease, unsigned long seq)
  924. {
  925. BEGIN_PROFILE_INTERVAL();
  926. int ret = 0;
  927. struct shim_ipc_msg * msg = create_ipc_msg_on_stack(NS_CODE(OFFER),
  928. sizeof(NS_MSG_TYPE(offer)), dest);
  929. NS_MSG_TYPE(offer) * msgin = (void *) &msg->msg;
  930. msgin->base = base;
  931. msgin->size = size;
  932. msgin->lease = lease;
  933. msg->seq = seq;
  934. debug("ipc send to %u: " NS_CODE_STR(OFFER) "(%u, %u, %lu)\n",
  935. port->info.vmid, base, size, lease);
  936. ret = send_ipc_message(msg, port);
  937. SAVE_PROFILE_INTERVAL(NS_SEND(offer));
  938. return ret;
  939. }
  940. int NS_CALLBACK(offer) (IPC_CALLBACK_ARGS)
  941. {
  942. BEGIN_PROFILE_INTERVAL();
  943. NS_MSG_TYPE(offer) * msgin = (void *) &msg->msg;
  944. debug("ipc callback from %u: " NS_CODE_STR(OFFER) "(%u, %u, %lu)\n",
  945. msg->src, msgin->base, msgin->size, msgin->lease);
  946. struct shim_ipc_msg_obj * obj = find_ipc_msg_duplex(port, msg->seq);
  947. switch (msgin->size) {
  948. case RANGE_SIZE:
  949. CONCAT3(add, NS, range)(msgin->base, cur_process.vmid,
  950. qstrgetstr(&cur_process.self->uri),
  951. msgin->lease);
  952. LEASETYPE * priv = obj ? obj->private : NULL;
  953. if (priv)
  954. *priv = msgin->lease;
  955. break;
  956. case 1:
  957. if (obj) {
  958. NS_MSG_TYPE(sublease) * s = (void *) &obj->msg.msg;
  959. CONCAT3(add, NS, subrange)(s->idx, s->tenant, s->uri,
  960. &msgin->lease);
  961. LEASETYPE * priv = obj->private;
  962. if (priv)
  963. *priv = msgin->lease;
  964. }
  965. break;
  966. default:
  967. goto out;
  968. }
  969. if (obj && obj->thread)
  970. thread_wakeup(obj->thread);
  971. out:
  972. SAVE_PROFILE_INTERVAL(NS_CALLBACK(offer));
  973. return 0;
  974. }
  975. DEFINE_PROFILE_INTERVAL(NS_SEND(renew), ipc);
  976. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(renew), ipc);
  977. int NS_SEND(renew) (IDTYPE base, IDTYPE size)
  978. {
  979. BEGIN_PROFILE_INTERVAL();
  980. IDTYPE leader;
  981. struct shim_ipc_port * port = NULL;
  982. int ret = 0;
  983. if ((ret = connect_ns(&leader, &port)) < 0)
  984. goto out;
  985. struct shim_ipc_msg * msg =
  986. create_ipc_msg_on_stack(NS_CODE(RENEW),
  987. sizeof(NS_MSG_TYPE(renew)), leader);
  988. NS_MSG_TYPE(renew) * msgin = (void *) &msg->msg;
  989. msgin->base = base;
  990. msgin->size = size;
  991. debug("ipc send to %u: " NS_CODE_STR(RENEW) "(%u, %u)\n", base, size);
  992. ret = send_ipc_message(msg, port);
  993. put_ipc_port(port);
  994. out:
  995. SAVE_PROFILE_INTERVAL(NS_SEND(renew));
  996. return ret;
  997. }
  998. int NS_CALLBACK(renew) (IPC_CALLBACK_ARGS)
  999. {
  1000. BEGIN_PROFILE_INTERVAL();
  1001. NS_MSG_TYPE(renew) * msgin = (void *) &msg->msg;
  1002. int ret = 0;
  1003. debug("ipc callback from %u: " NS_CODE_STR(RENEW) "(%u, %u)\n",
  1004. msg->src, msgin->base, msgin->size);
  1005. if (msgin->size != 1 && msgin->size != RANGE_SIZE) {
  1006. ret = -EINVAL;
  1007. goto out;
  1008. }
  1009. LEASETYPE lease = 0;
  1010. switch (msgin->size) {
  1011. case RANGE_SIZE:
  1012. ret = CONCAT3(renew, NS, range) (msgin->base, &lease);
  1013. break;
  1014. case 1:
  1015. ret = CONCAT3(renew, NS, subrange) (msgin->size, &lease);
  1016. break;
  1017. default:
  1018. ret = -EINVAL;
  1019. break;
  1020. }
  1021. if (ret < 0)
  1022. goto out;
  1023. ret = NS_SEND(offer)(port, msg->src, msgin->base, msgin->size, lease,
  1024. msg->seq);
  1025. out:
  1026. SAVE_PROFILE_INTERVAL(NS_CALLBACK(renew));
  1027. return ret;
  1028. }
  1029. DEFINE_PROFILE_INTERVAL(NS_SEND(revoke), ipc);
  1030. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(revoke), ipc);
  1031. int NS_SEND(revoke) (IDTYPE base, IDTYPE size)
  1032. {
  1033. BEGIN_PROFILE_INTERVAL();
  1034. IDTYPE leader;
  1035. struct shim_ipc_port * port = NULL;
  1036. int ret = 0;
  1037. if ((ret = connect_ns(&leader, &port)) < 0)
  1038. goto out;
  1039. struct shim_ipc_msg * msg =
  1040. create_ipc_msg_on_stack(NS_CODE(REVOKE),
  1041. sizeof(NS_MSG_TYPE(revoke)), leader);
  1042. NS_MSG_TYPE(revoke) * msgin = (void *) &msg->msg;
  1043. msgin->base = base;
  1044. msgin->size = size;
  1045. debug("ipc send to %u: " NS_CODE_STR(REVOKE) "(%u, %u)\n",
  1046. leader, base, size);
  1047. ret = send_ipc_message(msg, port);
  1048. put_ipc_port(port);
  1049. out:
  1050. SAVE_PROFILE_INTERVAL(NS_SEND(revoke));
  1051. return ret;
  1052. }
  1053. int NS_CALLBACK(revoke) (IPC_CALLBACK_ARGS)
  1054. {
  1055. BEGIN_PROFILE_INTERVAL();
  1056. NS_MSG_TYPE(revoke) * msgin = (void *) &msg->msg;
  1057. int ret = 0;
  1058. debug("ipc callback from %u: " NS_CODE_STR(REVOKE) "(%u, %u)\n",
  1059. msg->src, msgin->base, msgin->size);
  1060. switch (msgin->size) {
  1061. case RANGE_SIZE:
  1062. ret = CONCAT3(del, NS, range)(msgin->base);
  1063. break;
  1064. case 1:
  1065. ret = CONCAT3(del, NS, subrange)(msgin->size);
  1066. break;
  1067. default:
  1068. ret = -EINVAL;
  1069. break;
  1070. }
  1071. SAVE_PROFILE_INTERVAL(NS_CALLBACK(revoke));
  1072. return ret;
  1073. }
  1074. DEFINE_PROFILE_INTERVAL(NS_SEND(sublease), ipc);
  1075. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(sublease), ipc);
  1076. int NS_SEND(sublease) (IDTYPE tenant, IDTYPE idx, const char * uri,
  1077. LEASETYPE * lease)
  1078. {
  1079. BEGIN_PROFILE_INTERVAL();
  1080. IDTYPE leader;
  1081. struct shim_ipc_port * port = NULL;
  1082. int ret = 0;
  1083. if ((ret = connect_ns(&leader, &port)) < 0)
  1084. goto out;
  1085. if (leader == cur_process.vmid) {
  1086. ret = CONCAT3(add, NS, subrange)(idx, tenant, uri, NULL);
  1087. goto out;
  1088. }
  1089. int len = strlen(uri);
  1090. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  1091. NS_CODE(SUBLEASE),
  1092. len + sizeof(NS_MSG_TYPE(sublease)),
  1093. leader);
  1094. NS_MSG_TYPE(sublease) * msgin = (void *) &msg->msg.msg;
  1095. msgin->tenant = tenant;
  1096. msgin->idx = idx;
  1097. memcpy(msgin->uri, uri, len + 1);
  1098. debug("ipc send to %u: " NS_CODE_STR(SUBLEASE) "(%u, %u, %s)\n",
  1099. leader, tenant, idx, msgin->uri);
  1100. ret = do_ipc_duplex(msg, port, NULL, lease);
  1101. out:
  1102. if (port)
  1103. put_ipc_port(port);
  1104. SAVE_PROFILE_INTERVAL(NS_SEND(sublease));
  1105. return ret;
  1106. }
  1107. int NS_CALLBACK(sublease) (IPC_CALLBACK_ARGS)
  1108. {
  1109. BEGIN_PROFILE_INTERVAL();
  1110. NS_MSG_TYPE(sublease) * msgin = (void *) &msg->msg;
  1111. debug("ipc callback from %u: " NS_CODE_STR(SUBLEASE) "(%u, %u, %s)\n",
  1112. msg->src, msgin->idx, msgin->tenant, msgin->uri);
  1113. LEASETYPE lease = 0;
  1114. int ret = CONCAT3(add, NS, subrange)(msgin->idx, msgin->tenant, msgin->uri,
  1115. &lease);
  1116. ret = NS_SEND(offer)(port, msg->src, msgin->idx, 1, lease, msg->seq);
  1117. SAVE_PROFILE_INTERVAL(NS_CALLBACK(sublease));
  1118. return ret;
  1119. }
  1120. DEFINE_PROFILE_INTERVAL(NS_SEND(query), ipc);
  1121. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(query), ipc);
  1122. int NS_SEND(query) (IDTYPE idx)
  1123. {
  1124. BEGIN_PROFILE_INTERVAL();
  1125. struct CONCAT2(NS, range) range;
  1126. IDTYPE leader;
  1127. struct shim_ipc_port * port = NULL;
  1128. int ret = 0;
  1129. memset(&range, 0, sizeof(struct CONCAT2(NS, range)));
  1130. if (!CONCAT3(get, NS, range)(idx, &range, NULL))
  1131. goto out;
  1132. if ((ret = connect_ns(&leader, &port)) < 0)
  1133. goto out;
  1134. if (cur_process.vmid == leader) {
  1135. ret = -ESRCH;
  1136. goto out;
  1137. }
  1138. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  1139. NS_CODE(QUERY),
  1140. sizeof(NS_MSG_TYPE(query)),
  1141. leader);
  1142. NS_MSG_TYPE(query) * msgin = (void *) &msg->msg.msg;
  1143. msgin->idx = idx;
  1144. debug("ipc send to %u: " NS_CODE_STR(QUERY) "(%u)\n", leader, idx);
  1145. ret = do_ipc_duplex(msg, port, NULL, NULL);
  1146. out:
  1147. if (port)
  1148. put_ipc_port(port);
  1149. SAVE_PROFILE_INTERVAL(NS_SEND(query));
  1150. return ret;
  1151. }
  1152. int NS_CALLBACK(query) (IPC_CALLBACK_ARGS)
  1153. {
  1154. BEGIN_PROFILE_INTERVAL();
  1155. NS_MSG_TYPE(query) * msgin = (void *) &msg->msg;
  1156. debug("ipc callback from %u: " NS_CODE_STR(QUERY) "(%u)\n",
  1157. msg->src, msgin->idx);
  1158. struct CONCAT2(NS, range) range;
  1159. int ret = 0;
  1160. memset(&range, 0, sizeof(struct CONCAT2(NS, range)));
  1161. ret = CONCAT3(get, NS, range)(msgin->idx, &range, NULL);
  1162. if (ret < 0)
  1163. goto out;
  1164. assert(msgin->idx >= range.base && msgin->idx < range.base + range.size);
  1165. assert(range.owner);
  1166. assert(!qstrempty(&range.uri));
  1167. struct ipc_ns_offered ans;
  1168. ans.base = range.base;
  1169. ans.size = range.size;
  1170. ans.lease = range.lease;
  1171. ans.owner_offset = 0;
  1172. int ownerdatasz = sizeof(struct ipc_ns_client) + range.uri.len;
  1173. struct ipc_ns_client * owner = __alloca(ownerdatasz);
  1174. owner->vmid = range.owner;
  1175. assert(!qstrempty(&range.uri));
  1176. memcpy(owner->uri, qstrgetstr(&range.uri), range.uri.len + 1);
  1177. ret = NS_SEND(answer)(port, msg->src, 1, &ans, 1, &owner, &ownerdatasz,
  1178. msg->seq);
  1179. out:
  1180. SAVE_PROFILE_INTERVAL(NS_CALLBACK(query));
  1181. return ret;
  1182. }
  1183. DEFINE_PROFILE_INTERVAL(NS_SEND(queryall), ipc);
  1184. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(queryall), ipc);
  1185. int NS_SEND(queryall) (void)
  1186. {
  1187. BEGIN_PROFILE_INTERVAL();
  1188. IDTYPE leader;
  1189. struct shim_ipc_port * port = NULL;
  1190. int ret = 0;
  1191. if ((ret = connect_ns(&leader, &port)) < 0)
  1192. goto out;
  1193. if (cur_process.vmid == leader)
  1194. goto out;
  1195. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  1196. NS_CODE(QUERYALL), 0, leader);
  1197. debug("ipc send to %u: " NS_CODE_STR(QUERYALL) "\n", leader);
  1198. ret = do_ipc_duplex(msg, port, NULL, NULL);
  1199. put_ipc_port(port);
  1200. out:
  1201. SAVE_PROFILE_INTERVAL(NS_SEND(queryall));
  1202. return ret;
  1203. }
  1204. int NS_CALLBACK(queryall) (IPC_CALLBACK_ARGS)
  1205. {
  1206. BEGIN_PROFILE_INTERVAL();
  1207. debug("ipc callback from %u: " NS_CODE_STR(QUERYALL) "\n", msg->src);
  1208. LISTP_TYPE(range) * list = &offered_ranges;
  1209. struct range * r;
  1210. int ret;
  1211. lock(range_map_lock);
  1212. int maxanswers = nowned + noffered + nsubed;
  1213. int nanswers = 0, nowners = 0, i;
  1214. struct ipc_ns_offered * answers =
  1215. __alloca(sizeof(struct ipc_ns_offered) * maxanswers);
  1216. struct ipc_ns_client ** ownerdata =
  1217. __alloca(sizeof(struct ipc_ns_client *) * maxanswers);
  1218. int * ownerdatasz = __alloca(sizeof(int) * maxanswers);
  1219. int owner_offset = 0;
  1220. retry:
  1221. listp_for_each_entry (r, list, list) {
  1222. struct shim_ipc_info * p = r->owner;
  1223. int datasz = sizeof(struct ipc_ns_client) + p->uri.len;
  1224. struct ipc_ns_client * owner = __alloca(datasz);
  1225. assert(!qstrempty(&p->uri));
  1226. owner->vmid = p->vmid;
  1227. memcpy(owner->uri, qstrgetstr(&p->uri), p->uri.len + 1);
  1228. IDTYPE base = r->offset * RANGE_SIZE + 1;
  1229. answers[nanswers].base = base;
  1230. answers[nanswers].size = RANGE_SIZE;
  1231. answers[nanswers].lease = r->lease;
  1232. answers[nanswers].owner_offset = owner_offset;
  1233. nanswers++;
  1234. ownerdata[nowners] = owner;
  1235. ownerdatasz[nowners] = datasz;
  1236. nowners++;
  1237. owner_offset += datasz;
  1238. if (!r->subranges)
  1239. continue;
  1240. for (i = 0 ; i < RANGE_SIZE ; i++) {
  1241. if (!r->subranges->map[i])
  1242. continue;
  1243. struct subrange * s = r->subranges->map[i];
  1244. p = s->owner;
  1245. datasz = sizeof(struct ipc_ns_client) + p->uri.len;
  1246. owner = __alloca(datasz);
  1247. assert(!qstrempty(&p->uri));
  1248. owner->vmid = p->vmid;
  1249. memcpy(owner->uri, qstrgetstr(&p->uri), p->uri.len + 1);
  1250. answers[nanswers].base = base + i;
  1251. answers[nanswers].size = 1;
  1252. answers[nanswers].lease = s->lease;
  1253. answers[nanswers].owner_offset = owner_offset;
  1254. nanswers++;
  1255. ownerdata[nowners] = owner;
  1256. ownerdatasz[nowners] = datasz;
  1257. nowners++;
  1258. owner_offset += datasz;
  1259. }
  1260. }
  1261. if (list == &offered_ranges) {
  1262. list = &owned_ranges;
  1263. goto retry;
  1264. }
  1265. unlock(range_map_lock);
  1266. ret = NS_SEND(answer)(port, msg->src, nanswers, answers, nowners,
  1267. ownerdata, ownerdatasz, msg->seq);
  1268. SAVE_PROFILE_INTERVAL(NS_CALLBACK(queryall));
  1269. return ret;
  1270. }
  1271. DEFINE_PROFILE_INTERVAL(NS_SEND(answer), ipc);
  1272. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(answer), ipc);
  1273. int NS_SEND(answer) (struct shim_ipc_port * port, IDTYPE dest,
  1274. int nanswers, struct ipc_ns_offered * answers,
  1275. int nowners, struct ipc_ns_client ** ownerdata,
  1276. int * ownerdatasz, unsigned long seq)
  1277. {
  1278. BEGIN_PROFILE_INTERVAL();
  1279. int owner_offset = sizeof(NS_MSG_TYPE(answer)) +
  1280. sizeof(struct ipc_ns_offered) * nanswers;
  1281. int total_ownerdatasz = 0;
  1282. for (int i = 0 ; i < nowners ; i++)
  1283. total_ownerdatasz += ownerdatasz[i];
  1284. struct shim_ipc_msg * msg =
  1285. create_ipc_msg_on_stack(NS_CODE(ANSWER),
  1286. owner_offset + total_ownerdatasz, dest);
  1287. NS_MSG_TYPE(answer) * msgin = (void *) &msg->msg;
  1288. msgin->nanswers = nanswers;
  1289. for (int i = 0 ; i < nanswers ; i++) {
  1290. msgin->answers[i] = answers[i];
  1291. msgin->answers[i].owner_offset += owner_offset;
  1292. }
  1293. for (int i = 0 ; i < nowners ; i++) {
  1294. memcpy((void *) msgin + owner_offset, ownerdata[i], ownerdatasz[i]);
  1295. owner_offset += ownerdatasz[i];
  1296. }
  1297. msg->seq = seq;
  1298. if (nanswers == 1)
  1299. debug("ipc send to %u: " NS_CODE_STR(ANSWER) "([%u, %u])\n", dest,
  1300. answers[0].base, answers[0].size);
  1301. else if (nanswers)
  1302. debug("ipc send to %u: " NS_CODE_STR(ANSWER) "([%u, %u], ...)\n", dest,
  1303. answers[0].base, answers[0].size);
  1304. int ret = send_ipc_message(msg, port);
  1305. SAVE_PROFILE_INTERVAL(NS_SEND(answer));
  1306. return ret;
  1307. }
  1308. int NS_CALLBACK(answer) (IPC_CALLBACK_ARGS)
  1309. {
  1310. BEGIN_PROFILE_INTERVAL();
  1311. NS_MSG_TYPE(answer) * msgin = (void *) &msg->msg;
  1312. if (msgin->nanswers == 1)
  1313. debug("ipc callback from %u: " NS_CODE_STR(ANSWER) "([%u, %u])\n",
  1314. msg->src, msgin->answers[0].base, msgin->answers[0].size);
  1315. else if (msgin->nanswers)
  1316. debug("ipc callback from %u: " NS_CODE_STR(ANSWER) "([%u, %u], ...)\n",
  1317. msg->src, msgin->answers[0].base, msgin->answers[0].size);
  1318. for (int i = 0 ; i < msgin->nanswers ; i++) {
  1319. struct ipc_ns_offered * ans = &msgin->answers[i];
  1320. struct ipc_ns_client * owner = (void *) msgin + ans->owner_offset;
  1321. switch (ans->size) {
  1322. case RANGE_SIZE:
  1323. CONCAT3(add, NS, range)(ans->base, owner->vmid, owner->uri,
  1324. ans->lease);
  1325. break;
  1326. case 1:
  1327. CONCAT3(add, NS, subrange)(ans->base, owner->vmid, owner->uri,
  1328. &ans->lease);
  1329. break;
  1330. default:
  1331. break;
  1332. }
  1333. }
  1334. struct shim_ipc_msg_obj * obj = find_ipc_msg_duplex(port, msg->seq);
  1335. if (obj && obj->thread)
  1336. thread_wakeup(obj->thread);
  1337. SAVE_PROFILE_INTERVAL(NS_CALLBACK(answer));
  1338. return 0;
  1339. }
  1340. #ifdef NS_KEY
  1341. #define KEY_HASH_LEN 8
  1342. #define KEY_HASH_NUM (1 << KEY_HASH_LEN)
  1343. #define KEY_HASH_MASK (KEY_HASH_NUM - 1)
  1344. DEFINE_LIST(key);
  1345. struct key {
  1346. NS_KEY key;
  1347. IDTYPE id;
  1348. LIST_TYPE(key) hlist;
  1349. };
  1350. DEFINE_LISTP(key);
  1351. static LISTP_TYPE(key) key_map [KEY_HASH_NUM];
  1352. int CONCAT2(NS, add_key) (NS_KEY * key, IDTYPE id)
  1353. {
  1354. LISTP_TYPE(key) * head = &key_map[KEY_HASH(key) & KEY_HASH_MASK];
  1355. struct key * k;
  1356. int ret = -EEXIST;
  1357. lock(range_map_lock);
  1358. listp_for_each_entry(k, head, hlist)
  1359. if (!KEY_COMP(&k->key, key))
  1360. goto out;
  1361. k = malloc(sizeof(struct key));
  1362. if (!k) {
  1363. ret = -ENOMEM;
  1364. goto out;
  1365. }
  1366. KEY_COPY(&k->key, key);
  1367. k->id = id;
  1368. INIT_LIST_HEAD(k, hlist);
  1369. listp_add(k, head, hlist);
  1370. debug("add key/id pair (%u, %u) to hash list: %p\n",
  1371. KEY_HASH(key), id, head);
  1372. ret = 0;
  1373. out:
  1374. unlock(range_map_lock);
  1375. return ret;
  1376. }
  1377. int CONCAT2(NS, get_key) (NS_KEY * key, bool delete)
  1378. {
  1379. LISTP_TYPE(key) * head = &key_map[KEY_HASH(key) & KEY_HASH_MASK];
  1380. struct key * k;
  1381. int id = -ENOENT;
  1382. lock(range_map_lock);
  1383. listp_for_each_entry(k, head, hlist)
  1384. if (!KEY_COMP(&k->key, key)) {
  1385. id = k->id;
  1386. if (delete) {
  1387. listp_del(k, head, hlist);
  1388. free(k);
  1389. }
  1390. break;
  1391. }
  1392. unlock(range_map_lock);
  1393. return id;
  1394. }
  1395. DEFINE_PROFILE_INTERVAL(NS_SEND(findkey), ipc);
  1396. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(findkey), ipc);
  1397. int NS_SEND(findkey) (NS_KEY * key)
  1398. {
  1399. BEGIN_PROFILE_INTERVAL();
  1400. int ret = 0;
  1401. ret = CONCAT2(NS, get_key) (key, false);
  1402. if (!ret)
  1403. goto out;
  1404. IDTYPE dest;
  1405. struct shim_ipc_port * port = NULL;
  1406. if ((ret = connect_ns(&dest, &port)) < 0)
  1407. goto out;
  1408. if (dest == cur_process.vmid) {
  1409. ret = -ENOENT;
  1410. goto out;
  1411. }
  1412. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  1413. NS_CODE(FINDKEY),
  1414. sizeof(NS_MSG_TYPE(findkey)),
  1415. dest);
  1416. NS_MSG_TYPE(findkey) * msgin = (void *) &msg->msg.msg;
  1417. KEY_COPY(&msgin->key, key);
  1418. debug("ipc send to %u: " NS_CODE_STR(FINDKEY) "(%u)\n",
  1419. dest, KEY_HASH(key));
  1420. ret = do_ipc_duplex(msg, port, NULL, NULL);
  1421. put_ipc_port(port);
  1422. if (!ret)
  1423. ret = CONCAT2(NS, get_key) (key, false);
  1424. out:
  1425. SAVE_PROFILE_INTERVAL(NS_SEND(findkey));
  1426. return ret;
  1427. }
  1428. int NS_CALLBACK(findkey) (IPC_CALLBACK_ARGS)
  1429. {
  1430. BEGIN_PROFILE_INTERVAL();
  1431. int ret = 0;
  1432. NS_MSG_TYPE(findkey) * msgin = (void *) &msg->msg;
  1433. debug("ipc callback from %u: " NS_CODE_STR(FINDKEY) "(%u)\n",
  1434. msg->src, KEY_HASH(&msgin->key));
  1435. ret = CONCAT2(NS, get_key)(&msgin->key, false);
  1436. if (ret < 0)
  1437. goto out;
  1438. ret = NS_SEND(tellkey)(port, msg->src, &msgin->key, ret, msg->seq);
  1439. out:
  1440. SAVE_PROFILE_INTERVAL(NS_CALLBACK(findkey));
  1441. return ret;
  1442. }
  1443. DEFINE_PROFILE_INTERVAL(NS_SEND(tellkey), ipc);
  1444. DEFINE_PROFILE_INTERVAL(NS_CALLBACK(tellkey), ipc);
  1445. int NS_SEND(tellkey) (struct shim_ipc_port * port, IDTYPE dest, NS_KEY * key,
  1446. IDTYPE id, unsigned long seq)
  1447. {
  1448. BEGIN_PROFILE_INTERVAL();
  1449. bool owned = true;
  1450. int ret = 0;
  1451. if (!dest) {
  1452. if ((ret = CONCAT2(NS, add_key)(key, id)) < 0)
  1453. goto out;
  1454. if ((ret = connect_ns(&dest, &port)) < 0)
  1455. goto out;
  1456. if (dest == cur_process.vmid)
  1457. goto out;
  1458. owned = false;
  1459. }
  1460. if (owned) {
  1461. struct shim_ipc_msg * msg = create_ipc_msg_on_stack(
  1462. NS_CODE(TELLKEY),
  1463. sizeof(NS_MSG_TYPE(tellkey)),
  1464. dest);
  1465. NS_MSG_TYPE(tellkey) * msgin = (void *) &msg->msg;
  1466. KEY_COPY(&msgin->key, key);
  1467. msgin->id = id;
  1468. msg->seq = seq;
  1469. debug("ipc send to %u: IPC_SYSV_TELLKEY(%u, %u)\n", dest,
  1470. KEY_HASH(key), id);
  1471. ret = send_ipc_message(msg, port);
  1472. goto out;
  1473. }
  1474. struct shim_ipc_msg_obj * msg = create_ipc_msg_duplex_on_stack(
  1475. NS_CODE(TELLKEY),
  1476. sizeof(NS_MSG_TYPE(tellkey)),
  1477. dest);
  1478. NS_MSG_TYPE(tellkey) * msgin = (void *) &msg->msg.msg;
  1479. KEY_COPY(&msgin->key, key);
  1480. msgin->id = id;
  1481. debug("ipc send to %u: IPC_SYSV_TELLKEY(%u, %u)\n", dest,
  1482. KEY_HASH(key), id);
  1483. ret = do_ipc_duplex(msg, port, NULL, NULL);
  1484. put_ipc_port(port);
  1485. out:
  1486. SAVE_PROFILE_INTERVAL(NS_SEND(tellkey));
  1487. return ret;
  1488. }
  1489. int NS_CALLBACK(tellkey) (IPC_CALLBACK_ARGS)
  1490. {
  1491. BEGIN_PROFILE_INTERVAL();
  1492. int ret = 0;
  1493. NS_MSG_TYPE(tellkey) * msgin = (void *) &msg->msg;
  1494. debug("ipc callback from %u: " NS_CODE_STR(TELLKEY) "(%u, %u)\n",
  1495. msg->src, KEY_HASH(&msgin->key), msgin->id);
  1496. ret = CONCAT2(NS, add_key)(&msgin->key, msgin->id);
  1497. struct shim_ipc_msg_obj * obj = find_ipc_msg_duplex(port, msg->seq);
  1498. if (!obj) {
  1499. ret = RESPONSE_CALLBACK;
  1500. goto out;
  1501. }
  1502. if (obj->thread)
  1503. thread_wakeup(obj->thread);
  1504. out:
  1505. SAVE_PROFILE_INTERVAL(ipc_sysv_tellkey_callback);
  1506. return ret;
  1507. }
  1508. #endif /* NS_KEY */