shim_ipc_nsimpl.h 49 KB

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