#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: xenbus_client.c,v 1.17 2020/04/07 15:16:52 jdolecek Exp $");
#if 0
#define DPRINTK(fmt, args...) \
printk("xenbus_client (%s:%d) " fmt ".\n", __func__, __LINE__, ##args)
#else
#define DPRINTK(fmt, args...) ((void)0)
#endif
#include <sys/types.h>
#include <sys/null.h>
#include <sys/errno.h>
#include <sys/kmem.h>
#include <sys/systm.h>
#include <xen/xen.h>
#include <xen/hypervisor.h>
#include <xen/evtchn.h>
#include <xen/xenbus.h>
#include <xen/granttables.h>
int
xenbus_watch_path2(struct xenbus_device *dev, const char *path,
const char *path2, struct xenbus_watch *watch,
void (*callback)(struct xenbus_watch *,
const char **, unsigned int))
{
int err;
char *state;
DPRINTK("xenbus_watch_path2 path %s path2 %s\n", path, path2);
watch->node_sz = strlen(path) + 1 + strlen(path2) + 1;
state = kmem_alloc(watch->node_sz, KM_SLEEP);
strcpy(state, path);
strcat(state, "/");
strcat(state, path2);
watch->node = state;
watch->xbw_callback = callback;
err = register_xenbus_watch(watch);
if (err) {
watch->node = NULL;
watch->node_sz = 0;
watch->xbw_callback = NULL;
xenbus_dev_fatal(dev, err, "adding watch on %s", state);
kmem_free(state, watch->node_sz);
}
return err;
}
void
xenbus_unwatch_path(struct xenbus_watch *watch)
{
if (watch->node != NULL) {
unregister_xenbus_watch(watch);
kmem_free(watch->node, watch->node_sz);
watch->node = NULL;
}
}
int
xenbus_switch_state(struct xenbus_device *dev,
struct xenbus_transaction *xbt,
XenbusState state)
{
u_long current_state;
int err = xenbus_read_ul(xbt, dev->xbusd_path, "state",
¤t_state, 10);
if (err)
return 0;
if ((XenbusState)current_state == state)
return 0;
err = xenbus_printf(xbt, dev->xbusd_path, "state", "%d", state);
if (err) {
xenbus_dev_fatal(dev, err, "writing new state");
return err;
}
return 0;
}
static char *
error_path(struct xenbus_device *dev, size_t *len)
{
*len = strlen("error/") + strlen(dev->xbusd_path) + 1;
char *path_buffer = kmem_alloc(*len, KM_NOSLEEP);
if (path_buffer == NULL)
return NULL;
strcpy(path_buffer, "error/");
strcpy(path_buffer + strlen("error/"), dev->xbusd_path);
return path_buffer;
}
static void
_dev_error(struct xenbus_device *dev, int err, const char *fmt,
va_list ap)
{
int ret __diagused;
unsigned int len;
char *printf_buffer = NULL, *path_buffer = NULL;
size_t path_buffer_sz = 0;
#define PRINTF_BUFFER_SIZE 4096
printf_buffer = kmem_alloc(PRINTF_BUFFER_SIZE, KM_NOSLEEP);
if (printf_buffer == NULL)
goto fail;
len = snprintf(printf_buffer, PRINTF_BUFFER_SIZE, "%i ", -err);
KASSERT(len < PRINTF_BUFFER_SIZE);
ret = vsnprintf(printf_buffer+len, PRINTF_BUFFER_SIZE-len, fmt, ap);
KASSERT(len + ret < PRINTF_BUFFER_SIZE);
dev->xbusd_has_error = 1;
path_buffer = error_path(dev, &path_buffer_sz);
if (path_buffer == NULL) {
printk("xenbus: failed to write error node for %s (%s)\n",
dev->xbusd_path, printf_buffer);
goto fail;
}
if (xenbus_write(NULL, path_buffer, "error", printf_buffer) != 0) {
printk("xenbus: failed to write error node for %s (%s)\n",
dev->xbusd_path, printf_buffer);
goto fail;
}
fail:
if (printf_buffer)
kmem_free(printf_buffer, PRINTF_BUFFER_SIZE);
if (path_buffer)
kmem_free(path_buffer, path_buffer_sz);
}
void
xenbus_dev_error(struct xenbus_device *dev, int err, const char *fmt,
...)
{
va_list ap;
va_start(ap, fmt);
_dev_error(dev, err, fmt, ap);
va_end(ap);
}
void
xenbus_dev_fatal(struct xenbus_device *dev, int err, const char *fmt,
...)
{
va_list ap;
va_start(ap, fmt);
_dev_error(dev, err, fmt, ap);
va_end(ap);
xenbus_switch_state(dev, NULL, XenbusStateClosing);
}
int
xenbus_grant_ring(struct xenbus_device *dev, paddr_t ring_pa,
grant_ref_t *entryp)
{
int err = xengnt_grant_access(dev->xbusd_otherend_id, ring_pa,
0, entryp);
if (err != 0)
xenbus_dev_fatal(dev, err, "granting access to ring page");
return err;
}
int
xenbus_alloc_evtchn(struct xenbus_device *dev, int *port)
{
evtchn_op_t op = {
.cmd = EVTCHNOP_alloc_unbound,
.u.alloc_unbound = {
.dom = DOMID_SELF,
.remote_dom = dev->xbusd_otherend_id,
.port = 0
}
};
int err = HYPERVISOR_event_channel_op(&op);
if (err)
xenbus_dev_fatal(dev, err, "allocating event channel");
else
*port = op.u.alloc_unbound.port;
return err;
}
XenbusState
xenbus_read_driver_state(const char *path)
{
u_long result;
int err = xenbus_read_ul(NULL, path, "state", &result, 10);
if (err)
result = XenbusStateClosed;
return result;
}