qubes-linux-kernel/patches.xen/Revert-xen-optimize-xenbus-driver-for-multiple-concu.patch
Simon Gaiser 2c4bf83c10 Workaround for HVM suspend issue
(cherry picked from commit 56ea7eaf76)
2018-02-05 22:06:43 +01:00

1519 lines
38 KiB
Diff

From 8829b1a71ba3dc2d0d5d3b6d494b798cc35f3a7e Mon Sep 17 00:00:00 2001
From: Simon Gaiser <simon@invisiblethingslab.com>
Date: Tue, 30 Jan 2018 07:38:25 +0100
Subject: [PATCH 4/4] Revert "xen: optimize xenbus driver for multiple
concurrent xenstore accesses"
This reverts commit fd8aa9095a95c02dcc35540a263267c29b8fda9d.
---
drivers/xen/xenbus/xenbus.h | 48 +--
drivers/xen/xenbus/xenbus_comms.c | 307 ++----------------
drivers/xen/xenbus/xenbus_dev_frontend.c | 188 ++++-------
drivers/xen/xenbus/xenbus_xs.c | 520 +++++++++++++++++--------------
4 files changed, 391 insertions(+), 672 deletions(-)
diff --git a/drivers/xen/xenbus/xenbus.h b/drivers/xen/xenbus/xenbus.h
index 149c5e7efc89..51995276f549 100644
--- a/drivers/xen/xenbus/xenbus.h
+++ b/drivers/xen/xenbus/xenbus.h
@@ -32,10 +32,6 @@
#ifndef _XENBUS_XENBUS_H
#define _XENBUS_XENBUS_H
-#include <linux/mutex.h>
-#include <linux/uio.h>
-#include <xen/xenbus.h>
-
#define XEN_BUS_ID_SIZE 20
struct xen_bus_type {
@@ -56,49 +52,16 @@ enum xenstore_init {
XS_LOCAL,
};
-struct xs_watch_event {
- struct list_head list;
- unsigned int len;
- struct xenbus_watch *handle;
- const char *path;
- const char *token;
- char body[];
-};
-
-enum xb_req_state {
- xb_req_state_queued,
- xb_req_state_wait_reply,
- xb_req_state_got_reply,
- xb_req_state_aborted
-};
-
-struct xb_req_data {
- struct list_head list;
- wait_queue_head_t wq;
- struct xsd_sockmsg msg;
- enum xsd_sockmsg_type type;
- char *body;
- const struct kvec *vec;
- int num_vecs;
- int err;
- enum xb_req_state state;
- void (*cb)(struct xb_req_data *);
- void *par;
-};
-
extern enum xenstore_init xen_store_domain_type;
extern const struct attribute_group *xenbus_dev_groups[];
-extern struct mutex xs_response_mutex;
-extern struct list_head xs_reply_list;
-extern struct list_head xb_write_list;
-extern wait_queue_head_t xb_waitq;
-extern struct mutex xb_write_mutex;
int xs_init(void);
int xb_init_comms(void);
void xb_deinit_comms(void);
-int xs_watch_msg(struct xs_watch_event *event);
-void xs_request_exit(struct xb_req_data *req);
+int xb_write(const void *data, unsigned int len);
+int xb_read(void *data, unsigned int len);
+int xb_data_to_read(void);
+int xb_wait_for_data_to_read(void);
int xenbus_match(struct device *_dev, struct device_driver *_drv);
int xenbus_dev_probe(struct device *_dev);
@@ -129,7 +92,6 @@ int xenbus_read_otherend_details(struct xenbus_device *xendev,
void xenbus_ring_ops_init(void);
-int xenbus_dev_request_and_reply(struct xsd_sockmsg *msg, void *par);
-void xenbus_dev_queue_reply(struct xb_req_data *req);
+void *xenbus_dev_request_and_reply(struct xsd_sockmsg *msg);
#endif
diff --git a/drivers/xen/xenbus/xenbus_comms.c b/drivers/xen/xenbus/xenbus_comms.c
index 856ada5d39c9..c21ec02643e1 100644
--- a/drivers/xen/xenbus/xenbus_comms.c
+++ b/drivers/xen/xenbus/xenbus_comms.c
@@ -34,7 +34,6 @@
#include <linux/wait.h>
#include <linux/interrupt.h>
-#include <linux/kthread.h>
#include <linux/sched.h>
#include <linux/err.h>
#include <xen/xenbus.h>
@@ -43,22 +42,11 @@
#include <xen/page.h>
#include "xenbus.h"
-/* A list of replies. Currently only one will ever be outstanding. */
-LIST_HEAD(xs_reply_list);
-
-/* A list of write requests. */
-LIST_HEAD(xb_write_list);
-DECLARE_WAIT_QUEUE_HEAD(xb_waitq);
-DEFINE_MUTEX(xb_write_mutex);
-
-/* Protect xenbus reader thread against save/restore. */
-DEFINE_MUTEX(xs_response_mutex);
-
static int xenbus_irq;
-static struct task_struct *xenbus_task;
static DECLARE_WORK(probe_work, xenbus_probe);
+static DECLARE_WAIT_QUEUE_HEAD(xb_waitq);
static irqreturn_t wake_waiting(int irq, void *unused)
{
@@ -96,31 +84,30 @@ static const void *get_input_chunk(XENSTORE_RING_IDX cons,
return buf + MASK_XENSTORE_IDX(cons);
}
-static int xb_data_to_write(void)
-{
- struct xenstore_domain_interface *intf = xen_store_interface;
-
- return (intf->req_prod - intf->req_cons) != XENSTORE_RING_SIZE &&
- !list_empty(&xb_write_list);
-}
-
/**
* xb_write - low level write
* @data: buffer to send
* @len: length of buffer
*
- * Returns number of bytes written or -err.
+ * Returns 0 on success, error otherwise.
*/
-static int xb_write(const void *data, unsigned int len)
+int xb_write(const void *data, unsigned len)
{
struct xenstore_domain_interface *intf = xen_store_interface;
XENSTORE_RING_IDX cons, prod;
- unsigned int bytes = 0;
+ int rc;
while (len != 0) {
void *dst;
unsigned int avail;
+ rc = wait_event_interruptible(
+ xb_waitq,
+ (intf->req_prod - intf->req_cons) !=
+ XENSTORE_RING_SIZE);
+ if (rc < 0)
+ return rc;
+
/* Read indexes, then verify. */
cons = intf->req_cons;
prod = intf->req_prod;
@@ -128,11 +115,6 @@ static int xb_write(const void *data, unsigned int len)
intf->req_cons = intf->req_prod = 0;
return -EIO;
}
- if (!xb_data_to_write())
- return bytes;
-
- /* Must write data /after/ reading the consumer index. */
- virt_mb();
dst = get_output_chunk(cons, prod, intf->req, &avail);
if (avail == 0)
@@ -140,45 +122,52 @@ static int xb_write(const void *data, unsigned int len)
if (avail > len)
avail = len;
+ /* Must write data /after/ reading the consumer index. */
+ virt_mb();
+
memcpy(dst, data, avail);
data += avail;
len -= avail;
- bytes += avail;
/* Other side must not see new producer until data is there. */
virt_wmb();
intf->req_prod += avail;
/* Implies mb(): other side will see the updated producer. */
- if (prod <= intf->req_cons)
- notify_remote_via_evtchn(xen_store_evtchn);
+ notify_remote_via_evtchn(xen_store_evtchn);
}
- return bytes;
+ return 0;
}
-static int xb_data_to_read(void)
+int xb_data_to_read(void)
{
struct xenstore_domain_interface *intf = xen_store_interface;
return (intf->rsp_cons != intf->rsp_prod);
}
-static int xb_read(void *data, unsigned int len)
+int xb_wait_for_data_to_read(void)
+{
+ return wait_event_interruptible(xb_waitq, xb_data_to_read());
+}
+
+int xb_read(void *data, unsigned len)
{
struct xenstore_domain_interface *intf = xen_store_interface;
XENSTORE_RING_IDX cons, prod;
- unsigned int bytes = 0;
+ int rc;
while (len != 0) {
unsigned int avail;
const char *src;
+ rc = xb_wait_for_data_to_read();
+ if (rc < 0)
+ return rc;
+
/* Read indexes, then verify. */
cons = intf->rsp_cons;
prod = intf->rsp_prod;
- if (cons == prod)
- return bytes;
-
if (!check_indexes(cons, prod)) {
intf->rsp_cons = intf->rsp_prod = 0;
return -EIO;
@@ -196,243 +185,17 @@ static int xb_read(void *data, unsigned int len)
memcpy(data, src, avail);
data += avail;
len -= avail;
- bytes += avail;
/* Other side must not see free space until we've copied out */
virt_mb();
intf->rsp_cons += avail;
- /* Implies mb(): other side will see the updated consumer. */
- if (intf->rsp_prod - cons >= XENSTORE_RING_SIZE)
- notify_remote_via_evtchn(xen_store_evtchn);
- }
-
- return bytes;
-}
-
-static int process_msg(void)
-{
- static struct {
- struct xsd_sockmsg msg;
- char *body;
- union {
- void *alloc;
- struct xs_watch_event *watch;
- };
- bool in_msg;
- bool in_hdr;
- unsigned int read;
- } state;
- struct xb_req_data *req;
- int err;
- unsigned int len;
-
- if (!state.in_msg) {
- state.in_msg = true;
- state.in_hdr = true;
- state.read = 0;
-
- /*
- * We must disallow save/restore while reading a message.
- * A partial read across s/r leaves us out of sync with
- * xenstored.
- * xs_response_mutex is locked as long as we are processing one
- * message. state.in_msg will be true as long as we are holding
- * the lock here.
- */
- mutex_lock(&xs_response_mutex);
-
- if (!xb_data_to_read()) {
- /* We raced with save/restore: pending data 'gone'. */
- mutex_unlock(&xs_response_mutex);
- state.in_msg = false;
- return 0;
- }
- }
-
- if (state.in_hdr) {
- if (state.read != sizeof(state.msg)) {
- err = xb_read((void *)&state.msg + state.read,
- sizeof(state.msg) - state.read);
- if (err < 0)
- goto out;
- state.read += err;
- if (state.read != sizeof(state.msg))
- return 0;
- if (state.msg.len > XENSTORE_PAYLOAD_MAX) {
- err = -EINVAL;
- goto out;
- }
- }
-
- len = state.msg.len + 1;
- if (state.msg.type == XS_WATCH_EVENT)
- len += sizeof(*state.watch);
-
- state.alloc = kmalloc(len, GFP_NOIO | __GFP_HIGH);
- if (!state.alloc)
- return -ENOMEM;
-
- if (state.msg.type == XS_WATCH_EVENT)
- state.body = state.watch->body;
- else
- state.body = state.alloc;
- state.in_hdr = false;
- state.read = 0;
- }
-
- err = xb_read(state.body + state.read, state.msg.len - state.read);
- if (err < 0)
- goto out;
-
- state.read += err;
- if (state.read != state.msg.len)
- return 0;
+ pr_debug("Finished read of %i bytes (%i to go)\n", avail, len);
- state.body[state.msg.len] = '\0';
-
- if (state.msg.type == XS_WATCH_EVENT) {
- state.watch->len = state.msg.len;
- err = xs_watch_msg(state.watch);
- } else {
- err = -ENOENT;
- mutex_lock(&xb_write_mutex);
- list_for_each_entry(req, &xs_reply_list, list) {
- if (req->msg.req_id == state.msg.req_id) {
- if (req->state == xb_req_state_wait_reply) {
- req->msg.type = state.msg.type;
- req->msg.len = state.msg.len;
- req->body = state.body;
- req->state = xb_req_state_got_reply;
- list_del(&req->list);
- req->cb(req);
- } else {
- list_del(&req->list);
- kfree(req);
- }
- err = 0;
- break;
- }
- }
- mutex_unlock(&xb_write_mutex);
- if (err)
- goto out;
- }
-
- mutex_unlock(&xs_response_mutex);
-
- state.in_msg = false;
- state.alloc = NULL;
- return err;
-
- out:
- mutex_unlock(&xs_response_mutex);
- state.in_msg = false;
- kfree(state.alloc);
- state.alloc = NULL;
- return err;
-}
-
-static int process_writes(void)
-{
- static struct {
- struct xb_req_data *req;
- int idx;
- unsigned int written;
- } state;
- void *base;
- unsigned int len;
- int err = 0;
-
- if (!xb_data_to_write())
- return 0;
-
- mutex_lock(&xb_write_mutex);
-
- if (!state.req) {
- state.req = list_first_entry(&xb_write_list,
- struct xb_req_data, list);
- state.idx = -1;
- state.written = 0;
- }
-
- if (state.req->state == xb_req_state_aborted)
- goto out_err;
-
- while (state.idx < state.req->num_vecs) {
- if (state.idx < 0) {
- base = &state.req->msg;
- len = sizeof(state.req->msg);
- } else {
- base = state.req->vec[state.idx].iov_base;
- len = state.req->vec[state.idx].iov_len;
- }
- err = xb_write(base + state.written, len - state.written);
- if (err < 0)
- goto out_err;
- state.written += err;
- if (state.written != len)
- goto out;
-
- state.idx++;
- state.written = 0;
- }
-
- list_del(&state.req->list);
- state.req->state = xb_req_state_wait_reply;
- list_add_tail(&state.req->list, &xs_reply_list);
- state.req = NULL;
-
- out:
- mutex_unlock(&xb_write_mutex);
-
- return 0;
-
- out_err:
- state.req->msg.type = XS_ERROR;
- state.req->err = err;
- list_del(&state.req->list);
- if (state.req->state == xb_req_state_aborted)
- kfree(state.req);
- else {
- state.req->state = xb_req_state_got_reply;
- wake_up(&state.req->wq);
- }
-
- mutex_unlock(&xb_write_mutex);
-
- state.req = NULL;
-
- return err;
-}
-
-static int xb_thread_work(void)
-{
- return xb_data_to_read() || xb_data_to_write();
-}
-
-static int xenbus_thread(void *unused)
-{
- int err;
-
- while (!kthread_should_stop()) {
- if (wait_event_interruptible(xb_waitq, xb_thread_work()))
- continue;
-
- err = process_msg();
- if (err == -ENOMEM)
- schedule();
- else if (err)
- pr_warn_ratelimited("error %d while reading message\n",
- err);
-
- err = process_writes();
- if (err)
- pr_warn_ratelimited("error %d while writing message\n",
- err);
+ /* Implies mb(): other side will see the updated consumer. */
+ notify_remote_via_evtchn(xen_store_evtchn);
}
- xenbus_task = NULL;
return 0;
}
@@ -460,7 +223,6 @@ int xb_init_comms(void)
rebind_evtchn_irq(xen_store_evtchn, xenbus_irq);
} else {
int err;
-
err = bind_evtchn_to_irqhandler(xen_store_evtchn, wake_waiting,
0, "xenbus", &xb_waitq);
if (err < 0) {
@@ -469,13 +231,6 @@ int xb_init_comms(void)
}
xenbus_irq = err;
-
- if (!xenbus_task) {
- xenbus_task = kthread_run(xenbus_thread, NULL,
- "xenbus");
- if (IS_ERR(xenbus_task))
- return PTR_ERR(xenbus_task);
- }
}
return 0;
diff --git a/drivers/xen/xenbus/xenbus_dev_frontend.c b/drivers/xen/xenbus/xenbus_dev_frontend.c
index 1f4733b80c87..19f823b378a0 100644
--- a/drivers/xen/xenbus/xenbus_dev_frontend.c
+++ b/drivers/xen/xenbus/xenbus_dev_frontend.c
@@ -112,7 +112,6 @@ struct xenbus_file_priv {
struct list_head read_buffers;
wait_queue_head_t read_waitq;
- struct kref kref;
};
/* Read out any raw xenbus messages queued up. */
@@ -297,107 +296,6 @@ static void watch_fired(struct xenbus_watch *watch,
mutex_unlock(&adap->dev_data->reply_mutex);
}
-static void xenbus_file_free(struct kref *kref)
-{
- struct xenbus_file_priv *u;
- struct xenbus_transaction_holder *trans, *tmp;
- struct watch_adapter *watch, *tmp_watch;
- struct read_buffer *rb, *tmp_rb;
-
- u = container_of(kref, struct xenbus_file_priv, kref);
-
- /*
- * No need for locking here because there are no other users,
- * by definition.
- */
-
- list_for_each_entry_safe(trans, tmp, &u->transactions, list) {
- xenbus_transaction_end(trans->handle, 1);
- list_del(&trans->list);
- kfree(trans);
- }
-
- list_for_each_entry_safe(watch, tmp_watch, &u->watches, list) {
- unregister_xenbus_watch(&watch->watch);
- list_del(&watch->list);
- free_watch_adapter(watch);
- }
-
- list_for_each_entry_safe(rb, tmp_rb, &u->read_buffers, list) {
- list_del(&rb->list);
- kfree(rb);
- }
- kfree(u);
-}
-
-static struct xenbus_transaction_holder *xenbus_get_transaction(
- struct xenbus_file_priv *u, uint32_t tx_id)
-{
- struct xenbus_transaction_holder *trans;
-
- list_for_each_entry(trans, &u->transactions, list)
- if (trans->handle.id == tx_id)
- return trans;
-
- return NULL;
-}
-
-void xenbus_dev_queue_reply(struct xb_req_data *req)
-{
- struct xenbus_file_priv *u = req->par;
- struct xenbus_transaction_holder *trans = NULL;
- int rc;
- LIST_HEAD(staging_q);
-
- xs_request_exit(req);
-
- mutex_lock(&u->msgbuffer_mutex);
-
- if (req->type == XS_TRANSACTION_START) {
- trans = xenbus_get_transaction(u, 0);
- if (WARN_ON(!trans))
- goto out;
- if (req->msg.type == XS_ERROR) {
- list_del(&trans->list);
- kfree(trans);
- } else {
- rc = kstrtou32(req->body, 10, &trans->handle.id);
- if (WARN_ON(rc))
- goto out;
- }
- } else if (req->msg.type == XS_TRANSACTION_END) {
- trans = xenbus_get_transaction(u, req->msg.tx_id);
- if (WARN_ON(!trans))
- goto out;
- list_del(&trans->list);
- kfree(trans);
- }
-
- mutex_unlock(&u->msgbuffer_mutex);
-
- mutex_lock(&u->reply_mutex);
- rc = queue_reply(&staging_q, &req->msg, sizeof(req->msg));
- if (!rc)
- rc = queue_reply(&staging_q, req->body, req->msg.len);
- if (!rc) {
- list_splice_tail(&staging_q, &u->read_buffers);
- wake_up(&u->read_waitq);
- } else {
- queue_cleanup(&staging_q);
- }
- mutex_unlock(&u->reply_mutex);
-
- kfree(req->body);
- kfree(req);
-
- kref_put(&u->kref, xenbus_file_free);
-
- return;
-
- out:
- mutex_unlock(&u->msgbuffer_mutex);
-}
-
static int xenbus_command_reply(struct xenbus_file_priv *u,
unsigned int msg_type, const char *reply)
{
@@ -418,9 +316,6 @@ static int xenbus_command_reply(struct xenbus_file_priv *u,
wake_up(&u->read_waitq);
mutex_unlock(&u->reply_mutex);
- if (!rc)
- kref_put(&u->kref, xenbus_file_free);
-
return rc;
}
@@ -428,22 +323,57 @@ static int xenbus_write_transaction(unsigned msg_type,
struct xenbus_file_priv *u)
{
int rc;
+ void *reply;
struct xenbus_transaction_holder *trans = NULL;
+ LIST_HEAD(staging_q);
if (msg_type == XS_TRANSACTION_START) {
- trans = kzalloc(sizeof(*trans), GFP_KERNEL);
+ trans = kmalloc(sizeof(*trans), GFP_KERNEL);
if (!trans) {
rc = -ENOMEM;
goto out;
}
- list_add(&trans->list, &u->transactions);
- } else if (u->u.msg.tx_id != 0 &&
- !xenbus_get_transaction(u, u->u.msg.tx_id))
- return xenbus_command_reply(u, XS_ERROR, "ENOENT");
+ } else if (u->u.msg.tx_id != 0) {
+ list_for_each_entry(trans, &u->transactions, list)
+ if (trans->handle.id == u->u.msg.tx_id)
+ break;
+ if (&trans->list == &u->transactions)
+ return xenbus_command_reply(u, XS_ERROR, "ENOENT");
+ }
+
+ reply = xenbus_dev_request_and_reply(&u->u.msg);
+ if (IS_ERR(reply)) {
+ if (msg_type == XS_TRANSACTION_START)
+ kfree(trans);
+ rc = PTR_ERR(reply);
+ goto out;
+ }
- rc = xenbus_dev_request_and_reply(&u->u.msg, u);
- if (rc)
+ if (msg_type == XS_TRANSACTION_START) {
+ if (u->u.msg.type == XS_ERROR)
+ kfree(trans);
+ else {
+ trans->handle.id = simple_strtoul(reply, NULL, 0);
+ list_add(&trans->list, &u->transactions);
+ }
+ } else if (u->u.msg.type == XS_TRANSACTION_END) {
+ list_del(&trans->list);
kfree(trans);
+ }
+
+ mutex_lock(&u->reply_mutex);
+ rc = queue_reply(&staging_q, &u->u.msg, sizeof(u->u.msg));
+ if (!rc)
+ rc = queue_reply(&staging_q, reply, u->u.msg.len);
+ if (!rc) {
+ list_splice_tail(&staging_q, &u->read_buffers);
+ wake_up(&u->read_waitq);
+ } else {
+ queue_cleanup(&staging_q);
+ }
+ mutex_unlock(&u->reply_mutex);
+
+ kfree(reply);
out:
return rc;
@@ -575,8 +505,6 @@ static ssize_t xenbus_file_write(struct file *filp,
* OK, now we have a complete message. Do something with it.
*/
- kref_get(&u->kref);
-
msg_type = u->u.msg.type;
switch (msg_type) {
@@ -591,10 +519,8 @@ static ssize_t xenbus_file_write(struct file *filp,
ret = xenbus_write_transaction(msg_type, u);
break;
}
- if (ret != 0) {
+ if (ret != 0)
rc = ret;
- kref_put(&u->kref, xenbus_file_free);
- }
/* Buffered message consumed */
u->len = 0;
@@ -619,8 +545,6 @@ static int xenbus_file_open(struct inode *inode, struct file *filp)
if (u == NULL)
return -ENOMEM;
- kref_init(&u->kref);
-
INIT_LIST_HEAD(&u->transactions);
INIT_LIST_HEAD(&u->watches);
INIT_LIST_HEAD(&u->read_buffers);
@@ -637,8 +561,32 @@ static int xenbus_file_open(struct inode *inode, struct file *filp)
static int xenbus_file_release(struct inode *inode, struct file *filp)
{
struct xenbus_file_priv *u = filp->private_data;
+ struct xenbus_transaction_holder *trans, *tmp;
+ struct watch_adapter *watch, *tmp_watch;
+ struct read_buffer *rb, *tmp_rb;
+
+ /*
+ * No need for locking here because there are no other users,
+ * by definition.
+ */
- kref_put(&u->kref, xenbus_file_free);
+ list_for_each_entry_safe(trans, tmp, &u->transactions, list) {
+ xenbus_transaction_end(trans->handle, 1);
+ list_del(&trans->list);
+ kfree(trans);
+ }
+
+ list_for_each_entry_safe(watch, tmp_watch, &u->watches, list) {
+ unregister_xenbus_watch(&watch->watch);
+ list_del(&watch->list);
+ free_watch_adapter(watch);
+ }
+
+ list_for_each_entry_safe(rb, tmp_rb, &u->read_buffers, list) {
+ list_del(&rb->list);
+ kfree(rb);
+ }
+ kfree(u);
return 0;
}
diff --git a/drivers/xen/xenbus/xenbus_xs.c b/drivers/xen/xenbus/xenbus_xs.c
index e46080214955..ebc768f44abe 100644
--- a/drivers/xen/xenbus/xenbus_xs.c
+++ b/drivers/xen/xenbus/xenbus_xs.c
@@ -43,7 +43,6 @@
#include <linux/slab.h>
#include <linux/fcntl.h>
#include <linux/kthread.h>
-#include <linux/reboot.h>
#include <linux/rwsem.h>
#include <linux/mutex.h>
#include <asm/xen/hypervisor.h>
@@ -51,28 +50,61 @@
#include <xen/xen.h>
#include "xenbus.h"
-/*
- * Framework to protect suspend/resume handling against normal Xenstore
- * message handling:
- * During suspend/resume there must be no open transaction and no pending
- * Xenstore request.
- * New watch events happening in this time can be ignored by firing all watches
- * after resume.
- */
+struct xs_stored_msg {
+ struct list_head list;
-/* Lock protecting enter/exit critical region. */
-static DEFINE_SPINLOCK(xs_state_lock);
-/* Number of users in critical region (protected by xs_state_lock). */
-static unsigned int xs_state_users;
-/* Suspend handler waiting or already active (protected by xs_state_lock)? */
-static int xs_suspend_active;
-/* Unique Xenstore request id (protected by xs_state_lock). */
-static uint32_t xs_request_id;
+ struct xsd_sockmsg hdr;
-/* Wait queue for all callers waiting for critical region to become usable. */
-static DECLARE_WAIT_QUEUE_HEAD(xs_state_enter_wq);
-/* Wait queue for suspend handling waiting for critical region being empty. */
-static DECLARE_WAIT_QUEUE_HEAD(xs_state_exit_wq);
+ union {
+ /* Queued replies. */
+ struct {
+ char *body;
+ } reply;
+
+ /* Queued watch events. */
+ struct {
+ struct xenbus_watch *handle;
+ const char *path;
+ const char *token;
+ } watch;
+ } u;
+};
+
+struct xs_handle {
+ /* A list of replies. Currently only one will ever be outstanding. */
+ struct list_head reply_list;
+ spinlock_t reply_lock;
+ wait_queue_head_t reply_waitq;
+
+ /*
+ * Mutex ordering: transaction_mutex -> watch_mutex -> request_mutex.
+ * response_mutex is never taken simultaneously with the other three.
+ *
+ * transaction_mutex must be held before incrementing
+ * transaction_count. The mutex is held when a suspend is in
+ * progress to prevent new transactions starting.
+ *
+ * When decrementing transaction_count to zero the wait queue
+ * should be woken up, the suspend code waits for count to
+ * reach zero.
+ */
+
+ /* One request at a time. */
+ struct mutex request_mutex;
+
+ /* Protect xenbus reader thread against save/restore. */
+ struct mutex response_mutex;
+
+ /* Protect transactions against save/restore. */
+ struct mutex transaction_mutex;
+ atomic_t transaction_count;
+ wait_queue_head_t transaction_wq;
+
+ /* Protect watch (de)register against save/restore. */
+ struct rw_semaphore watch_mutex;
+};
+
+static struct xs_handle xs_state;
/* List of registered watches, and a lock to protect it. */
static LIST_HEAD(watches);
@@ -82,9 +114,6 @@ static DEFINE_SPINLOCK(watches_lock);
static LIST_HEAD(watch_events);
static DEFINE_SPINLOCK(watch_events_lock);
-/* Protect watch (de)register against save/restore. */
-static DECLARE_RWSEM(xs_watch_rwsem);
-
/*
* Details of the xenwatch callback kernel thread. The thread waits on the
* watch_events_waitq for work to do (queued on watch_events list). When it
@@ -95,59 +124,6 @@ static pid_t xenwatch_pid;
static DEFINE_MUTEX(xenwatch_mutex);
static DECLARE_WAIT_QUEUE_HEAD(watch_events_waitq);
-static void xs_suspend_enter(void)
-{
- spin_lock(&xs_state_lock);
- xs_suspend_active++;
- spin_unlock(&xs_state_lock);
- wait_event(xs_state_exit_wq, xs_state_users == 0);
-}
-
-static void xs_suspend_exit(void)
-{
- spin_lock(&xs_state_lock);
- xs_suspend_active--;
- spin_unlock(&xs_state_lock);
- wake_up_all(&xs_state_enter_wq);
-}
-
-static uint32_t xs_request_enter(struct xb_req_data *req)
-{
- uint32_t rq_id;
-
- req->type = req->msg.type;
-
- spin_lock(&xs_state_lock);
-
- while (!xs_state_users && xs_suspend_active) {
- spin_unlock(&xs_state_lock);
- wait_event(xs_state_enter_wq, xs_suspend_active == 0);
- spin_lock(&xs_state_lock);
- }
-
- if (req->type == XS_TRANSACTION_START)
- xs_state_users++;
- xs_state_users++;
- rq_id = xs_request_id++;
-
- spin_unlock(&xs_state_lock);
-
- return rq_id;
-}
-
-void xs_request_exit(struct xb_req_data *req)
-{
- spin_lock(&xs_state_lock);
- xs_state_users--;
- if ((req->type == XS_TRANSACTION_START && req->msg.type == XS_ERROR) ||
- req->type == XS_TRANSACTION_END)
- xs_state_users--;
- spin_unlock(&xs_state_lock);
-
- if (xs_suspend_active && !xs_state_users)
- wake_up(&xs_state_exit_wq);
-}
-
static int get_error(const char *errorstring)
{
unsigned int i;
@@ -185,24 +161,21 @@ static bool xenbus_ok(void)
}
return false;
}
-
-static bool test_reply(struct xb_req_data *req)
+static void *read_reply(enum xsd_sockmsg_type *type, unsigned int *len)
{
- if (req->state == xb_req_state_got_reply || !xenbus_ok())
- return true;
+ struct xs_stored_msg *msg;
+ char *body;
- /* Make sure to reread req->state each time. */
- barrier();
+ spin_lock(&xs_state.reply_lock);
- return false;
-}
-
-static void *read_reply(struct xb_req_data *req)
-{
- while (req->state != xb_req_state_got_reply) {
- wait_event(req->wq, test_reply(req));
-
- if (!xenbus_ok())
+ while (list_empty(&xs_state.reply_list)) {
+ spin_unlock(&xs_state.reply_lock);
+ if (xenbus_ok())
+ /* XXX FIXME: Avoid synchronous wait for response here. */
+ wait_event_timeout(xs_state.reply_waitq,
+ !list_empty(&xs_state.reply_list),
+ msecs_to_jiffies(500));
+ else {
/*
* If we are in the process of being shut-down there is
* no point of trying to contact XenBus - it is either
@@ -210,82 +183,76 @@ static void *read_reply(struct xb_req_data *req)
* has been killed or is unreachable.
*/
return ERR_PTR(-EIO);
- if (req->err)
- return ERR_PTR(req->err);
-
+ }
+ spin_lock(&xs_state.reply_lock);
}
- return req->body;
-}
+ msg = list_entry(xs_state.reply_list.next,
+ struct xs_stored_msg, list);
+ list_del(&msg->list);
-static void xs_send(struct xb_req_data *req, struct xsd_sockmsg *msg)
-{
- bool notify;
+ spin_unlock(&xs_state.reply_lock);
- req->msg = *msg;
- req->err = 0;
- req->state = xb_req_state_queued;
- init_waitqueue_head(&req->wq);
-
- req->msg.req_id = xs_request_enter(req);
+ *type = msg->hdr.type;
+ if (len)
+ *len = msg->hdr.len;
+ body = msg->u.reply.body;
- mutex_lock(&xb_write_mutex);
- list_add_tail(&req->list, &xb_write_list);
- notify = list_is_singular(&xb_write_list);
- mutex_unlock(&xb_write_mutex);
+ kfree(msg);
- if (notify)
- wake_up(&xb_waitq);
+ return body;
}
-static void *xs_wait_for_reply(struct xb_req_data *req, struct xsd_sockmsg *msg)
+static void transaction_start(void)
{
- void *ret;
-
- ret = read_reply(req);
-
- xs_request_exit(req);
-
- msg->type = req->msg.type;
- msg->len = req->msg.len;
+ mutex_lock(&xs_state.transaction_mutex);
+ atomic_inc(&xs_state.transaction_count);
+ mutex_unlock(&xs_state.transaction_mutex);
+}
- mutex_lock(&xb_write_mutex);
- if (req->state == xb_req_state_queued ||
- req->state == xb_req_state_wait_reply)
- req->state = xb_req_state_aborted;
- else
- kfree(req);
- mutex_unlock(&xb_write_mutex);
+static void transaction_end(void)
+{
+ if (atomic_dec_and_test(&xs_state.transaction_count))
+ wake_up(&xs_state.transaction_wq);
+}
- return ret;
+static void transaction_suspend(void)
+{
+ mutex_lock(&xs_state.transaction_mutex);
+ wait_event(xs_state.transaction_wq,
+ atomic_read(&xs_state.transaction_count) == 0);
}
-static void xs_wake_up(struct xb_req_data *req)
+static void transaction_resume(void)
{
- wake_up(&req->wq);
+ mutex_unlock(&xs_state.transaction_mutex);
}
-int xenbus_dev_request_and_reply(struct xsd_sockmsg *msg, void *par)
+void *xenbus_dev_request_and_reply(struct xsd_sockmsg *msg)
{
- struct xb_req_data *req;
- struct kvec *vec;
+ void *ret;
+ enum xsd_sockmsg_type type = msg->type;
+ int err;
- req = kmalloc(sizeof(*req) + sizeof(*vec), GFP_KERNEL);
- if (!req)
- return -ENOMEM;
+ if (type == XS_TRANSACTION_START)
+ transaction_start();
+
+ mutex_lock(&xs_state.request_mutex);
- vec = (struct kvec *)(req + 1);
- vec->iov_len = msg->len;
- vec->iov_base = msg + 1;
+ err = xb_write(msg, sizeof(*msg) + msg->len);
+ if (err) {
+ msg->type = XS_ERROR;
+ ret = ERR_PTR(err);
+ } else
+ ret = read_reply(&msg->type, &msg->len);
- req->vec = vec;
- req->num_vecs = 1;
- req->cb = xenbus_dev_queue_reply;
- req->par = par;
+ mutex_unlock(&xs_state.request_mutex);
- xs_send(req, msg);
+ if ((msg->type == XS_TRANSACTION_END) ||
+ ((type == XS_TRANSACTION_START) && (msg->type == XS_ERROR)))
+ transaction_end();
- return 0;
+ return ret;
}
EXPORT_SYMBOL(xenbus_dev_request_and_reply);
@@ -296,31 +263,37 @@ static void *xs_talkv(struct xenbus_transaction t,
unsigned int num_vecs,
unsigned int *len)
{
- struct xb_req_data *req;
struct xsd_sockmsg msg;
void *ret = NULL;
unsigned int i;
int err;
- req = kmalloc(sizeof(*req), GFP_NOIO | __GFP_HIGH);
- if (!req)
- return ERR_PTR(-ENOMEM);
-
- req->vec = iovec;
- req->num_vecs = num_vecs;
- req->cb = xs_wake_up;
-
msg.tx_id = t.id;
+ msg.req_id = 0;
msg.type = type;
msg.len = 0;
for (i = 0; i < num_vecs; i++)
msg.len += iovec[i].iov_len;
- xs_send(req, &msg);
+ mutex_lock(&xs_state.request_mutex);
- ret = xs_wait_for_reply(req, &msg);
- if (len)
- *len = msg.len;
+ err = xb_write(&msg, sizeof(msg));
+ if (err) {
+ mutex_unlock(&xs_state.request_mutex);
+ return ERR_PTR(err);
+ }
+
+ for (i = 0; i < num_vecs; i++) {
+ err = xb_write(iovec[i].iov_base, iovec[i].iov_len);
+ if (err) {
+ mutex_unlock(&xs_state.request_mutex);
+ return ERR_PTR(err);
+ }
+ }
+
+ ret = read_reply(&msg.type, len);
+
+ mutex_unlock(&xs_state.request_mutex);
if (IS_ERR(ret))
return ret;
@@ -527,9 +500,13 @@ int xenbus_transaction_start(struct xenbus_transaction *t)
{
char *id_str;
+ transaction_start();
+
id_str = xs_single(XBT_NIL, XS_TRANSACTION_START, "", NULL);
- if (IS_ERR(id_str))
+ if (IS_ERR(id_str)) {
+ transaction_end();
return PTR_ERR(id_str);
+ }
t->id = simple_strtoul(id_str, NULL, 0);
kfree(id_str);
@@ -543,13 +520,18 @@ EXPORT_SYMBOL_GPL(xenbus_transaction_start);
int xenbus_transaction_end(struct xenbus_transaction t, int abort)
{
char abortstr[2];
+ int err;
if (abort)
strcpy(abortstr, "F");
else
strcpy(abortstr, "T");
- return xs_error(xs_single(t, XS_TRANSACTION_END, abortstr, NULL));
+ err = xs_error(xs_single(t, XS_TRANSACTION_END, abortstr, NULL));
+
+ transaction_end();
+
+ return err;
}
EXPORT_SYMBOL_GPL(xenbus_transaction_end);
@@ -682,30 +664,6 @@ static struct xenbus_watch *find_watch(const char *token)
return NULL;
}
-
-int xs_watch_msg(struct xs_watch_event *event)
-{
- if (count_strings(event->body, event->len) != 2) {
- kfree(event);
- return -EINVAL;
- }
- event->path = (const char *)event->body;
- event->token = (const char *)strchr(event->body, '\0') + 1;
-
- spin_lock(&watches_lock);
- event->handle = find_watch(event->token);
- if (event->handle != NULL) {
- spin_lock(&watch_events_lock);
- list_add_tail(&event->list, &watch_events);
- wake_up(&watch_events_waitq);
- spin_unlock(&watch_events_lock);
- } else
- kfree(event);
- spin_unlock(&watches_lock);
-
- return 0;
-}
-
/*
* Certain older XenBus toolstack cannot handle reading values that are
* not populated. Some Xen 3.4 installation are incapable of doing this
@@ -754,7 +712,7 @@ int register_xenbus_watch(struct xenbus_watch *watch)
sprintf(token, "%lX", (long)watch);
- down_read(&xs_watch_rwsem);
+ down_read(&xs_state.watch_mutex);
spin_lock(&watches_lock);
BUG_ON(find_watch(token));
@@ -769,7 +727,7 @@ int register_xenbus_watch(struct xenbus_watch *watch)
spin_unlock(&watches_lock);
}
- up_read(&xs_watch_rwsem);
+ up_read(&xs_state.watch_mutex);
return err;
}
@@ -777,13 +735,13 @@ EXPORT_SYMBOL_GPL(register_xenbus_watch);
void unregister_xenbus_watch(struct xenbus_watch *watch)
{
- struct xs_watch_event *event, *tmp;
+ struct xs_stored_msg *msg, *tmp;
char token[sizeof(watch) * 2 + 1];
int err;
sprintf(token, "%lX", (long)watch);
- down_read(&xs_watch_rwsem);
+ down_read(&xs_state.watch_mutex);
spin_lock(&watches_lock);
BUG_ON(!find_watch(token));
@@ -794,7 +752,7 @@ void unregister_xenbus_watch(struct xenbus_watch *watch)
if (err)
pr_warn("Failed to release watch %s: %i\n", watch->node, err);
- up_read(&xs_watch_rwsem);
+ up_read(&xs_state.watch_mutex);
/* Make sure there are no callbacks running currently (unless
its us) */
@@ -803,11 +761,12 @@ void unregister_xenbus_watch(struct xenbus_watch *watch)
/* Cancel pending watch events. */
spin_lock(&watch_events_lock);
- list_for_each_entry_safe(event, tmp, &watch_events, list) {
- if (event->handle != watch)
+ list_for_each_entry_safe(msg, tmp, &watch_events, list) {
+ if (msg->u.watch.handle != watch)
continue;
- list_del(&event->list);
- kfree(event);
+ list_del(&msg->list);
+ kfree(msg->u.watch.path);
+ kfree(msg);
}
spin_unlock(&watch_events_lock);
@@ -818,10 +777,10 @@ EXPORT_SYMBOL_GPL(unregister_xenbus_watch);
void xs_suspend(void)
{
- xs_suspend_enter();
-
- down_write(&xs_watch_rwsem);
- mutex_lock(&xs_response_mutex);
+ transaction_suspend();
+ down_write(&xs_state.watch_mutex);
+ mutex_lock(&xs_state.request_mutex);
+ mutex_lock(&xs_state.response_mutex);
}
void xs_resume(void)
@@ -831,31 +790,31 @@ void xs_resume(void)
xb_init_comms();
- mutex_unlock(&xs_response_mutex);
-
- xs_suspend_exit();
+ mutex_unlock(&xs_state.response_mutex);
+ mutex_unlock(&xs_state.request_mutex);
+ transaction_resume();
- /* No need for watches_lock: the xs_watch_rwsem is sufficient. */
+ /* No need for watches_lock: the watch_mutex is sufficient. */
list_for_each_entry(watch, &watches, list) {
sprintf(token, "%lX", (long)watch);
xs_watch(watch->node, token);
}
- up_write(&xs_watch_rwsem);
+ up_write(&xs_state.watch_mutex);
}
void xs_suspend_cancel(void)
{
- mutex_unlock(&xs_response_mutex);
- up_write(&xs_watch_rwsem);
-
- xs_suspend_exit();
+ mutex_unlock(&xs_state.response_mutex);
+ mutex_unlock(&xs_state.request_mutex);
+ up_write(&xs_state.watch_mutex);
+ mutex_unlock(&xs_state.transaction_mutex);
}
static int xenwatch_thread(void *unused)
{
struct list_head *ent;
- struct xs_watch_event *event;
+ struct xs_stored_msg *msg;
for (;;) {
wait_event_interruptible(watch_events_waitq,
@@ -873,10 +832,12 @@ static int xenwatch_thread(void *unused)
spin_unlock(&watch_events_lock);
if (ent != &watch_events) {
- event = list_entry(ent, struct xs_watch_event, list);
- event->handle->callback(event->handle, event->path,
- event->token);
- kfree(event);
+ msg = list_entry(ent, struct xs_stored_msg, list);
+ msg->u.watch.handle->callback(msg->u.watch.handle,
+ msg->u.watch.path,
+ msg->u.watch.token);
+ kfree(msg->u.watch.path);
+ kfree(msg);
}
mutex_unlock(&xenwatch_mutex);
@@ -885,37 +846,126 @@ static int xenwatch_thread(void *unused)
return 0;
}
-/*
- * Wake up all threads waiting for a xenstore reply. In case of shutdown all
- * pending replies will be marked as "aborted" in order to let the waiters
- * return in spite of xenstore possibly no longer being able to reply. This
- * will avoid blocking shutdown by a thread waiting for xenstore but being
- * necessary for shutdown processing to proceed.
- */
-static int xs_reboot_notify(struct notifier_block *nb,
- unsigned long code, void *unused)
+static int process_msg(void)
{
- struct xb_req_data *req;
+ struct xs_stored_msg *msg;
+ char *body;
+ int err;
+
+ /*
+ * We must disallow save/restore while reading a xenstore message.
+ * A partial read across s/r leaves us out of sync with xenstored.
+ */
+ for (;;) {
+ err = xb_wait_for_data_to_read();
+ if (err)
+ return err;
+ mutex_lock(&xs_state.response_mutex);
+ if (xb_data_to_read())
+ break;
+ /* We raced with save/restore: pending data 'disappeared'. */
+ mutex_unlock(&xs_state.response_mutex);
+ }
- mutex_lock(&xb_write_mutex);
- list_for_each_entry(req, &xs_reply_list, list)
- wake_up(&req->wq);
- list_for_each_entry(req, &xb_write_list, list)
- wake_up(&req->wq);
- mutex_unlock(&xb_write_mutex);
- return NOTIFY_DONE;
+
+ msg = kmalloc(sizeof(*msg), GFP_NOIO | __GFP_HIGH);
+ if (msg == NULL) {
+ err = -ENOMEM;
+ goto out;
+ }
+
+ err = xb_read(&msg->hdr, sizeof(msg->hdr));
+ if (err) {
+ kfree(msg);
+ goto out;
+ }
+
+ if (msg->hdr.len > XENSTORE_PAYLOAD_MAX) {
+ kfree(msg);
+ err = -EINVAL;
+ goto out;
+ }
+
+ body = kmalloc(msg->hdr.len + 1, GFP_NOIO | __GFP_HIGH);
+ if (body == NULL) {
+ kfree(msg);
+ err = -ENOMEM;
+ goto out;
+ }
+
+ err = xb_read(body, msg->hdr.len);
+ if (err) {
+ kfree(body);
+ kfree(msg);
+ goto out;
+ }
+ body[msg->hdr.len] = '\0';
+
+ if (msg->hdr.type == XS_WATCH_EVENT) {
+ if (count_strings(body, msg->hdr.len) != 2) {
+ err = -EINVAL;
+ kfree(msg);
+ kfree(body);
+ goto out;
+ }
+ msg->u.watch.path = (const char *)body;
+ msg->u.watch.token = (const char *)strchr(body, '\0') + 1;
+
+ spin_lock(&watches_lock);
+ msg->u.watch.handle = find_watch(msg->u.watch.token);
+ if (msg->u.watch.handle != NULL) {
+ spin_lock(&watch_events_lock);
+ list_add_tail(&msg->list, &watch_events);
+ wake_up(&watch_events_waitq);
+ spin_unlock(&watch_events_lock);
+ } else {
+ kfree(body);
+ kfree(msg);
+ }
+ spin_unlock(&watches_lock);
+ } else {
+ msg->u.reply.body = body;
+ spin_lock(&xs_state.reply_lock);
+ list_add_tail(&msg->list, &xs_state.reply_list);
+ spin_unlock(&xs_state.reply_lock);
+ wake_up(&xs_state.reply_waitq);
+ }
+
+ out:
+ mutex_unlock(&xs_state.response_mutex);
+ return err;
}
-static struct notifier_block xs_reboot_nb = {
- .notifier_call = xs_reboot_notify,
-};
+static int xenbus_thread(void *unused)
+{
+ int err;
+
+ for (;;) {
+ err = process_msg();
+ if (err)
+ pr_warn("error %d while reading message\n", err);
+ if (kthread_should_stop())
+ break;
+ }
+
+ return 0;
+}
int xs_init(void)
{
int err;
struct task_struct *task;
- register_reboot_notifier(&xs_reboot_nb);
+ INIT_LIST_HEAD(&xs_state.reply_list);
+ spin_lock_init(&xs_state.reply_lock);
+ init_waitqueue_head(&xs_state.reply_waitq);
+
+ mutex_init(&xs_state.request_mutex);
+ mutex_init(&xs_state.response_mutex);
+ mutex_init(&xs_state.transaction_mutex);
+ init_rwsem(&xs_state.watch_mutex);
+ atomic_set(&xs_state.transaction_count, 0);
+ init_waitqueue_head(&xs_state.transaction_wq);
/* Initialize the shared memory rings to talk to xenstored */
err = xb_init_comms();
@@ -927,6 +977,10 @@ int xs_init(void)
return PTR_ERR(task);
xenwatch_pid = task->pid;
+ task = kthread_run(xenbus_thread, NULL, "xenbus");
+ if (IS_ERR(task))
+ return PTR_ERR(task);
+
/* shutdown watches for kexec boot */
xs_reset_watches();
--
2.15.1