162306a36Sopenharmony_ci/******************************************************************************
262306a36Sopenharmony_ci * xenbus_xs.c
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * This is the kernel equivalent of the "xs" library.  We don't need everything
562306a36Sopenharmony_ci * and we use xenbus_comms for communication.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Copyright (C) 2005 Rusty Russell, IBM Corporation
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci * This program is free software; you can redistribute it and/or
1062306a36Sopenharmony_ci * modify it under the terms of the GNU General Public License version 2
1162306a36Sopenharmony_ci * as published by the Free Software Foundation; or, when distributed
1262306a36Sopenharmony_ci * separately from the Linux kernel or incorporated into other
1362306a36Sopenharmony_ci * software packages, subject to the following license:
1462306a36Sopenharmony_ci *
1562306a36Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a copy
1662306a36Sopenharmony_ci * of this source file (the "Software"), to deal in the Software without
1762306a36Sopenharmony_ci * restriction, including without limitation the rights to use, copy, modify,
1862306a36Sopenharmony_ci * merge, publish, distribute, sublicense, and/or sell copies of the Software,
1962306a36Sopenharmony_ci * and to permit persons to whom the Software is furnished to do so, subject to
2062306a36Sopenharmony_ci * the following conditions:
2162306a36Sopenharmony_ci *
2262306a36Sopenharmony_ci * The above copyright notice and this permission notice shall be included in
2362306a36Sopenharmony_ci * all copies or substantial portions of the Software.
2462306a36Sopenharmony_ci *
2562306a36Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
2662306a36Sopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
2762306a36Sopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
2862306a36Sopenharmony_ci * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
2962306a36Sopenharmony_ci * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
3062306a36Sopenharmony_ci * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
3162306a36Sopenharmony_ci * IN THE SOFTWARE.
3262306a36Sopenharmony_ci */
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci#include <linux/unistd.h>
3762306a36Sopenharmony_ci#include <linux/errno.h>
3862306a36Sopenharmony_ci#include <linux/types.h>
3962306a36Sopenharmony_ci#include <linux/uio.h>
4062306a36Sopenharmony_ci#include <linux/kernel.h>
4162306a36Sopenharmony_ci#include <linux/string.h>
4262306a36Sopenharmony_ci#include <linux/err.h>
4362306a36Sopenharmony_ci#include <linux/slab.h>
4462306a36Sopenharmony_ci#include <linux/fcntl.h>
4562306a36Sopenharmony_ci#include <linux/kthread.h>
4662306a36Sopenharmony_ci#include <linux/reboot.h>
4762306a36Sopenharmony_ci#include <linux/rwsem.h>
4862306a36Sopenharmony_ci#include <linux/mutex.h>
4962306a36Sopenharmony_ci#include <asm/xen/hypervisor.h>
5062306a36Sopenharmony_ci#include <xen/xenbus.h>
5162306a36Sopenharmony_ci#include <xen/xen.h>
5262306a36Sopenharmony_ci#include "xenbus.h"
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci/*
5562306a36Sopenharmony_ci * Framework to protect suspend/resume handling against normal Xenstore
5662306a36Sopenharmony_ci * message handling:
5762306a36Sopenharmony_ci * During suspend/resume there must be no open transaction and no pending
5862306a36Sopenharmony_ci * Xenstore request.
5962306a36Sopenharmony_ci * New watch events happening in this time can be ignored by firing all watches
6062306a36Sopenharmony_ci * after resume.
6162306a36Sopenharmony_ci */
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci/* Lock protecting enter/exit critical region. */
6462306a36Sopenharmony_cistatic DEFINE_SPINLOCK(xs_state_lock);
6562306a36Sopenharmony_ci/* Number of users in critical region (protected by xs_state_lock). */
6662306a36Sopenharmony_cistatic unsigned int xs_state_users;
6762306a36Sopenharmony_ci/* Suspend handler waiting or already active (protected by xs_state_lock)? */
6862306a36Sopenharmony_cistatic int xs_suspend_active;
6962306a36Sopenharmony_ci/* Unique Xenstore request id (protected by xs_state_lock). */
7062306a36Sopenharmony_cistatic uint32_t xs_request_id;
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci/* Wait queue for all callers waiting for critical region to become usable. */
7362306a36Sopenharmony_cistatic DECLARE_WAIT_QUEUE_HEAD(xs_state_enter_wq);
7462306a36Sopenharmony_ci/* Wait queue for suspend handling waiting for critical region being empty. */
7562306a36Sopenharmony_cistatic DECLARE_WAIT_QUEUE_HEAD(xs_state_exit_wq);
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci/* List of registered watches, and a lock to protect it. */
7862306a36Sopenharmony_cistatic LIST_HEAD(watches);
7962306a36Sopenharmony_cistatic DEFINE_SPINLOCK(watches_lock);
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci/* List of pending watch callback events, and a lock to protect it. */
8262306a36Sopenharmony_cistatic LIST_HEAD(watch_events);
8362306a36Sopenharmony_cistatic DEFINE_SPINLOCK(watch_events_lock);
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci/* Protect watch (de)register against save/restore. */
8662306a36Sopenharmony_cistatic DECLARE_RWSEM(xs_watch_rwsem);
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci/*
8962306a36Sopenharmony_ci * Details of the xenwatch callback kernel thread. The thread waits on the
9062306a36Sopenharmony_ci * watch_events_waitq for work to do (queued on watch_events list). When it
9162306a36Sopenharmony_ci * wakes up it acquires the xenwatch_mutex before reading the list and
9262306a36Sopenharmony_ci * carrying out work.
9362306a36Sopenharmony_ci */
9462306a36Sopenharmony_cistatic pid_t xenwatch_pid;
9562306a36Sopenharmony_cistatic DEFINE_MUTEX(xenwatch_mutex);
9662306a36Sopenharmony_cistatic DECLARE_WAIT_QUEUE_HEAD(watch_events_waitq);
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic void xs_suspend_enter(void)
9962306a36Sopenharmony_ci{
10062306a36Sopenharmony_ci	spin_lock(&xs_state_lock);
10162306a36Sopenharmony_ci	xs_suspend_active++;
10262306a36Sopenharmony_ci	spin_unlock(&xs_state_lock);
10362306a36Sopenharmony_ci	wait_event(xs_state_exit_wq, xs_state_users == 0);
10462306a36Sopenharmony_ci}
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_cistatic void xs_suspend_exit(void)
10762306a36Sopenharmony_ci{
10862306a36Sopenharmony_ci	xb_dev_generation_id++;
10962306a36Sopenharmony_ci	spin_lock(&xs_state_lock);
11062306a36Sopenharmony_ci	xs_suspend_active--;
11162306a36Sopenharmony_ci	spin_unlock(&xs_state_lock);
11262306a36Sopenharmony_ci	wake_up_all(&xs_state_enter_wq);
11362306a36Sopenharmony_ci}
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_cistatic uint32_t xs_request_enter(struct xb_req_data *req)
11662306a36Sopenharmony_ci{
11762306a36Sopenharmony_ci	uint32_t rq_id;
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	req->type = req->msg.type;
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	spin_lock(&xs_state_lock);
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_ci	while (!xs_state_users && xs_suspend_active) {
12462306a36Sopenharmony_ci		spin_unlock(&xs_state_lock);
12562306a36Sopenharmony_ci		wait_event(xs_state_enter_wq, xs_suspend_active == 0);
12662306a36Sopenharmony_ci		spin_lock(&xs_state_lock);
12762306a36Sopenharmony_ci	}
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci	if (req->type == XS_TRANSACTION_START && !req->user_req)
13062306a36Sopenharmony_ci		xs_state_users++;
13162306a36Sopenharmony_ci	xs_state_users++;
13262306a36Sopenharmony_ci	rq_id = xs_request_id++;
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_ci	spin_unlock(&xs_state_lock);
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	return rq_id;
13762306a36Sopenharmony_ci}
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_civoid xs_request_exit(struct xb_req_data *req)
14062306a36Sopenharmony_ci{
14162306a36Sopenharmony_ci	spin_lock(&xs_state_lock);
14262306a36Sopenharmony_ci	xs_state_users--;
14362306a36Sopenharmony_ci	if ((req->type == XS_TRANSACTION_START && req->msg.type == XS_ERROR) ||
14462306a36Sopenharmony_ci	    (req->type == XS_TRANSACTION_END && !req->user_req &&
14562306a36Sopenharmony_ci	     !WARN_ON_ONCE(req->msg.type == XS_ERROR &&
14662306a36Sopenharmony_ci			   !strcmp(req->body, "ENOENT"))))
14762306a36Sopenharmony_ci		xs_state_users--;
14862306a36Sopenharmony_ci	spin_unlock(&xs_state_lock);
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	if (xs_suspend_active && !xs_state_users)
15162306a36Sopenharmony_ci		wake_up(&xs_state_exit_wq);
15262306a36Sopenharmony_ci}
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_cistatic int get_error(const char *errorstring)
15562306a36Sopenharmony_ci{
15662306a36Sopenharmony_ci	unsigned int i;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	for (i = 0; strcmp(errorstring, xsd_errors[i].errstring) != 0; i++) {
15962306a36Sopenharmony_ci		if (i == ARRAY_SIZE(xsd_errors) - 1) {
16062306a36Sopenharmony_ci			pr_warn("xen store gave: unknown error %s\n",
16162306a36Sopenharmony_ci				errorstring);
16262306a36Sopenharmony_ci			return EINVAL;
16362306a36Sopenharmony_ci		}
16462306a36Sopenharmony_ci	}
16562306a36Sopenharmony_ci	return xsd_errors[i].errnum;
16662306a36Sopenharmony_ci}
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_cistatic bool xenbus_ok(void)
16962306a36Sopenharmony_ci{
17062306a36Sopenharmony_ci	switch (xen_store_domain_type) {
17162306a36Sopenharmony_ci	case XS_LOCAL:
17262306a36Sopenharmony_ci		switch (system_state) {
17362306a36Sopenharmony_ci		case SYSTEM_POWER_OFF:
17462306a36Sopenharmony_ci		case SYSTEM_RESTART:
17562306a36Sopenharmony_ci		case SYSTEM_HALT:
17662306a36Sopenharmony_ci			return false;
17762306a36Sopenharmony_ci		default:
17862306a36Sopenharmony_ci			break;
17962306a36Sopenharmony_ci		}
18062306a36Sopenharmony_ci		return true;
18162306a36Sopenharmony_ci	case XS_PV:
18262306a36Sopenharmony_ci	case XS_HVM:
18362306a36Sopenharmony_ci		/* FIXME: Could check that the remote domain is alive,
18462306a36Sopenharmony_ci		 * but it is normally initial domain. */
18562306a36Sopenharmony_ci		return true;
18662306a36Sopenharmony_ci	default:
18762306a36Sopenharmony_ci		break;
18862306a36Sopenharmony_ci	}
18962306a36Sopenharmony_ci	return false;
19062306a36Sopenharmony_ci}
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_cistatic bool test_reply(struct xb_req_data *req)
19362306a36Sopenharmony_ci{
19462306a36Sopenharmony_ci	if (req->state == xb_req_state_got_reply || !xenbus_ok()) {
19562306a36Sopenharmony_ci		/* read req->state before all other fields */
19662306a36Sopenharmony_ci		virt_rmb();
19762306a36Sopenharmony_ci		return true;
19862306a36Sopenharmony_ci	}
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci	/* Make sure to reread req->state each time. */
20162306a36Sopenharmony_ci	barrier();
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	return false;
20462306a36Sopenharmony_ci}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic void *read_reply(struct xb_req_data *req)
20762306a36Sopenharmony_ci{
20862306a36Sopenharmony_ci	do {
20962306a36Sopenharmony_ci		wait_event(req->wq, test_reply(req));
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci		if (!xenbus_ok())
21262306a36Sopenharmony_ci			/*
21362306a36Sopenharmony_ci			 * If we are in the process of being shut-down there is
21462306a36Sopenharmony_ci			 * no point of trying to contact XenBus - it is either
21562306a36Sopenharmony_ci			 * killed (xenstored application) or the other domain
21662306a36Sopenharmony_ci			 * has been killed or is unreachable.
21762306a36Sopenharmony_ci			 */
21862306a36Sopenharmony_ci			return ERR_PTR(-EIO);
21962306a36Sopenharmony_ci		if (req->err)
22062306a36Sopenharmony_ci			return ERR_PTR(req->err);
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	} while (req->state != xb_req_state_got_reply);
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci	return req->body;
22562306a36Sopenharmony_ci}
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_cistatic void xs_send(struct xb_req_data *req, struct xsd_sockmsg *msg)
22862306a36Sopenharmony_ci{
22962306a36Sopenharmony_ci	bool notify;
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	req->msg = *msg;
23262306a36Sopenharmony_ci	req->err = 0;
23362306a36Sopenharmony_ci	req->state = xb_req_state_queued;
23462306a36Sopenharmony_ci	init_waitqueue_head(&req->wq);
23562306a36Sopenharmony_ci
23662306a36Sopenharmony_ci	/* Save the caller req_id and restore it later in the reply */
23762306a36Sopenharmony_ci	req->caller_req_id = req->msg.req_id;
23862306a36Sopenharmony_ci	req->msg.req_id = xs_request_enter(req);
23962306a36Sopenharmony_ci
24062306a36Sopenharmony_ci	mutex_lock(&xb_write_mutex);
24162306a36Sopenharmony_ci	list_add_tail(&req->list, &xb_write_list);
24262306a36Sopenharmony_ci	notify = list_is_singular(&xb_write_list);
24362306a36Sopenharmony_ci	mutex_unlock(&xb_write_mutex);
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci	if (notify)
24662306a36Sopenharmony_ci		wake_up(&xb_waitq);
24762306a36Sopenharmony_ci}
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_cistatic void *xs_wait_for_reply(struct xb_req_data *req, struct xsd_sockmsg *msg)
25062306a36Sopenharmony_ci{
25162306a36Sopenharmony_ci	void *ret;
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	ret = read_reply(req);
25462306a36Sopenharmony_ci
25562306a36Sopenharmony_ci	xs_request_exit(req);
25662306a36Sopenharmony_ci
25762306a36Sopenharmony_ci	msg->type = req->msg.type;
25862306a36Sopenharmony_ci	msg->len = req->msg.len;
25962306a36Sopenharmony_ci
26062306a36Sopenharmony_ci	mutex_lock(&xb_write_mutex);
26162306a36Sopenharmony_ci	if (req->state == xb_req_state_queued ||
26262306a36Sopenharmony_ci	    req->state == xb_req_state_wait_reply)
26362306a36Sopenharmony_ci		req->state = xb_req_state_aborted;
26462306a36Sopenharmony_ci	else
26562306a36Sopenharmony_ci		kfree(req);
26662306a36Sopenharmony_ci	mutex_unlock(&xb_write_mutex);
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci	return ret;
26962306a36Sopenharmony_ci}
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_cistatic void xs_wake_up(struct xb_req_data *req)
27262306a36Sopenharmony_ci{
27362306a36Sopenharmony_ci	wake_up(&req->wq);
27462306a36Sopenharmony_ci}
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_ciint xenbus_dev_request_and_reply(struct xsd_sockmsg *msg, void *par)
27762306a36Sopenharmony_ci{
27862306a36Sopenharmony_ci	struct xb_req_data *req;
27962306a36Sopenharmony_ci	struct kvec *vec;
28062306a36Sopenharmony_ci
28162306a36Sopenharmony_ci	req = kmalloc(sizeof(*req) + sizeof(*vec), GFP_KERNEL);
28262306a36Sopenharmony_ci	if (!req)
28362306a36Sopenharmony_ci		return -ENOMEM;
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_ci	vec = (struct kvec *)(req + 1);
28662306a36Sopenharmony_ci	vec->iov_len = msg->len;
28762306a36Sopenharmony_ci	vec->iov_base = msg + 1;
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	req->vec = vec;
29062306a36Sopenharmony_ci	req->num_vecs = 1;
29162306a36Sopenharmony_ci	req->cb = xenbus_dev_queue_reply;
29262306a36Sopenharmony_ci	req->par = par;
29362306a36Sopenharmony_ci	req->user_req = true;
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci	xs_send(req, msg);
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_ci	return 0;
29862306a36Sopenharmony_ci}
29962306a36Sopenharmony_ciEXPORT_SYMBOL(xenbus_dev_request_and_reply);
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ci/* Send message to xs, get kmalloc'ed reply.  ERR_PTR() on error. */
30262306a36Sopenharmony_cistatic void *xs_talkv(struct xenbus_transaction t,
30362306a36Sopenharmony_ci		      enum xsd_sockmsg_type type,
30462306a36Sopenharmony_ci		      const struct kvec *iovec,
30562306a36Sopenharmony_ci		      unsigned int num_vecs,
30662306a36Sopenharmony_ci		      unsigned int *len)
30762306a36Sopenharmony_ci{
30862306a36Sopenharmony_ci	struct xb_req_data *req;
30962306a36Sopenharmony_ci	struct xsd_sockmsg msg;
31062306a36Sopenharmony_ci	void *ret = NULL;
31162306a36Sopenharmony_ci	unsigned int i;
31262306a36Sopenharmony_ci	int err;
31362306a36Sopenharmony_ci
31462306a36Sopenharmony_ci	req = kmalloc(sizeof(*req), GFP_NOIO | __GFP_HIGH);
31562306a36Sopenharmony_ci	if (!req)
31662306a36Sopenharmony_ci		return ERR_PTR(-ENOMEM);
31762306a36Sopenharmony_ci
31862306a36Sopenharmony_ci	req->vec = iovec;
31962306a36Sopenharmony_ci	req->num_vecs = num_vecs;
32062306a36Sopenharmony_ci	req->cb = xs_wake_up;
32162306a36Sopenharmony_ci	req->user_req = false;
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci	msg.req_id = 0;
32462306a36Sopenharmony_ci	msg.tx_id = t.id;
32562306a36Sopenharmony_ci	msg.type = type;
32662306a36Sopenharmony_ci	msg.len = 0;
32762306a36Sopenharmony_ci	for (i = 0; i < num_vecs; i++)
32862306a36Sopenharmony_ci		msg.len += iovec[i].iov_len;
32962306a36Sopenharmony_ci
33062306a36Sopenharmony_ci	xs_send(req, &msg);
33162306a36Sopenharmony_ci
33262306a36Sopenharmony_ci	ret = xs_wait_for_reply(req, &msg);
33362306a36Sopenharmony_ci	if (len)
33462306a36Sopenharmony_ci		*len = msg.len;
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_ci	if (IS_ERR(ret))
33762306a36Sopenharmony_ci		return ret;
33862306a36Sopenharmony_ci
33962306a36Sopenharmony_ci	if (msg.type == XS_ERROR) {
34062306a36Sopenharmony_ci		err = get_error(ret);
34162306a36Sopenharmony_ci		kfree(ret);
34262306a36Sopenharmony_ci		return ERR_PTR(-err);
34362306a36Sopenharmony_ci	}
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci	if (msg.type != type) {
34662306a36Sopenharmony_ci		pr_warn_ratelimited("unexpected type [%d], expected [%d]\n",
34762306a36Sopenharmony_ci				    msg.type, type);
34862306a36Sopenharmony_ci		kfree(ret);
34962306a36Sopenharmony_ci		return ERR_PTR(-EINVAL);
35062306a36Sopenharmony_ci	}
35162306a36Sopenharmony_ci	return ret;
35262306a36Sopenharmony_ci}
35362306a36Sopenharmony_ci
35462306a36Sopenharmony_ci/* Simplified version of xs_talkv: single message. */
35562306a36Sopenharmony_cistatic void *xs_single(struct xenbus_transaction t,
35662306a36Sopenharmony_ci		       enum xsd_sockmsg_type type,
35762306a36Sopenharmony_ci		       const char *string,
35862306a36Sopenharmony_ci		       unsigned int *len)
35962306a36Sopenharmony_ci{
36062306a36Sopenharmony_ci	struct kvec iovec;
36162306a36Sopenharmony_ci
36262306a36Sopenharmony_ci	iovec.iov_base = (void *)string;
36362306a36Sopenharmony_ci	iovec.iov_len = strlen(string) + 1;
36462306a36Sopenharmony_ci	return xs_talkv(t, type, &iovec, 1, len);
36562306a36Sopenharmony_ci}
36662306a36Sopenharmony_ci
36762306a36Sopenharmony_ci/* Many commands only need an ack, don't care what it says. */
36862306a36Sopenharmony_cistatic int xs_error(char *reply)
36962306a36Sopenharmony_ci{
37062306a36Sopenharmony_ci	if (IS_ERR(reply))
37162306a36Sopenharmony_ci		return PTR_ERR(reply);
37262306a36Sopenharmony_ci	kfree(reply);
37362306a36Sopenharmony_ci	return 0;
37462306a36Sopenharmony_ci}
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_cistatic unsigned int count_strings(const char *strings, unsigned int len)
37762306a36Sopenharmony_ci{
37862306a36Sopenharmony_ci	unsigned int num;
37962306a36Sopenharmony_ci	const char *p;
38062306a36Sopenharmony_ci
38162306a36Sopenharmony_ci	for (p = strings, num = 0; p < strings + len; p += strlen(p) + 1)
38262306a36Sopenharmony_ci		num++;
38362306a36Sopenharmony_ci
38462306a36Sopenharmony_ci	return num;
38562306a36Sopenharmony_ci}
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci/* Return the path to dir with /name appended. Buffer must be kfree()'ed. */
38862306a36Sopenharmony_cistatic char *join(const char *dir, const char *name)
38962306a36Sopenharmony_ci{
39062306a36Sopenharmony_ci	char *buffer;
39162306a36Sopenharmony_ci
39262306a36Sopenharmony_ci	if (strlen(name) == 0)
39362306a36Sopenharmony_ci		buffer = kasprintf(GFP_NOIO | __GFP_HIGH, "%s", dir);
39462306a36Sopenharmony_ci	else
39562306a36Sopenharmony_ci		buffer = kasprintf(GFP_NOIO | __GFP_HIGH, "%s/%s", dir, name);
39662306a36Sopenharmony_ci	return (!buffer) ? ERR_PTR(-ENOMEM) : buffer;
39762306a36Sopenharmony_ci}
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_cistatic char **split(char *strings, unsigned int len, unsigned int *num)
40062306a36Sopenharmony_ci{
40162306a36Sopenharmony_ci	char *p, **ret;
40262306a36Sopenharmony_ci
40362306a36Sopenharmony_ci	/* Count the strings. */
40462306a36Sopenharmony_ci	*num = count_strings(strings, len);
40562306a36Sopenharmony_ci
40662306a36Sopenharmony_ci	/* Transfer to one big alloc for easy freeing. */
40762306a36Sopenharmony_ci	ret = kmalloc(*num * sizeof(char *) + len, GFP_NOIO | __GFP_HIGH);
40862306a36Sopenharmony_ci	if (!ret) {
40962306a36Sopenharmony_ci		kfree(strings);
41062306a36Sopenharmony_ci		return ERR_PTR(-ENOMEM);
41162306a36Sopenharmony_ci	}
41262306a36Sopenharmony_ci	memcpy(&ret[*num], strings, len);
41362306a36Sopenharmony_ci	kfree(strings);
41462306a36Sopenharmony_ci
41562306a36Sopenharmony_ci	strings = (char *)&ret[*num];
41662306a36Sopenharmony_ci	for (p = strings, *num = 0; p < strings + len; p += strlen(p) + 1)
41762306a36Sopenharmony_ci		ret[(*num)++] = p;
41862306a36Sopenharmony_ci
41962306a36Sopenharmony_ci	return ret;
42062306a36Sopenharmony_ci}
42162306a36Sopenharmony_ci
42262306a36Sopenharmony_cichar **xenbus_directory(struct xenbus_transaction t,
42362306a36Sopenharmony_ci			const char *dir, const char *node, unsigned int *num)
42462306a36Sopenharmony_ci{
42562306a36Sopenharmony_ci	char *strings, *path;
42662306a36Sopenharmony_ci	unsigned int len;
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_ci	path = join(dir, node);
42962306a36Sopenharmony_ci	if (IS_ERR(path))
43062306a36Sopenharmony_ci		return (char **)path;
43162306a36Sopenharmony_ci
43262306a36Sopenharmony_ci	strings = xs_single(t, XS_DIRECTORY, path, &len);
43362306a36Sopenharmony_ci	kfree(path);
43462306a36Sopenharmony_ci	if (IS_ERR(strings))
43562306a36Sopenharmony_ci		return (char **)strings;
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ci	return split(strings, len, num);
43862306a36Sopenharmony_ci}
43962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_directory);
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_ci/* Check if a path exists. Return 1 if it does. */
44262306a36Sopenharmony_ciint xenbus_exists(struct xenbus_transaction t,
44362306a36Sopenharmony_ci		  const char *dir, const char *node)
44462306a36Sopenharmony_ci{
44562306a36Sopenharmony_ci	char **d;
44662306a36Sopenharmony_ci	int dir_n;
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_ci	d = xenbus_directory(t, dir, node, &dir_n);
44962306a36Sopenharmony_ci	if (IS_ERR(d))
45062306a36Sopenharmony_ci		return 0;
45162306a36Sopenharmony_ci	kfree(d);
45262306a36Sopenharmony_ci	return 1;
45362306a36Sopenharmony_ci}
45462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_exists);
45562306a36Sopenharmony_ci
45662306a36Sopenharmony_ci/* Get the value of a single file.
45762306a36Sopenharmony_ci * Returns a kmalloced value: call free() on it after use.
45862306a36Sopenharmony_ci * len indicates length in bytes.
45962306a36Sopenharmony_ci */
46062306a36Sopenharmony_civoid *xenbus_read(struct xenbus_transaction t,
46162306a36Sopenharmony_ci		  const char *dir, const char *node, unsigned int *len)
46262306a36Sopenharmony_ci{
46362306a36Sopenharmony_ci	char *path;
46462306a36Sopenharmony_ci	void *ret;
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci	path = join(dir, node);
46762306a36Sopenharmony_ci	if (IS_ERR(path))
46862306a36Sopenharmony_ci		return (void *)path;
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci	ret = xs_single(t, XS_READ, path, len);
47162306a36Sopenharmony_ci	kfree(path);
47262306a36Sopenharmony_ci	return ret;
47362306a36Sopenharmony_ci}
47462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_read);
47562306a36Sopenharmony_ci
47662306a36Sopenharmony_ci/* Write the value of a single file.
47762306a36Sopenharmony_ci * Returns -err on failure.
47862306a36Sopenharmony_ci */
47962306a36Sopenharmony_ciint xenbus_write(struct xenbus_transaction t,
48062306a36Sopenharmony_ci		 const char *dir, const char *node, const char *string)
48162306a36Sopenharmony_ci{
48262306a36Sopenharmony_ci	const char *path;
48362306a36Sopenharmony_ci	struct kvec iovec[2];
48462306a36Sopenharmony_ci	int ret;
48562306a36Sopenharmony_ci
48662306a36Sopenharmony_ci	path = join(dir, node);
48762306a36Sopenharmony_ci	if (IS_ERR(path))
48862306a36Sopenharmony_ci		return PTR_ERR(path);
48962306a36Sopenharmony_ci
49062306a36Sopenharmony_ci	iovec[0].iov_base = (void *)path;
49162306a36Sopenharmony_ci	iovec[0].iov_len = strlen(path) + 1;
49262306a36Sopenharmony_ci	iovec[1].iov_base = (void *)string;
49362306a36Sopenharmony_ci	iovec[1].iov_len = strlen(string);
49462306a36Sopenharmony_ci
49562306a36Sopenharmony_ci	ret = xs_error(xs_talkv(t, XS_WRITE, iovec, ARRAY_SIZE(iovec), NULL));
49662306a36Sopenharmony_ci	kfree(path);
49762306a36Sopenharmony_ci	return ret;
49862306a36Sopenharmony_ci}
49962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_write);
50062306a36Sopenharmony_ci
50162306a36Sopenharmony_ci/* Create a new directory. */
50262306a36Sopenharmony_ciint xenbus_mkdir(struct xenbus_transaction t,
50362306a36Sopenharmony_ci		 const char *dir, const char *node)
50462306a36Sopenharmony_ci{
50562306a36Sopenharmony_ci	char *path;
50662306a36Sopenharmony_ci	int ret;
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_ci	path = join(dir, node);
50962306a36Sopenharmony_ci	if (IS_ERR(path))
51062306a36Sopenharmony_ci		return PTR_ERR(path);
51162306a36Sopenharmony_ci
51262306a36Sopenharmony_ci	ret = xs_error(xs_single(t, XS_MKDIR, path, NULL));
51362306a36Sopenharmony_ci	kfree(path);
51462306a36Sopenharmony_ci	return ret;
51562306a36Sopenharmony_ci}
51662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_mkdir);
51762306a36Sopenharmony_ci
51862306a36Sopenharmony_ci/* Destroy a file or directory (directories must be empty). */
51962306a36Sopenharmony_ciint xenbus_rm(struct xenbus_transaction t, const char *dir, const char *node)
52062306a36Sopenharmony_ci{
52162306a36Sopenharmony_ci	char *path;
52262306a36Sopenharmony_ci	int ret;
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_ci	path = join(dir, node);
52562306a36Sopenharmony_ci	if (IS_ERR(path))
52662306a36Sopenharmony_ci		return PTR_ERR(path);
52762306a36Sopenharmony_ci
52862306a36Sopenharmony_ci	ret = xs_error(xs_single(t, XS_RM, path, NULL));
52962306a36Sopenharmony_ci	kfree(path);
53062306a36Sopenharmony_ci	return ret;
53162306a36Sopenharmony_ci}
53262306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_rm);
53362306a36Sopenharmony_ci
53462306a36Sopenharmony_ci/* Start a transaction: changes by others will not be seen during this
53562306a36Sopenharmony_ci * transaction, and changes will not be visible to others until end.
53662306a36Sopenharmony_ci */
53762306a36Sopenharmony_ciint xenbus_transaction_start(struct xenbus_transaction *t)
53862306a36Sopenharmony_ci{
53962306a36Sopenharmony_ci	char *id_str;
54062306a36Sopenharmony_ci
54162306a36Sopenharmony_ci	id_str = xs_single(XBT_NIL, XS_TRANSACTION_START, "", NULL);
54262306a36Sopenharmony_ci	if (IS_ERR(id_str))
54362306a36Sopenharmony_ci		return PTR_ERR(id_str);
54462306a36Sopenharmony_ci
54562306a36Sopenharmony_ci	t->id = simple_strtoul(id_str, NULL, 0);
54662306a36Sopenharmony_ci	kfree(id_str);
54762306a36Sopenharmony_ci	return 0;
54862306a36Sopenharmony_ci}
54962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_transaction_start);
55062306a36Sopenharmony_ci
55162306a36Sopenharmony_ci/* End a transaction.
55262306a36Sopenharmony_ci * If abandon is true, transaction is discarded instead of committed.
55362306a36Sopenharmony_ci */
55462306a36Sopenharmony_ciint xenbus_transaction_end(struct xenbus_transaction t, int abort)
55562306a36Sopenharmony_ci{
55662306a36Sopenharmony_ci	char abortstr[2];
55762306a36Sopenharmony_ci
55862306a36Sopenharmony_ci	if (abort)
55962306a36Sopenharmony_ci		strcpy(abortstr, "F");
56062306a36Sopenharmony_ci	else
56162306a36Sopenharmony_ci		strcpy(abortstr, "T");
56262306a36Sopenharmony_ci
56362306a36Sopenharmony_ci	return xs_error(xs_single(t, XS_TRANSACTION_END, abortstr, NULL));
56462306a36Sopenharmony_ci}
56562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_transaction_end);
56662306a36Sopenharmony_ci
56762306a36Sopenharmony_ci/* Single read and scanf: returns -errno or num scanned. */
56862306a36Sopenharmony_ciint xenbus_scanf(struct xenbus_transaction t,
56962306a36Sopenharmony_ci		 const char *dir, const char *node, const char *fmt, ...)
57062306a36Sopenharmony_ci{
57162306a36Sopenharmony_ci	va_list ap;
57262306a36Sopenharmony_ci	int ret;
57362306a36Sopenharmony_ci	char *val;
57462306a36Sopenharmony_ci
57562306a36Sopenharmony_ci	val = xenbus_read(t, dir, node, NULL);
57662306a36Sopenharmony_ci	if (IS_ERR(val))
57762306a36Sopenharmony_ci		return PTR_ERR(val);
57862306a36Sopenharmony_ci
57962306a36Sopenharmony_ci	va_start(ap, fmt);
58062306a36Sopenharmony_ci	ret = vsscanf(val, fmt, ap);
58162306a36Sopenharmony_ci	va_end(ap);
58262306a36Sopenharmony_ci	kfree(val);
58362306a36Sopenharmony_ci	/* Distinctive errno. */
58462306a36Sopenharmony_ci	if (ret == 0)
58562306a36Sopenharmony_ci		return -ERANGE;
58662306a36Sopenharmony_ci	return ret;
58762306a36Sopenharmony_ci}
58862306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_scanf);
58962306a36Sopenharmony_ci
59062306a36Sopenharmony_ci/* Read an (optional) unsigned value. */
59162306a36Sopenharmony_ciunsigned int xenbus_read_unsigned(const char *dir, const char *node,
59262306a36Sopenharmony_ci				  unsigned int default_val)
59362306a36Sopenharmony_ci{
59462306a36Sopenharmony_ci	unsigned int val;
59562306a36Sopenharmony_ci	int ret;
59662306a36Sopenharmony_ci
59762306a36Sopenharmony_ci	ret = xenbus_scanf(XBT_NIL, dir, node, "%u", &val);
59862306a36Sopenharmony_ci	if (ret <= 0)
59962306a36Sopenharmony_ci		val = default_val;
60062306a36Sopenharmony_ci
60162306a36Sopenharmony_ci	return val;
60262306a36Sopenharmony_ci}
60362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_read_unsigned);
60462306a36Sopenharmony_ci
60562306a36Sopenharmony_ci/* Single printf and write: returns -errno or 0. */
60662306a36Sopenharmony_ciint xenbus_printf(struct xenbus_transaction t,
60762306a36Sopenharmony_ci		  const char *dir, const char *node, const char *fmt, ...)
60862306a36Sopenharmony_ci{
60962306a36Sopenharmony_ci	va_list ap;
61062306a36Sopenharmony_ci	int ret;
61162306a36Sopenharmony_ci	char *buf;
61262306a36Sopenharmony_ci
61362306a36Sopenharmony_ci	va_start(ap, fmt);
61462306a36Sopenharmony_ci	buf = kvasprintf(GFP_NOIO | __GFP_HIGH, fmt, ap);
61562306a36Sopenharmony_ci	va_end(ap);
61662306a36Sopenharmony_ci
61762306a36Sopenharmony_ci	if (!buf)
61862306a36Sopenharmony_ci		return -ENOMEM;
61962306a36Sopenharmony_ci
62062306a36Sopenharmony_ci	ret = xenbus_write(t, dir, node, buf);
62162306a36Sopenharmony_ci
62262306a36Sopenharmony_ci	kfree(buf);
62362306a36Sopenharmony_ci
62462306a36Sopenharmony_ci	return ret;
62562306a36Sopenharmony_ci}
62662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_printf);
62762306a36Sopenharmony_ci
62862306a36Sopenharmony_ci/* Takes tuples of names, scanf-style args, and void **, NULL terminated. */
62962306a36Sopenharmony_ciint xenbus_gather(struct xenbus_transaction t, const char *dir, ...)
63062306a36Sopenharmony_ci{
63162306a36Sopenharmony_ci	va_list ap;
63262306a36Sopenharmony_ci	const char *name;
63362306a36Sopenharmony_ci	int ret = 0;
63462306a36Sopenharmony_ci
63562306a36Sopenharmony_ci	va_start(ap, dir);
63662306a36Sopenharmony_ci	while (ret == 0 && (name = va_arg(ap, char *)) != NULL) {
63762306a36Sopenharmony_ci		const char *fmt = va_arg(ap, char *);
63862306a36Sopenharmony_ci		void *result = va_arg(ap, void *);
63962306a36Sopenharmony_ci		char *p;
64062306a36Sopenharmony_ci
64162306a36Sopenharmony_ci		p = xenbus_read(t, dir, name, NULL);
64262306a36Sopenharmony_ci		if (IS_ERR(p)) {
64362306a36Sopenharmony_ci			ret = PTR_ERR(p);
64462306a36Sopenharmony_ci			break;
64562306a36Sopenharmony_ci		}
64662306a36Sopenharmony_ci		if (fmt) {
64762306a36Sopenharmony_ci			if (sscanf(p, fmt, result) == 0)
64862306a36Sopenharmony_ci				ret = -EINVAL;
64962306a36Sopenharmony_ci			kfree(p);
65062306a36Sopenharmony_ci		} else
65162306a36Sopenharmony_ci			*(char **)result = p;
65262306a36Sopenharmony_ci	}
65362306a36Sopenharmony_ci	va_end(ap);
65462306a36Sopenharmony_ci	return ret;
65562306a36Sopenharmony_ci}
65662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(xenbus_gather);
65762306a36Sopenharmony_ci
65862306a36Sopenharmony_cistatic int xs_watch(const char *path, const char *token)
65962306a36Sopenharmony_ci{
66062306a36Sopenharmony_ci	struct kvec iov[2];
66162306a36Sopenharmony_ci
66262306a36Sopenharmony_ci	iov[0].iov_base = (void *)path;
66362306a36Sopenharmony_ci	iov[0].iov_len = strlen(path) + 1;
66462306a36Sopenharmony_ci	iov[1].iov_base = (void *)token;
66562306a36Sopenharmony_ci	iov[1].iov_len = strlen(token) + 1;
66662306a36Sopenharmony_ci
66762306a36Sopenharmony_ci	return xs_error(xs_talkv(XBT_NIL, XS_WATCH, iov,
66862306a36Sopenharmony_ci				 ARRAY_SIZE(iov), NULL));
66962306a36Sopenharmony_ci}
67062306a36Sopenharmony_ci
67162306a36Sopenharmony_cistatic int xs_unwatch(const char *path, const char *token)
67262306a36Sopenharmony_ci{
67362306a36Sopenharmony_ci	struct kvec iov[2];
67462306a36Sopenharmony_ci
67562306a36Sopenharmony_ci	iov[0].iov_base = (char *)path;
67662306a36Sopenharmony_ci	iov[0].iov_len = strlen(path) + 1;
67762306a36Sopenharmony_ci	iov[1].iov_base = (char *)token;
67862306a36Sopenharmony_ci	iov[1].iov_len = strlen(token) + 1;
67962306a36Sopenharmony_ci
68062306a36Sopenharmony_ci	return xs_error(xs_talkv(XBT_NIL, XS_UNWATCH, iov,
68162306a36Sopenharmony_ci				 ARRAY_SIZE(iov), NULL));
68262306a36Sopenharmony_ci}
68362306a36Sopenharmony_ci
68462306a36Sopenharmony_cistatic struct xenbus_watch *find_watch(const char *token)
68562306a36Sopenharmony_ci{
68662306a36Sopenharmony_ci	struct xenbus_watch *i, *cmp;
68762306a36Sopenharmony_ci
68862306a36Sopenharmony_ci	cmp = (void *)simple_strtoul(token, NULL, 16);
68962306a36Sopenharmony_ci
69062306a36Sopenharmony_ci	list_for_each_entry(i, &watches, list)
69162306a36Sopenharmony_ci		if (i == cmp)
69262306a36Sopenharmony_ci			return i;
69362306a36Sopenharmony_ci
69462306a36Sopenharmony_ci	return NULL;
69562306a36Sopenharmony_ci}
69662306a36Sopenharmony_ci
69762306a36Sopenharmony_ciint xs_watch_msg(struct xs_watch_event *event)
69862306a36Sopenharmony_ci{
69962306a36Sopenharmony_ci	if (count_strings(event->body, event->len) != 2) {
70062306a36Sopenharmony_ci		kfree(event);
70162306a36Sopenharmony_ci		return -EINVAL;
70262306a36Sopenharmony_ci	}
70362306a36Sopenharmony_ci	event->path = (const char *)event->body;
70462306a36Sopenharmony_ci	event->token = (const char *)strchr(event->body, '\0') + 1;
70562306a36Sopenharmony_ci
70662306a36Sopenharmony_ci	spin_lock(&watches_lock);
70762306a36Sopenharmony_ci	event->handle = find_watch(event->token);
70862306a36Sopenharmony_ci	if (event->handle != NULL &&
70962306a36Sopenharmony_ci			(!event->handle->will_handle ||
71062306a36Sopenharmony_ci			 event->handle->will_handle(event->handle,
71162306a36Sopenharmony_ci				 event->path, event->token))) {
71262306a36Sopenharmony_ci		spin_lock(&watch_events_lock);
71362306a36Sopenharmony_ci		list_add_tail(&event->list, &watch_events);
71462306a36Sopenharmony_ci		event->handle->nr_pending++;
71562306a36Sopenharmony_ci		wake_up(&watch_events_waitq);
71662306a36Sopenharmony_ci		spin_unlock(&watch_events_lock);
71762306a36Sopenharmony_ci	} else
71862306a36Sopenharmony_ci		kfree(event);
71962306a36Sopenharmony_ci	spin_unlock(&watches_lock);
72062306a36Sopenharmony_ci
72162306a36Sopenharmony_ci	return 0;
72262306a36Sopenharmony_ci}
72362306a36Sopenharmony_ci
72462306a36Sopenharmony_ci/*
72562306a36Sopenharmony_ci * Certain older XenBus toolstack cannot handle reading values that are
72662306a36Sopenharmony_ci * not populated. Some Xen 3.4 installation are incapable of doing this
72762306a36Sopenharmony_ci * so if we are running on anything older than 4 do not attempt to read
72862306a36Sopenharmony_ci * control/platform-feature-xs_reset_watches.
72962306a36Sopenharmony_ci */
73062306a36Sopenharmony_cistatic bool xen_strict_xenbus_quirk(void)
73162306a36Sopenharmony_ci{
73262306a36Sopenharmony_ci#ifdef CONFIG_X86
73362306a36Sopenharmony_ci	uint32_t eax, ebx, ecx, edx, base;
73462306a36Sopenharmony_ci
73562306a36Sopenharmony_ci	base = xen_cpuid_base();
73662306a36Sopenharmony_ci	cpuid(base + 1, &eax, &ebx, &ecx, &edx);
73762306a36Sopenharmony_ci
73862306a36Sopenharmony_ci	if ((eax >> 16) < 4)
73962306a36Sopenharmony_ci		return true;
74062306a36Sopenharmony_ci#endif
74162306a36Sopenharmony_ci	return false;
74262306a36Sopenharmony_ci
74362306a36Sopenharmony_ci}
74462306a36Sopenharmony_cistatic void xs_reset_watches(void)
74562306a36Sopenharmony_ci{
74662306a36Sopenharmony_ci	int err;
74762306a36Sopenharmony_ci
74862306a36Sopenharmony_ci	if (!xen_hvm_domain() || xen_initial_domain())
74962306a36Sopenharmony_ci		return;
75062306a36Sopenharmony_ci
75162306a36Sopenharmony_ci	if (xen_strict_xenbus_quirk())
75262306a36Sopenharmony_ci		return;
75362306a36Sopenharmony_ci
75462306a36Sopenharmony_ci	if (!xenbus_read_unsigned("control",
75562306a36Sopenharmony_ci				  "platform-feature-xs_reset_watches", 0))
75662306a36Sopenharmony_ci		return;
75762306a36Sopenharmony_ci
75862306a36Sopenharmony_ci	err = xs_error(xs_single(XBT_NIL, XS_RESET_WATCHES, "", NULL));
75962306a36Sopenharmony_ci	if (err && err != -EEXIST)
76062306a36Sopenharmony_ci		pr_warn("xs_reset_watches failed: %d\n", err);
76162306a36Sopenharmony_ci}
76262306a36Sopenharmony_ci
76362306a36Sopenharmony_ci/* Register callback to watch this node. */
76462306a36Sopenharmony_ciint register_xenbus_watch(struct xenbus_watch *watch)
76562306a36Sopenharmony_ci{
76662306a36Sopenharmony_ci	/* Pointer in ascii is the token. */
76762306a36Sopenharmony_ci	char token[sizeof(watch) * 2 + 1];
76862306a36Sopenharmony_ci	int err;
76962306a36Sopenharmony_ci
77062306a36Sopenharmony_ci	sprintf(token, "%lX", (long)watch);
77162306a36Sopenharmony_ci
77262306a36Sopenharmony_ci	watch->nr_pending = 0;
77362306a36Sopenharmony_ci
77462306a36Sopenharmony_ci	down_read(&xs_watch_rwsem);
77562306a36Sopenharmony_ci
77662306a36Sopenharmony_ci	spin_lock(&watches_lock);
77762306a36Sopenharmony_ci	BUG_ON(find_watch(token));
77862306a36Sopenharmony_ci	list_add(&watch->list, &watches);
77962306a36Sopenharmony_ci	spin_unlock(&watches_lock);
78062306a36Sopenharmony_ci
78162306a36Sopenharmony_ci	err = xs_watch(watch->node, token);
78262306a36Sopenharmony_ci
78362306a36Sopenharmony_ci	if (err) {
78462306a36Sopenharmony_ci		spin_lock(&watches_lock);
78562306a36Sopenharmony_ci		list_del(&watch->list);
78662306a36Sopenharmony_ci		spin_unlock(&watches_lock);
78762306a36Sopenharmony_ci	}
78862306a36Sopenharmony_ci
78962306a36Sopenharmony_ci	up_read(&xs_watch_rwsem);
79062306a36Sopenharmony_ci
79162306a36Sopenharmony_ci	return err;
79262306a36Sopenharmony_ci}
79362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(register_xenbus_watch);
79462306a36Sopenharmony_ci
79562306a36Sopenharmony_civoid unregister_xenbus_watch(struct xenbus_watch *watch)
79662306a36Sopenharmony_ci{
79762306a36Sopenharmony_ci	struct xs_watch_event *event, *tmp;
79862306a36Sopenharmony_ci	char token[sizeof(watch) * 2 + 1];
79962306a36Sopenharmony_ci	int err;
80062306a36Sopenharmony_ci
80162306a36Sopenharmony_ci	sprintf(token, "%lX", (long)watch);
80262306a36Sopenharmony_ci
80362306a36Sopenharmony_ci	down_read(&xs_watch_rwsem);
80462306a36Sopenharmony_ci
80562306a36Sopenharmony_ci	spin_lock(&watches_lock);
80662306a36Sopenharmony_ci	BUG_ON(!find_watch(token));
80762306a36Sopenharmony_ci	list_del(&watch->list);
80862306a36Sopenharmony_ci	spin_unlock(&watches_lock);
80962306a36Sopenharmony_ci
81062306a36Sopenharmony_ci	err = xs_unwatch(watch->node, token);
81162306a36Sopenharmony_ci	if (err)
81262306a36Sopenharmony_ci		pr_warn("Failed to release watch %s: %i\n", watch->node, err);
81362306a36Sopenharmony_ci
81462306a36Sopenharmony_ci	up_read(&xs_watch_rwsem);
81562306a36Sopenharmony_ci
81662306a36Sopenharmony_ci	/* Make sure there are no callbacks running currently (unless
81762306a36Sopenharmony_ci	   its us) */
81862306a36Sopenharmony_ci	if (current->pid != xenwatch_pid)
81962306a36Sopenharmony_ci		mutex_lock(&xenwatch_mutex);
82062306a36Sopenharmony_ci
82162306a36Sopenharmony_ci	/* Cancel pending watch events. */
82262306a36Sopenharmony_ci	spin_lock(&watch_events_lock);
82362306a36Sopenharmony_ci	if (watch->nr_pending) {
82462306a36Sopenharmony_ci		list_for_each_entry_safe(event, tmp, &watch_events, list) {
82562306a36Sopenharmony_ci			if (event->handle != watch)
82662306a36Sopenharmony_ci				continue;
82762306a36Sopenharmony_ci			list_del(&event->list);
82862306a36Sopenharmony_ci			kfree(event);
82962306a36Sopenharmony_ci		}
83062306a36Sopenharmony_ci		watch->nr_pending = 0;
83162306a36Sopenharmony_ci	}
83262306a36Sopenharmony_ci	spin_unlock(&watch_events_lock);
83362306a36Sopenharmony_ci
83462306a36Sopenharmony_ci	if (current->pid != xenwatch_pid)
83562306a36Sopenharmony_ci		mutex_unlock(&xenwatch_mutex);
83662306a36Sopenharmony_ci}
83762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(unregister_xenbus_watch);
83862306a36Sopenharmony_ci
83962306a36Sopenharmony_civoid xs_suspend(void)
84062306a36Sopenharmony_ci{
84162306a36Sopenharmony_ci	xs_suspend_enter();
84262306a36Sopenharmony_ci
84362306a36Sopenharmony_ci	mutex_lock(&xs_response_mutex);
84462306a36Sopenharmony_ci	down_write(&xs_watch_rwsem);
84562306a36Sopenharmony_ci}
84662306a36Sopenharmony_ci
84762306a36Sopenharmony_civoid xs_resume(void)
84862306a36Sopenharmony_ci{
84962306a36Sopenharmony_ci	struct xenbus_watch *watch;
85062306a36Sopenharmony_ci	char token[sizeof(watch) * 2 + 1];
85162306a36Sopenharmony_ci
85262306a36Sopenharmony_ci	xb_init_comms();
85362306a36Sopenharmony_ci
85462306a36Sopenharmony_ci	mutex_unlock(&xs_response_mutex);
85562306a36Sopenharmony_ci
85662306a36Sopenharmony_ci	xs_suspend_exit();
85762306a36Sopenharmony_ci
85862306a36Sopenharmony_ci	/* No need for watches_lock: the xs_watch_rwsem is sufficient. */
85962306a36Sopenharmony_ci	list_for_each_entry(watch, &watches, list) {
86062306a36Sopenharmony_ci		sprintf(token, "%lX", (long)watch);
86162306a36Sopenharmony_ci		xs_watch(watch->node, token);
86262306a36Sopenharmony_ci	}
86362306a36Sopenharmony_ci
86462306a36Sopenharmony_ci	up_write(&xs_watch_rwsem);
86562306a36Sopenharmony_ci}
86662306a36Sopenharmony_ci
86762306a36Sopenharmony_civoid xs_suspend_cancel(void)
86862306a36Sopenharmony_ci{
86962306a36Sopenharmony_ci	up_write(&xs_watch_rwsem);
87062306a36Sopenharmony_ci	mutex_unlock(&xs_response_mutex);
87162306a36Sopenharmony_ci
87262306a36Sopenharmony_ci	xs_suspend_exit();
87362306a36Sopenharmony_ci}
87462306a36Sopenharmony_ci
87562306a36Sopenharmony_cistatic int xenwatch_thread(void *unused)
87662306a36Sopenharmony_ci{
87762306a36Sopenharmony_ci	struct xs_watch_event *event;
87862306a36Sopenharmony_ci
87962306a36Sopenharmony_ci	xenwatch_pid = current->pid;
88062306a36Sopenharmony_ci
88162306a36Sopenharmony_ci	for (;;) {
88262306a36Sopenharmony_ci		wait_event_interruptible(watch_events_waitq,
88362306a36Sopenharmony_ci					 !list_empty(&watch_events));
88462306a36Sopenharmony_ci
88562306a36Sopenharmony_ci		if (kthread_should_stop())
88662306a36Sopenharmony_ci			break;
88762306a36Sopenharmony_ci
88862306a36Sopenharmony_ci		mutex_lock(&xenwatch_mutex);
88962306a36Sopenharmony_ci
89062306a36Sopenharmony_ci		spin_lock(&watch_events_lock);
89162306a36Sopenharmony_ci		event = list_first_entry_or_null(&watch_events,
89262306a36Sopenharmony_ci				struct xs_watch_event, list);
89362306a36Sopenharmony_ci		if (event) {
89462306a36Sopenharmony_ci			list_del(&event->list);
89562306a36Sopenharmony_ci			event->handle->nr_pending--;
89662306a36Sopenharmony_ci		}
89762306a36Sopenharmony_ci		spin_unlock(&watch_events_lock);
89862306a36Sopenharmony_ci
89962306a36Sopenharmony_ci		if (event) {
90062306a36Sopenharmony_ci			event->handle->callback(event->handle, event->path,
90162306a36Sopenharmony_ci						event->token);
90262306a36Sopenharmony_ci			kfree(event);
90362306a36Sopenharmony_ci		}
90462306a36Sopenharmony_ci
90562306a36Sopenharmony_ci		mutex_unlock(&xenwatch_mutex);
90662306a36Sopenharmony_ci	}
90762306a36Sopenharmony_ci
90862306a36Sopenharmony_ci	return 0;
90962306a36Sopenharmony_ci}
91062306a36Sopenharmony_ci
91162306a36Sopenharmony_ci/*
91262306a36Sopenharmony_ci * Wake up all threads waiting for a xenstore reply. In case of shutdown all
91362306a36Sopenharmony_ci * pending replies will be marked as "aborted" in order to let the waiters
91462306a36Sopenharmony_ci * return in spite of xenstore possibly no longer being able to reply. This
91562306a36Sopenharmony_ci * will avoid blocking shutdown by a thread waiting for xenstore but being
91662306a36Sopenharmony_ci * necessary for shutdown processing to proceed.
91762306a36Sopenharmony_ci */
91862306a36Sopenharmony_cistatic int xs_reboot_notify(struct notifier_block *nb,
91962306a36Sopenharmony_ci			    unsigned long code, void *unused)
92062306a36Sopenharmony_ci{
92162306a36Sopenharmony_ci	struct xb_req_data *req;
92262306a36Sopenharmony_ci
92362306a36Sopenharmony_ci	mutex_lock(&xb_write_mutex);
92462306a36Sopenharmony_ci	list_for_each_entry(req, &xs_reply_list, list)
92562306a36Sopenharmony_ci		wake_up(&req->wq);
92662306a36Sopenharmony_ci	list_for_each_entry(req, &xb_write_list, list)
92762306a36Sopenharmony_ci		wake_up(&req->wq);
92862306a36Sopenharmony_ci	mutex_unlock(&xb_write_mutex);
92962306a36Sopenharmony_ci	return NOTIFY_DONE;
93062306a36Sopenharmony_ci}
93162306a36Sopenharmony_ci
93262306a36Sopenharmony_cistatic struct notifier_block xs_reboot_nb = {
93362306a36Sopenharmony_ci	.notifier_call = xs_reboot_notify,
93462306a36Sopenharmony_ci};
93562306a36Sopenharmony_ci
93662306a36Sopenharmony_ciint xs_init(void)
93762306a36Sopenharmony_ci{
93862306a36Sopenharmony_ci	int err;
93962306a36Sopenharmony_ci	struct task_struct *task;
94062306a36Sopenharmony_ci
94162306a36Sopenharmony_ci	register_reboot_notifier(&xs_reboot_nb);
94262306a36Sopenharmony_ci
94362306a36Sopenharmony_ci	/* Initialize the shared memory rings to talk to xenstored */
94462306a36Sopenharmony_ci	err = xb_init_comms();
94562306a36Sopenharmony_ci	if (err)
94662306a36Sopenharmony_ci		return err;
94762306a36Sopenharmony_ci
94862306a36Sopenharmony_ci	task = kthread_run(xenwatch_thread, NULL, "xenwatch");
94962306a36Sopenharmony_ci	if (IS_ERR(task))
95062306a36Sopenharmony_ci		return PTR_ERR(task);
95162306a36Sopenharmony_ci
95262306a36Sopenharmony_ci	/* shutdown watches for kexec boot */
95362306a36Sopenharmony_ci	xs_reset_watches();
95462306a36Sopenharmony_ci
95562306a36Sopenharmony_ci	return 0;
95662306a36Sopenharmony_ci}
957