shim_ipc_nsimpl.h 48 KB

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