2
0

xen-legacy-backend.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845
  1. /*
  2. * xen backend driver infrastructure
  3. * (c) 2008 Gerd Hoffmann <kraxel@redhat.com>
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation; under version 2 of the License.
  8. *
  9. * This program 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. *
  14. * You should have received a copy of the GNU General Public License along
  15. * with this program; if not, see <http://www.gnu.org/licenses/>.
  16. *
  17. * Contributions after 2012-01-13 are licensed under the terms of the
  18. * GNU GPL, version 2 or (at your option) any later version.
  19. */
  20. /*
  21. * TODO: add some xenbus / xenstore concepts overview here.
  22. */
  23. #include "qemu/osdep.h"
  24. #include <sys/signal.h>
  25. #include "hw/sysbus.h"
  26. #include "hw/boards.h"
  27. #include "hw/qdev-properties.h"
  28. #include "qemu/log.h"
  29. #include "qemu/main-loop.h"
  30. #include "qapi/error.h"
  31. #include "hw/xen/xen-legacy-backend.h"
  32. #include "hw/xen/xen_pvdev.h"
  33. #include "monitor/qdev.h"
  34. DeviceState *xen_sysdev;
  35. BusState *xen_sysbus;
  36. /* ------------------------------------------------------------- */
  37. /* public */
  38. struct xs_handle *xenstore;
  39. const char *xen_protocol;
  40. /* private */
  41. static bool xen_feature_grant_copy;
  42. static int debug;
  43. int xenstore_write_be_str(struct XenLegacyDevice *xendev, const char *node,
  44. const char *val)
  45. {
  46. return xenstore_write_str(xendev->be, node, val);
  47. }
  48. int xenstore_write_be_int(struct XenLegacyDevice *xendev, const char *node,
  49. int ival)
  50. {
  51. return xenstore_write_int(xendev->be, node, ival);
  52. }
  53. int xenstore_write_be_int64(struct XenLegacyDevice *xendev, const char *node,
  54. int64_t ival)
  55. {
  56. return xenstore_write_int64(xendev->be, node, ival);
  57. }
  58. char *xenstore_read_be_str(struct XenLegacyDevice *xendev, const char *node)
  59. {
  60. return xenstore_read_str(xendev->be, node);
  61. }
  62. int xenstore_read_be_int(struct XenLegacyDevice *xendev, const char *node,
  63. int *ival)
  64. {
  65. return xenstore_read_int(xendev->be, node, ival);
  66. }
  67. char *xenstore_read_fe_str(struct XenLegacyDevice *xendev, const char *node)
  68. {
  69. return xenstore_read_str(xendev->fe, node);
  70. }
  71. int xenstore_read_fe_int(struct XenLegacyDevice *xendev, const char *node,
  72. int *ival)
  73. {
  74. return xenstore_read_int(xendev->fe, node, ival);
  75. }
  76. int xenstore_read_fe_uint64(struct XenLegacyDevice *xendev, const char *node,
  77. uint64_t *uval)
  78. {
  79. return xenstore_read_uint64(xendev->fe, node, uval);
  80. }
  81. /* ------------------------------------------------------------- */
  82. int xen_be_set_state(struct XenLegacyDevice *xendev, enum xenbus_state state)
  83. {
  84. int rc;
  85. rc = xenstore_write_be_int(xendev, "state", state);
  86. if (rc < 0) {
  87. return rc;
  88. }
  89. xen_pv_printf(xendev, 1, "backend state: %s -> %s\n",
  90. xenbus_strstate(xendev->be_state), xenbus_strstate(state));
  91. xendev->be_state = state;
  92. return 0;
  93. }
  94. void xen_be_set_max_grant_refs(struct XenLegacyDevice *xendev,
  95. unsigned int nr_refs)
  96. {
  97. assert(xendev->ops->flags & DEVOPS_FLAG_NEED_GNTDEV);
  98. if (xengnttab_set_max_grants(xendev->gnttabdev, nr_refs)) {
  99. xen_pv_printf(xendev, 0, "xengnttab_set_max_grants failed: %s\n",
  100. strerror(errno));
  101. }
  102. }
  103. void *xen_be_map_grant_refs(struct XenLegacyDevice *xendev, uint32_t *refs,
  104. unsigned int nr_refs, int prot)
  105. {
  106. void *ptr;
  107. assert(xendev->ops->flags & DEVOPS_FLAG_NEED_GNTDEV);
  108. ptr = xengnttab_map_domain_grant_refs(xendev->gnttabdev, nr_refs,
  109. xen_domid, refs, prot);
  110. if (!ptr) {
  111. xen_pv_printf(xendev, 0,
  112. "xengnttab_map_domain_grant_refs failed: %s\n",
  113. strerror(errno));
  114. }
  115. return ptr;
  116. }
  117. void xen_be_unmap_grant_refs(struct XenLegacyDevice *xendev, void *ptr,
  118. unsigned int nr_refs)
  119. {
  120. assert(xendev->ops->flags & DEVOPS_FLAG_NEED_GNTDEV);
  121. if (xengnttab_unmap(xendev->gnttabdev, ptr, nr_refs)) {
  122. xen_pv_printf(xendev, 0, "xengnttab_unmap failed: %s\n",
  123. strerror(errno));
  124. }
  125. }
  126. static int compat_copy_grant_refs(struct XenLegacyDevice *xendev,
  127. bool to_domain,
  128. XenGrantCopySegment segs[],
  129. unsigned int nr_segs)
  130. {
  131. uint32_t *refs = g_new(uint32_t, nr_segs);
  132. int prot = to_domain ? PROT_WRITE : PROT_READ;
  133. void *pages;
  134. unsigned int i;
  135. for (i = 0; i < nr_segs; i++) {
  136. XenGrantCopySegment *seg = &segs[i];
  137. refs[i] = to_domain ?
  138. seg->dest.foreign.ref : seg->source.foreign.ref;
  139. }
  140. pages = xengnttab_map_domain_grant_refs(xendev->gnttabdev, nr_segs,
  141. xen_domid, refs, prot);
  142. if (!pages) {
  143. xen_pv_printf(xendev, 0,
  144. "xengnttab_map_domain_grant_refs failed: %s\n",
  145. strerror(errno));
  146. g_free(refs);
  147. return -1;
  148. }
  149. for (i = 0; i < nr_segs; i++) {
  150. XenGrantCopySegment *seg = &segs[i];
  151. void *page = pages + (i * XC_PAGE_SIZE);
  152. if (to_domain) {
  153. memcpy(page + seg->dest.foreign.offset, seg->source.virt,
  154. seg->len);
  155. } else {
  156. memcpy(seg->dest.virt, page + seg->source.foreign.offset,
  157. seg->len);
  158. }
  159. }
  160. if (xengnttab_unmap(xendev->gnttabdev, pages, nr_segs)) {
  161. xen_pv_printf(xendev, 0, "xengnttab_unmap failed: %s\n",
  162. strerror(errno));
  163. }
  164. g_free(refs);
  165. return 0;
  166. }
  167. int xen_be_copy_grant_refs(struct XenLegacyDevice *xendev,
  168. bool to_domain,
  169. XenGrantCopySegment segs[],
  170. unsigned int nr_segs)
  171. {
  172. xengnttab_grant_copy_segment_t *xengnttab_segs;
  173. unsigned int i;
  174. int rc;
  175. assert(xendev->ops->flags & DEVOPS_FLAG_NEED_GNTDEV);
  176. if (!xen_feature_grant_copy) {
  177. return compat_copy_grant_refs(xendev, to_domain, segs, nr_segs);
  178. }
  179. xengnttab_segs = g_new0(xengnttab_grant_copy_segment_t, nr_segs);
  180. for (i = 0; i < nr_segs; i++) {
  181. XenGrantCopySegment *seg = &segs[i];
  182. xengnttab_grant_copy_segment_t *xengnttab_seg = &xengnttab_segs[i];
  183. if (to_domain) {
  184. xengnttab_seg->flags = GNTCOPY_dest_gref;
  185. xengnttab_seg->dest.foreign.domid = xen_domid;
  186. xengnttab_seg->dest.foreign.ref = seg->dest.foreign.ref;
  187. xengnttab_seg->dest.foreign.offset = seg->dest.foreign.offset;
  188. xengnttab_seg->source.virt = seg->source.virt;
  189. } else {
  190. xengnttab_seg->flags = GNTCOPY_source_gref;
  191. xengnttab_seg->source.foreign.domid = xen_domid;
  192. xengnttab_seg->source.foreign.ref = seg->source.foreign.ref;
  193. xengnttab_seg->source.foreign.offset =
  194. seg->source.foreign.offset;
  195. xengnttab_seg->dest.virt = seg->dest.virt;
  196. }
  197. xengnttab_seg->len = seg->len;
  198. }
  199. rc = xengnttab_grant_copy(xendev->gnttabdev, nr_segs, xengnttab_segs);
  200. if (rc) {
  201. xen_pv_printf(xendev, 0, "xengnttab_copy failed: %s\n",
  202. strerror(errno));
  203. }
  204. for (i = 0; i < nr_segs; i++) {
  205. xengnttab_grant_copy_segment_t *xengnttab_seg =
  206. &xengnttab_segs[i];
  207. if (xengnttab_seg->status != GNTST_okay) {
  208. xen_pv_printf(xendev, 0, "segment[%u] status: %d\n", i,
  209. xengnttab_seg->status);
  210. rc = -1;
  211. }
  212. }
  213. g_free(xengnttab_segs);
  214. return rc;
  215. }
  216. /*
  217. * get xen backend device, allocate a new one if it doesn't exist.
  218. */
  219. static struct XenLegacyDevice *xen_be_get_xendev(const char *type, int dom,
  220. int dev,
  221. struct XenDevOps *ops)
  222. {
  223. struct XenLegacyDevice *xendev;
  224. xendev = xen_pv_find_xendev(type, dom, dev);
  225. if (xendev) {
  226. return xendev;
  227. }
  228. /* init new xendev */
  229. xendev = g_malloc0(ops->size);
  230. object_initialize(&xendev->qdev, ops->size, TYPE_XENBACKEND);
  231. OBJECT(xendev)->free = g_free;
  232. qdev_set_parent_bus(DEVICE(xendev), xen_sysbus);
  233. qdev_set_id(DEVICE(xendev), g_strdup_printf("xen-%s-%d", type, dev));
  234. qdev_init_nofail(DEVICE(xendev));
  235. object_unref(OBJECT(xendev));
  236. xendev->type = type;
  237. xendev->dom = dom;
  238. xendev->dev = dev;
  239. xendev->ops = ops;
  240. snprintf(xendev->be, sizeof(xendev->be), "backend/%s/%d/%d",
  241. xendev->type, xendev->dom, xendev->dev);
  242. snprintf(xendev->name, sizeof(xendev->name), "%s-%d",
  243. xendev->type, xendev->dev);
  244. xendev->debug = debug;
  245. xendev->local_port = -1;
  246. xendev->evtchndev = xenevtchn_open(NULL, 0);
  247. if (xendev->evtchndev == NULL) {
  248. xen_pv_printf(NULL, 0, "can't open evtchn device\n");
  249. qdev_unplug(DEVICE(xendev), NULL);
  250. return NULL;
  251. }
  252. qemu_set_cloexec(xenevtchn_fd(xendev->evtchndev));
  253. xen_pv_insert_xendev(xendev);
  254. if (xendev->ops->alloc) {
  255. xendev->ops->alloc(xendev);
  256. }
  257. return xendev;
  258. }
  259. /*
  260. * Sync internal data structures on xenstore updates.
  261. * Node specifies the changed field. node = NULL means
  262. * update all fields (used for initialization).
  263. */
  264. static void xen_be_backend_changed(struct XenLegacyDevice *xendev,
  265. const char *node)
  266. {
  267. if (node == NULL || strcmp(node, "online") == 0) {
  268. if (xenstore_read_be_int(xendev, "online", &xendev->online) == -1) {
  269. xendev->online = 0;
  270. }
  271. }
  272. if (node) {
  273. xen_pv_printf(xendev, 2, "backend update: %s\n", node);
  274. if (xendev->ops->backend_changed) {
  275. xendev->ops->backend_changed(xendev, node);
  276. }
  277. }
  278. }
  279. static void xen_be_frontend_changed(struct XenLegacyDevice *xendev,
  280. const char *node)
  281. {
  282. int fe_state;
  283. if (node == NULL || strcmp(node, "state") == 0) {
  284. if (xenstore_read_fe_int(xendev, "state", &fe_state) == -1) {
  285. fe_state = XenbusStateUnknown;
  286. }
  287. if (xendev->fe_state != fe_state) {
  288. xen_pv_printf(xendev, 1, "frontend state: %s -> %s\n",
  289. xenbus_strstate(xendev->fe_state),
  290. xenbus_strstate(fe_state));
  291. }
  292. xendev->fe_state = fe_state;
  293. }
  294. if (node == NULL || strcmp(node, "protocol") == 0) {
  295. g_free(xendev->protocol);
  296. xendev->protocol = xenstore_read_fe_str(xendev, "protocol");
  297. if (xendev->protocol) {
  298. xen_pv_printf(xendev, 1, "frontend protocol: %s\n",
  299. xendev->protocol);
  300. }
  301. }
  302. if (node) {
  303. xen_pv_printf(xendev, 2, "frontend update: %s\n", node);
  304. if (xendev->ops->frontend_changed) {
  305. xendev->ops->frontend_changed(xendev, node);
  306. }
  307. }
  308. }
  309. /* ------------------------------------------------------------- */
  310. /* Check for possible state transitions and perform them. */
  311. /*
  312. * Initial xendev setup. Read frontend path, register watch for it.
  313. * Should succeed once xend finished setting up the backend device.
  314. *
  315. * Also sets initial state (-> Initializing) when done. Which
  316. * only affects the xendev->be_state variable as xenbus should
  317. * already be put into that state by xend.
  318. */
  319. static int xen_be_try_setup(struct XenLegacyDevice *xendev)
  320. {
  321. char token[XEN_BUFSIZE];
  322. int be_state;
  323. if (xenstore_read_be_int(xendev, "state", &be_state) == -1) {
  324. xen_pv_printf(xendev, 0, "reading backend state failed\n");
  325. return -1;
  326. }
  327. if (be_state != XenbusStateInitialising) {
  328. xen_pv_printf(xendev, 0, "initial backend state is wrong (%s)\n",
  329. xenbus_strstate(be_state));
  330. return -1;
  331. }
  332. xendev->fe = xenstore_read_be_str(xendev, "frontend");
  333. if (xendev->fe == NULL) {
  334. xen_pv_printf(xendev, 0, "reading frontend path failed\n");
  335. return -1;
  336. }
  337. /* setup frontend watch */
  338. snprintf(token, sizeof(token), "fe:%p", xendev);
  339. if (!xs_watch(xenstore, xendev->fe, token)) {
  340. xen_pv_printf(xendev, 0, "watching frontend path (%s) failed\n",
  341. xendev->fe);
  342. return -1;
  343. }
  344. xen_be_set_state(xendev, XenbusStateInitialising);
  345. xen_be_backend_changed(xendev, NULL);
  346. xen_be_frontend_changed(xendev, NULL);
  347. return 0;
  348. }
  349. /*
  350. * Try initialize xendev. Prepare everything the backend can do
  351. * without synchronizing with the frontend. Fakes hotplug-status. No
  352. * hotplug involved here because this is about userspace drivers, thus
  353. * there are kernel backend devices which could invoke hotplug.
  354. *
  355. * Goes to InitWait on success.
  356. */
  357. static int xen_be_try_init(struct XenLegacyDevice *xendev)
  358. {
  359. int rc = 0;
  360. if (!xendev->online) {
  361. xen_pv_printf(xendev, 1, "not online\n");
  362. return -1;
  363. }
  364. if (xendev->ops->init) {
  365. rc = xendev->ops->init(xendev);
  366. }
  367. if (rc != 0) {
  368. xen_pv_printf(xendev, 1, "init() failed\n");
  369. return rc;
  370. }
  371. xenstore_write_be_str(xendev, "hotplug-status", "connected");
  372. xen_be_set_state(xendev, XenbusStateInitWait);
  373. return 0;
  374. }
  375. /*
  376. * Try to initialise xendev. Depends on the frontend being ready
  377. * for it (shared ring and evtchn info in xenstore, state being
  378. * Initialised or Connected).
  379. *
  380. * Goes to Connected on success.
  381. */
  382. static int xen_be_try_initialise(struct XenLegacyDevice *xendev)
  383. {
  384. int rc = 0;
  385. if (xendev->fe_state != XenbusStateInitialised &&
  386. xendev->fe_state != XenbusStateConnected) {
  387. if (xendev->ops->flags & DEVOPS_FLAG_IGNORE_STATE) {
  388. xen_pv_printf(xendev, 2, "frontend not ready, ignoring\n");
  389. } else {
  390. xen_pv_printf(xendev, 2, "frontend not ready (yet)\n");
  391. return -1;
  392. }
  393. }
  394. if (xendev->ops->flags & DEVOPS_FLAG_NEED_GNTDEV) {
  395. xendev->gnttabdev = xengnttab_open(NULL, 0);
  396. if (xendev->gnttabdev == NULL) {
  397. xen_pv_printf(NULL, 0, "can't open gnttab device\n");
  398. return -1;
  399. }
  400. } else {
  401. xendev->gnttabdev = NULL;
  402. }
  403. if (xendev->ops->initialise) {
  404. rc = xendev->ops->initialise(xendev);
  405. }
  406. if (rc != 0) {
  407. xen_pv_printf(xendev, 0, "initialise() failed\n");
  408. return rc;
  409. }
  410. xen_be_set_state(xendev, XenbusStateConnected);
  411. return 0;
  412. }
  413. /*
  414. * Try to let xendev know that it is connected. Depends on the
  415. * frontend being Connected. Note that this may be called more
  416. * than once since the backend state is not modified.
  417. */
  418. static void xen_be_try_connected(struct XenLegacyDevice *xendev)
  419. {
  420. if (!xendev->ops->connected) {
  421. return;
  422. }
  423. if (xendev->fe_state != XenbusStateConnected) {
  424. if (xendev->ops->flags & DEVOPS_FLAG_IGNORE_STATE) {
  425. xen_pv_printf(xendev, 2, "frontend not ready, ignoring\n");
  426. } else {
  427. xen_pv_printf(xendev, 2, "frontend not ready (yet)\n");
  428. return;
  429. }
  430. }
  431. xendev->ops->connected(xendev);
  432. }
  433. /*
  434. * Teardown connection.
  435. *
  436. * Goes to Closed when done.
  437. */
  438. static void xen_be_disconnect(struct XenLegacyDevice *xendev,
  439. enum xenbus_state state)
  440. {
  441. if (xendev->be_state != XenbusStateClosing &&
  442. xendev->be_state != XenbusStateClosed &&
  443. xendev->ops->disconnect) {
  444. xendev->ops->disconnect(xendev);
  445. }
  446. if (xendev->gnttabdev) {
  447. xengnttab_close(xendev->gnttabdev);
  448. xendev->gnttabdev = NULL;
  449. }
  450. if (xendev->be_state != state) {
  451. xen_be_set_state(xendev, state);
  452. }
  453. }
  454. /*
  455. * Try to reset xendev, for reconnection by another frontend instance.
  456. */
  457. static int xen_be_try_reset(struct XenLegacyDevice *xendev)
  458. {
  459. if (xendev->fe_state != XenbusStateInitialising) {
  460. return -1;
  461. }
  462. xen_pv_printf(xendev, 1, "device reset (for re-connect)\n");
  463. xen_be_set_state(xendev, XenbusStateInitialising);
  464. return 0;
  465. }
  466. /*
  467. * state change dispatcher function
  468. */
  469. void xen_be_check_state(struct XenLegacyDevice *xendev)
  470. {
  471. int rc = 0;
  472. /* frontend may request shutdown from almost anywhere */
  473. if (xendev->fe_state == XenbusStateClosing ||
  474. xendev->fe_state == XenbusStateClosed) {
  475. xen_be_disconnect(xendev, xendev->fe_state);
  476. return;
  477. }
  478. /* check for possible backend state transitions */
  479. for (;;) {
  480. switch (xendev->be_state) {
  481. case XenbusStateUnknown:
  482. rc = xen_be_try_setup(xendev);
  483. break;
  484. case XenbusStateInitialising:
  485. rc = xen_be_try_init(xendev);
  486. break;
  487. case XenbusStateInitWait:
  488. rc = xen_be_try_initialise(xendev);
  489. break;
  490. case XenbusStateConnected:
  491. /* xendev->be_state doesn't change */
  492. xen_be_try_connected(xendev);
  493. rc = -1;
  494. break;
  495. case XenbusStateClosed:
  496. rc = xen_be_try_reset(xendev);
  497. break;
  498. default:
  499. rc = -1;
  500. }
  501. if (rc != 0) {
  502. break;
  503. }
  504. }
  505. }
  506. /* ------------------------------------------------------------- */
  507. static int xenstore_scan(const char *type, int dom, struct XenDevOps *ops)
  508. {
  509. struct XenLegacyDevice *xendev;
  510. char path[XEN_BUFSIZE], token[XEN_BUFSIZE];
  511. char **dev = NULL;
  512. unsigned int cdev, j;
  513. /* setup watch */
  514. snprintf(token, sizeof(token), "be:%p:%d:%p", type, dom, ops);
  515. snprintf(path, sizeof(path), "backend/%s/%d", type, dom);
  516. if (!xs_watch(xenstore, path, token)) {
  517. xen_pv_printf(NULL, 0, "xen be: watching backend path (%s) failed\n",
  518. path);
  519. return -1;
  520. }
  521. /* look for backends */
  522. dev = xs_directory(xenstore, 0, path, &cdev);
  523. if (!dev) {
  524. return 0;
  525. }
  526. for (j = 0; j < cdev; j++) {
  527. xendev = xen_be_get_xendev(type, dom, atoi(dev[j]), ops);
  528. if (xendev == NULL) {
  529. continue;
  530. }
  531. xen_be_check_state(xendev);
  532. }
  533. free(dev);
  534. return 0;
  535. }
  536. void xenstore_update_be(char *watch, char *type, int dom,
  537. struct XenDevOps *ops)
  538. {
  539. struct XenLegacyDevice *xendev;
  540. char path[XEN_BUFSIZE], *bepath;
  541. unsigned int len, dev;
  542. len = snprintf(path, sizeof(path), "backend/%s/%d", type, dom);
  543. if (strncmp(path, watch, len) != 0) {
  544. return;
  545. }
  546. if (sscanf(watch + len, "/%u/%255s", &dev, path) != 2) {
  547. strcpy(path, "");
  548. if (sscanf(watch + len, "/%u", &dev) != 1) {
  549. dev = -1;
  550. }
  551. }
  552. if (dev == -1) {
  553. return;
  554. }
  555. xendev = xen_be_get_xendev(type, dom, dev, ops);
  556. if (xendev != NULL) {
  557. bepath = xs_read(xenstore, 0, xendev->be, &len);
  558. if (bepath == NULL) {
  559. xen_pv_del_xendev(xendev);
  560. } else {
  561. free(bepath);
  562. xen_be_backend_changed(xendev, path);
  563. xen_be_check_state(xendev);
  564. }
  565. }
  566. }
  567. void xenstore_update_fe(char *watch, struct XenLegacyDevice *xendev)
  568. {
  569. char *node;
  570. unsigned int len;
  571. len = strlen(xendev->fe);
  572. if (strncmp(xendev->fe, watch, len) != 0) {
  573. return;
  574. }
  575. if (watch[len] != '/') {
  576. return;
  577. }
  578. node = watch + len + 1;
  579. xen_be_frontend_changed(xendev, node);
  580. xen_be_check_state(xendev);
  581. }
  582. /* -------------------------------------------------------------------- */
  583. int xen_be_init(void)
  584. {
  585. xengnttab_handle *gnttabdev;
  586. xenstore = xs_daemon_open();
  587. if (!xenstore) {
  588. xen_pv_printf(NULL, 0, "can't connect to xenstored\n");
  589. return -1;
  590. }
  591. qemu_set_fd_handler(xs_fileno(xenstore), xenstore_update, NULL, NULL);
  592. if (xen_xc == NULL || xen_fmem == NULL) {
  593. /* Check if xen_init() have been called */
  594. goto err;
  595. }
  596. gnttabdev = xengnttab_open(NULL, 0);
  597. if (gnttabdev != NULL) {
  598. if (xengnttab_grant_copy(gnttabdev, 0, NULL) == 0) {
  599. xen_feature_grant_copy = true;
  600. }
  601. xengnttab_close(gnttabdev);
  602. }
  603. xen_sysdev = qdev_create(NULL, TYPE_XENSYSDEV);
  604. qdev_init_nofail(xen_sysdev);
  605. xen_sysbus = qbus_create(TYPE_XENSYSBUS, DEVICE(xen_sysdev), "xen-sysbus");
  606. qbus_set_bus_hotplug_handler(xen_sysbus, &error_abort);
  607. return 0;
  608. err:
  609. qemu_set_fd_handler(xs_fileno(xenstore), NULL, NULL, NULL);
  610. xs_daemon_close(xenstore);
  611. xenstore = NULL;
  612. return -1;
  613. }
  614. static void xen_set_dynamic_sysbus(void)
  615. {
  616. Object *machine = qdev_get_machine();
  617. ObjectClass *oc = object_get_class(machine);
  618. MachineClass *mc = MACHINE_CLASS(oc);
  619. machine_class_allow_dynamic_sysbus_dev(mc, TYPE_XENSYSDEV);
  620. }
  621. int xen_be_register(const char *type, struct XenDevOps *ops)
  622. {
  623. char path[50];
  624. int rc;
  625. if (ops->backend_register) {
  626. rc = ops->backend_register();
  627. if (rc) {
  628. return rc;
  629. }
  630. }
  631. snprintf(path, sizeof(path), "device-model/%u/backends/%s", xen_domid,
  632. type);
  633. xenstore_mkdir(path, XS_PERM_NONE);
  634. return xenstore_scan(type, xen_domid, ops);
  635. }
  636. void xen_be_register_common(void)
  637. {
  638. xen_set_dynamic_sysbus();
  639. xen_be_register("console", &xen_console_ops);
  640. xen_be_register("vkbd", &xen_kbdmouse_ops);
  641. #ifdef CONFIG_VIRTFS
  642. xen_be_register("9pfs", &xen_9pfs_ops);
  643. #endif
  644. #ifdef CONFIG_USB_LIBUSB
  645. xen_be_register("qusb", &xen_usb_ops);
  646. #endif
  647. }
  648. int xen_be_bind_evtchn(struct XenLegacyDevice *xendev)
  649. {
  650. if (xendev->local_port != -1) {
  651. return 0;
  652. }
  653. xendev->local_port = xenevtchn_bind_interdomain
  654. (xendev->evtchndev, xendev->dom, xendev->remote_port);
  655. if (xendev->local_port == -1) {
  656. xen_pv_printf(xendev, 0, "xenevtchn_bind_interdomain failed\n");
  657. return -1;
  658. }
  659. xen_pv_printf(xendev, 2, "bind evtchn port %d\n", xendev->local_port);
  660. qemu_set_fd_handler(xenevtchn_fd(xendev->evtchndev),
  661. xen_pv_evtchn_event, NULL, xendev);
  662. return 0;
  663. }
  664. static Property xendev_properties[] = {
  665. DEFINE_PROP_END_OF_LIST(),
  666. };
  667. static void xendev_class_init(ObjectClass *klass, void *data)
  668. {
  669. DeviceClass *dc = DEVICE_CLASS(klass);
  670. dc->props = xendev_properties;
  671. set_bit(DEVICE_CATEGORY_MISC, dc->categories);
  672. /* xen-backend devices can be plugged/unplugged dynamically */
  673. dc->user_creatable = true;
  674. }
  675. static const TypeInfo xendev_type_info = {
  676. .name = TYPE_XENBACKEND,
  677. .parent = TYPE_XENSYSDEV,
  678. .class_init = xendev_class_init,
  679. .instance_size = sizeof(struct XenLegacyDevice),
  680. };
  681. static void xen_sysbus_class_init(ObjectClass *klass, void *data)
  682. {
  683. HotplugHandlerClass *hc = HOTPLUG_HANDLER_CLASS(klass);
  684. hc->unplug = qdev_simple_device_unplug_cb;
  685. }
  686. static const TypeInfo xensysbus_info = {
  687. .name = TYPE_XENSYSBUS,
  688. .parent = TYPE_BUS,
  689. .class_init = xen_sysbus_class_init,
  690. .interfaces = (InterfaceInfo[]) {
  691. { TYPE_HOTPLUG_HANDLER },
  692. { }
  693. }
  694. };
  695. static Property xen_sysdev_properties[] = {
  696. {/* end of property list */},
  697. };
  698. static void xen_sysdev_class_init(ObjectClass *klass, void *data)
  699. {
  700. DeviceClass *dc = DEVICE_CLASS(klass);
  701. dc->props = xen_sysdev_properties;
  702. dc->bus_type = TYPE_XENSYSBUS;
  703. }
  704. static const TypeInfo xensysdev_info = {
  705. .name = TYPE_XENSYSDEV,
  706. .parent = TYPE_SYS_BUS_DEVICE,
  707. .instance_size = sizeof(SysBusDevice),
  708. .class_init = xen_sysdev_class_init,
  709. };
  710. static void xenbe_register_types(void)
  711. {
  712. type_register_static(&xensysbus_info);
  713. type_register_static(&xensysdev_info);
  714. type_register_static(&xendev_type_info);
  715. }
  716. type_init(xenbe_register_types)