path: root/linux-2.6-xen-sparse/drivers/xen/pciback/xenbus.c

/*
 * PCI Backend Xenbus Setup - handles setup with frontend and xend
 *
 *   Author: Ryan Wilson <hap9@epoch.ncsc.mil>
 */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/list.h>
#include <linux/vmalloc.h>
#include <xen/xenbus.h>
#include <xen/evtchn.h>
#include "pciback.h"

#define INVALID_EVTCHN_IRQ  (-1)

static struct pciback_device *alloc_pdev(struct xenbus_device *xdev)
{
	struct pciback_device *pdev;

	pdev = kzalloc(sizeof(struct pciback_device), GFP_KERNEL);
	if (pdev == NULL)
		goto out;
	dev_dbg(&xdev->dev, "allocated pdev @ 0x%p\n", pdev);

	pdev->xdev = xdev;
	xdev->dev.driver_data = pdev;

	spin_lock_init(&pdev->dev_lock);

	pdev->sh_area = NULL;
	pdev->sh_info = NULL;
	pdev->evtchn_irq = INVALID_EVTCHN_IRQ;
	pdev->be_watching = 0;

	INIT_WORK(&pdev->op_work, pciback_do_op, pdev);

	if (pciback_init_devices(pdev)) {
		kfree(pdev);
		pdev = NULL;
	}
      out:
	return pdev;
}

static void free_pdev(struct pciback_device *pdev)
{
	if (pdev->be_watching)
		unregister_xenbus_watch(&pdev->be_watch);

	/* Ensure the guest can't trigger our handler before removing devices */
	if (pdev->evtchn_irq != INVALID_EVTCHN_IRQ)
		unbind_from_irqhandler(pdev->evtchn_irq, pdev);

	/* If the driver domain started an op, make sure we complete it or
	 * delete it before releasing the shared memory */
	cancel_delayed_work(&pdev->op_work);
	flush_scheduled_work();

	if (pdev->sh_info)
		xenbus_unmap_ring_vfree(pdev->xdev, pdev->sh_area);

	pciback_release_devices(pdev);

	pdev->xdev->dev.driver_data = NULL;
	pdev->xdev = NULL;

	kfree(pdev);
}

static int pciback_do_attach(struct pciback_device *pdev, int gnt_ref,
			     int remote_evtchn)
{
	int err = 0;
	int evtchn;
	struct vm_struct *area;

	dev_dbg(&pdev->xdev->dev,
		"Attaching to frontend resources - gnt_ref=%d evtchn=%d\n",
		gnt_ref, remote_evtchn);

	area = xenbus_map_ring_valloc(pdev->xdev, gnt_ref);
	if (IS_ERR(area)) {
		err = PTR_ERR(area);
		goto out;
	}
	pdev->sh_area = area;
	pdev->sh_info = area->addr;

	err = xenbus_bind_evtchn(pdev->xdev, remote_evtchn, &evtchn);
	if (err)
		goto out;

	err = bind_evtchn_to_irqhandler(evtchn, pciback_handle_event,
					SA_SAMPLE_RANDOM, "pciback", pdev);
	if (err < 0) {
		xenbus_dev_fatal(pdev->xdev, err,
				 "Error binding event channel to IRQ");
		goto out;
	}
	pdev->evtchn_irq = err;
	err = 0;

	dev_dbg(&pdev->xdev->dev, "Attached!\n");
      out:
	return err;
}

static int pciback_attach(struct pciback_device *pdev)
{
	int err = 0;
	int gnt_ref, remote_evtchn;
	char *magic = NULL;

	spin_lock(&pdev->dev_lock);

	/* Make sure we only do this setup once */
	if (xenbus_read_driver_state(pdev->xdev->nodename) !=
	    XenbusStateInitialised)
		goto out;

	/* Wait for frontend to state that it has published the configuration */
	if (xenbus_read_driver_state(pdev->xdev->otherend) !=
	    XenbusStateInitialised)
		goto out;

	dev_dbg(&pdev->xdev->dev, "Reading frontend config\n");

	err = xenbus_gather(XBT_NIL, pdev->xdev->otherend,
			    "pci-op-ref", "%u", &gnt_ref,
			    "event-channel", "%u", &remote_evtchn,
			    "magic", NULL, &magic, NULL);
	if (err) {
		/* If configuration didn't get read correctly, wait longer */
		xenbus_dev_fatal(pdev->xdev, err,
				 "Error reading configuration from frontend");
		goto out;
	}

	if (magic == NULL || strcmp(magic, XEN_PCI_MAGIC) != 0) {
		xenbus_dev_fatal(pdev->xdev, -EFAULT,
				 "version mismatch (%s/%s) with pcifront - "
				 "halting pciback",
				 magic, XEN_PCI_MAGIC);
		goto out;
	}

	err = pciback_do_attach(pdev, gnt_ref, remote_evtchn);
	if (err)
		goto out;

	dev_dbg(&pdev->xdev->dev, "Connecting...\n");

	err = xenbus_switch_state(pdev->xdev, XenbusStateConnected);
	if (err)
		xenbus_dev_fatal(pdev->xdev, err,
				 "Error switching to connected state!");

	dev_dbg(&pdev->xdev->dev, "Connected? %d\n", err);
      out:
	spin_unlock(&pdev->dev_lock);

	if (magic)
		kfree(magic);

	return err;
}

static void pciback_frontend_changed(struct xenbus_device *xdev,
				     enum xenbus_state fe_state)
{
	struct pciback_device *pdev = xdev->dev.driver_data;

	dev_dbg(&xdev->dev, "fe state changed %d\n", fe_state);

	switch (fe_state) {
	case XenbusStateInitialised:
		pciback_attach(pdev);
		break;

	case XenbusStateClosing:
		xenbus_switch_state(xdev, XenbusStateClosing);
		break;

	case XenbusStateUnknown:
	case XenbusStateClosed:
		dev_dbg(&xdev->dev, "frontend is gone! unregister device\n");
		device_unregister(&xdev->dev);
		break;

	default:
		break;
	}
}

static int pciback_publish_pci_root(struct pciback_device *pdev,
				    unsigned int domain, unsigned int bus)
{
	unsigned int d, b;
	int i, root_num, len, err;
	char str[64];

	dev_dbg(&pdev->xdev->dev, "Publishing pci roots\n");

	err = xenbus_scanf(XBT_NIL, pdev->xdev->nodename,
			   "root_num", "%d", &root_num);
	if (err == 0 || err == -ENOENT)
		root_num = 0;
	else if (err < 0)
		goto out;

	/* Verify that we haven't already published this pci root */
	for (i = 0; i < root_num; i++) {
		len = snprintf(str, sizeof(str), "root-%d", i);
		if (unlikely(len >= (sizeof(str) - 1))) {
			err = -ENOMEM;
			goto out;
		}

		err = xenbus_scanf(XBT_NIL, pdev->xdev->nodename,
				   str, "%x:%x", &d, &b);
		if (err < 0)