/* maybe be called from bottom halves */
struct omx_xen_user_region *omx_xen_user_region_acquire(const struct
omx_endpoint *endpoint,
uint32_t rdma_id)
{
struct omx_xen_user_region *region;
dprintk_in();
if (unlikely(rdma_id >= OMX_USER_REGION_MAX)) {
printk_err("rdma_id = %#x\n", rdma_id);
goto out;
}
rcu_read_lock();
region = rcu_dereference(endpoint->xen_regions[rdma_id]);
if (unlikely(!region)) {
printk_err("region is NULL!!\n");
goto out_with_rcu_lock;
}
kref_get(®ion->refcount);
rcu_read_unlock();
dprintk_out();
return region;
out_with_rcu_lock:
rcu_read_unlock();
out:
dprintk_out();
return NULL;
}
struct omx_xen_page_cookie *omx_xen_page_get_cookie(omx_xenif_t * omx_xenif)
{
struct omx_xen_page_cookie *cookie;
dprintk_in();
#ifdef OMX_XEN_COOKIES
dprintk_deb("want an event cookie!\n");
if ((volatile int)(list_empty(&omx_xenif->page_cookies_free))) {
omx_xen_page_alloc(omx_xenif, 20);
}
// write_lock(&omx_xenif->page_cookies_freelock);
cookie = list_first_entry(&omx_xenif->page_cookies_free,
struct omx_xen_page_cookie, node);
if (!cookie) {
printk_err("Error\n");
goto out;
}
list_move_tail(&cookie->node, &omx_xenif->page_cookies_inuse);
// write_unlock(&omx_xenif->page_cookies_freelock);
dprintk_deb("got it, %#010lx\n", (unsigned long)cookie);
out:
#endif
dprintk_out();
return cookie;
}
/* Called when the last reference on the region is released */
void __omx_xen_user_region_last_release(struct kref *kref)
{
dprintk_in();
#if 0
struct omx_xen_user_region *region =
container_of(kref, struct omx_xen_user_region, refcount);
struct omx_endpoint *endpoint = region->endpoint;
dprintk_deb("releasing the last reference on region %p, %#x\n", region,
region->id);
/* FIXME, we can't release the segments region from the backend, we need to get
* a frontend kick first:S Hence, we just decrease the refcount... Really impressive huh? */
#if 0
if (region->nr_vmalloc_segments && in_interrupt()) {
OMX_INIT_WORK(®ion->destroy_work,
omx_region_destroy_workfunc, region);
schedule_work(®ion->destroy_work);
} else {
omx_user_region_destroy_segments(region);
kfree(region);
}
#endif
//printk(KERN_INFO "Will free now the specified region\n");
//#if 0
if (endpoint) {
omx_xen_user_region_destroy_segments(region, endpoint);
rcu_assign_pointer(endpoint->xen_regions[region->id], NULL);
}
kfree(region);
//#endif
#endif
dprintk_out();
}
static int omx_xenfront_uevent(struct xenbus_device *xdev,
struct kobj_uevent_env *env)
{
dprintk_in();
dprintk_out();
return 0;
}
void omx_xen_page_put_cookie(omx_xenif_t * omx_xenif,
struct omx_xen_page_cookie *cookie)
{
dprintk_in();
#ifdef OMX_XEN_COOKIES
//write_lock(&omx_xenif->page_cookies_freelock);
list_move_tail(&cookie->node, &omx_xenif->page_cookies_free);
//write_unlock(&omx_xenif->page_cookies_freelock);
#endif
dprintk_out();
}
int omx_xen_page_alloc(omx_xenif_t * omx_xenif, uint32_t count)
{
struct omx_xen_page_cookie *cookie;
struct page *page;
int err = 0, i;
#ifdef OMX_XEN_COOKIES
dprintk_in();
for (i = 0; i < count; i++) {
cookie =
kmalloc(sizeof(struct omx_xen_page_cookie), GFP_KERNEL);
if (!cookie) {
printk_err("cannot create cookie\n");
err = -ENOMEM;
goto out;
}
page = alloc_page(GFP_KERNEL);
if (!page) {
printk_err("cannot allocate page\n");
err = -ENOMEM;
goto out;
}
cookie->page = page;
// write_lock(&omx_xenif->page_cookies_freelock);
list_add_tail(&cookie->node, &omx_xenif->page_cookies_free);
// write_unlock(&omx_xenif->page_cookies_freelock);
dprintk_deb
("allocated, and appended to list, %#lx, page = %#lx\n",
(unsigned long)cookie, (unsigned long)page);
}
out:
dprintk_out();
#endif
return err;
}
static void omx_xenfront_backend_changed(struct xenbus_device *dev,
enum xenbus_state backend_state)
{
struct omx_xenfront_info *fe = dev_get_drvdata(&dev->dev);
int ret = 0;
dprintk_in();
dprintk_deb("backend state %s\n", xenbus_strstate(backend_state));
switch (backend_state) {
case XenbusStateInitialising:
case XenbusStateInitWait:
break;
case XenbusStateInitialised:
ret = talk_to_backend(dev, fe);
if (ret) {
printk_err("Error trying to talk to backend"
", ret=%d\n", ret);
//kfree(info);
}
break;
case XenbusStateReconfiguring:
case XenbusStateReconfigured:
case XenbusStateUnknown:
case XenbusStateClosed:
break;
case XenbusStateConnected:
if (dev->state == XenbusStateConnected)
break;
omx_xenfront_connect(fe);
break;
case XenbusStateClosing:
dprintk_deb("Closing Xenbus\n");
xenbus_frontend_closed(dev);
break;
}
dprintk_out();
return;
}
static int omx_xenfront_remove(struct xenbus_device *dev)
{
struct omx_xenfront_info *fe = dev_get_drvdata(&dev->dev);
dprintk_in();
dprintk_deb("frontend_remove: %s removed\n", dev->nodename);
/* This frees the page as a side-effect */
if (fe->ring_ref)
gnttab_end_foreign_access(fe->ring_ref, 0, (unsigned long)fe->ring.sring);
/* This frees the page as a side-effect */
if (fe->recv_ring_ref)
gnttab_end_foreign_access(fe->recv_ring_ref, 0, (unsigned long)fe->recv_ring.sring);
omx_xenif_free(fe, 0);
xenbus_switch_state(fe->xbdev, XenbusStateClosing);
dprintk_out();
return 0;
}
int omx_xen_destroy_user_region(omx_xenif_t * omx_xenif, uint32_t id,
uint32_t seqnum, uint8_t eid)
{
struct backend_info *be = omx_xenif->be;
struct omxback_dev *dev = be->omxdev;
struct omx_endpoint *endpoint = dev->endpoints[eid];
struct omx_xen_user_region *region;
int ret = 0;
dprintk_in();
TIMER_START(&t_destroy_reg);
if (eid >= 0 && eid < 255) {
endpoint = dev->endpoints[eid];
} else {
printk_err
("Wrong endpoint number (%u) check your frontend/backend communication!\n",
eid);
ret = -EINVAL;
goto out;
}
region = rcu_dereference_protected(endpoint->xen_regions[id], 1);
if (unlikely(!region)) {
printk_err(
"%s: Cannot access non-existing region %d\n", __func__, id);
//ret = -EINVAL;
goto out;
}
rcu_assign_pointer(endpoint->xen_regions[region->id], NULL);
//omx_xen_user_region_release(region);
kfree(region);
out:
TIMER_STOP(&t_destroy_reg);
dprintk_out();
return ret;
}
int
omx_event_delivery_check(void)
{
int ret = -ENOSYS;
dprintk_in();
if (omx_atomic_check((omx_eventq_index_t) 0) < 0)
goto out;
if (omx_atomic_check((omx_eventq_index_t) 1) < 0)
goto out;
if (omx_atomic_check((omx_eventq_index_t) -1) < 0)
goto out;
if (omx_atomic_check(((omx_eventq_index_t) -1)/2) < 0)
goto out;
if (omx_atomic_check(((omx_eventq_index_t) -1)/2 + 1) < 0)
goto out;
ret = 0;
out:
dprintk_out();
return ret;
}
static int
omx_atomic_check(omx_eventq_index_t input)
{
omx_eventq_index_t atomic = input;
omx_eventq_index_t output;
int ret = 0;
dprintk_in();
output = (omx_eventq_index_t) atomic_read((atomic_t *) &atomic);
if (output != input) {
printk("read of got %x instead of %x\n", (unsigned) output, (unsigned) input);
ret = -1;
goto out;
}
output = (omx_eventq_index_t) atomic_inc_return((atomic_t *) &atomic);
if (output != input + 1) {
printk("inc_return of got %x instead of %x\n", (unsigned) output, (unsigned) input+1);
ret = -1;
goto out;
}
atomic_dec((atomic_t *) &atomic);
atomic_dec((atomic_t *) &atomic);
output = (omx_eventq_index_t) atomic_read((atomic_t *) &atomic);
if (output != input - 1) {
printk("dec+read of got %x instead of %x\n", (unsigned) output, (unsigned) input);
ret = -1;
goto out;
}
out:
dprintk_out();
return ret;
}
int omx_xenfront_init(void)
{
int ret = 0;
dprintk_in();
if (!xen_domain() || xen_initial_domain()) {
ret = -ENODEV;
printk_err
("We are not running under Xen, or this "
"*is* a privileged domain\n");
goto out;
}
ret = xenbus_register_frontend(&omx_xenfront_driver);
if (ret) {
printk_err("XenBus Registration Failed\n");
goto out;
}
printk_inf("init\n");
out:
dprintk_out();
return ret;
}
int omx_xen_deregister_user_segment(omx_xenif_t * omx_xenif, uint32_t id,
uint32_t sid, uint8_t eid)
{
struct gnttab_unmap_grant_ref ops;
struct backend_info *be = omx_xenif->be;
struct omxback_dev *dev = be->omxdev;
struct omx_endpoint *endpoint = dev->endpoints[eid];
struct omx_xen_user_region *region;
struct omx_xen_user_region_segment *seg;
int i, k, ret = 0;
unsigned int level;
dprintk_in();
TIMER_START(&t_dereg_seg);
if (eid < 0 && eid >= 255) {
printk_err
("Wrong endpoint number (%u) check your frontend/backend communication!\n",
eid);
ret = -EINVAL;
goto out;
}
region = rcu_dereference_protected(endpoint->xen_regions[id], 1);
if (unlikely(!region)) {
printk_err(
"%s: Cannot access non-existing region %d\n", __func__, id);
//ret = -EINVAL;
goto out;
}
seg = ®ion->segments[sid];
TIMER_START(&t_release_grants);
if (!seg->unmap) {
printk_err("seg->unmap is NULL\n");
ret = -EINVAL;
goto out;
}
gnttab_unmap_refs(seg->unmap, NULL, seg->pages, seg->nr_pages);
TIMER_STOP(&t_release_grants);
TIMER_START(&t_release_gref_list);
for (k = 0; k < seg->nr_parts; k++) {
#ifdef EXTRA_DEBUG_OMX
if (!seg->vm_gref) {
printk(KERN_ERR "vm_gref is NULL\n");
ret = -EFAULT;
goto out;
}
if (!seg->vm_gref[k]) {
printk(KERN_ERR "vm_gref[%d] is NULL\n", k);
ret = -EFAULT;
goto out;
}
if (!seg->vm_gref[k]->addr) {
printk(KERN_ERR "vm_gref[%d]->addr is NULL\n", k);
ret = -EFAULT;
goto out;
}
if (!seg->all_handle[k]) {
printk(KERN_ERR "all_handle[%d] is NULL\n", k);
ret = -EINVAL;
goto out;
}
#endif
gnttab_set_unmap_op(&ops, (unsigned long)seg->vm_gref[k]->addr,
GNTMAP_host_map | GNTMAP_contains_pte,
seg->all_handle[k]);
ops.host_addr =
arbitrary_virt_to_machine(lookup_address
((unsigned long)(seg->vm_gref[k]->
addr),
&level)).maddr;
dprintk_deb("putting vm_area[%d] %#lx, handle = %#x \n", k,
(unsigned long)seg->vm_gref[k], seg->all_handle[k]);
if (HYPERVISOR_grant_table_op
(GNTTABOP_unmap_grant_ref, &ops, 1)){
printk_err
("HYPERVISOR operation failed\n");
//BUG();
}
if (ops.status) {
printk_err
("HYPERVISOR unmap grant ref[%d]=%#lx failed status = %d",
k, seg->all_handle[k], ops.status);
ret = ops.status;
goto out;
}
}
TIMER_STOP(&t_release_gref_list);
TIMER_START(&t_free_pages);
for (k=0;k<seg->nr_parts;k++)
if (ops.status == GNTST_okay)
free_vm_area(seg->vm_gref[k]);
kfree(seg->map);
kfree(seg->unmap);
kfree(seg->gref_list);
#ifdef OMX_XEN_COOKIES
omx_xen_page_put_cookie(omx_xenif, seg->cookie);
#else
free_xenballooned_pages(seg->nr_pages, seg->pages);
kfree(seg->pages);
#endif
TIMER_STOP(&t_free_pages);
out:
TIMER_STOP(&t_dereg_seg);
dprintk_out();
return ret;
}
static int omx_xen_accept_gref_list(omx_xenif_t * omx_xenif,
struct omx_xen_user_region_segment *seg,
uint32_t gref, void **vaddr, uint8_t part)
{
int ret = 0;
struct backend_info *be = omx_xenif->be;
struct vm_struct *area;
pte_t *pte;
struct gnttab_map_grant_ref ops = {
.flags = GNTMAP_host_map | GNTMAP_contains_pte,
//.flags = GNTMAP_host_map,
.ref = gref,
.dom = be->remoteDomain,
};
dprintk_in();
area = alloc_vm_area(PAGE_SIZE, &pte);
if (!area) {
ret = -ENOMEM;
goto out;
}
seg->vm_gref[part] = area;
ops.host_addr = arbitrary_virt_to_machine(pte).maddr;
if (HYPERVISOR_grant_table_op(GNTTABOP_map_grant_ref, &ops, 1)) {
printk_err("HYPERVISOR map grant ref failed");
ret = -ENOSYS;
goto out;
}
dprintk_deb("addr=%#lx, mfn=%#lx, kaddr=%#lx\n",
(unsigned long)area->addr, ops.dev_bus_addr >> PAGE_SHIFT,
ops.host_addr);
if (ops.status) {
printk_err("HYPERVISOR map grant ref failed status = %d",
ops.status);
ret = ops.status;
goto out;
}
dprintk_deb("gref_offset = %#x\n", seg->gref_offset);
*vaddr = (area->addr + seg->gref_offset);
ret = ops.handle;
#if 0
for (i = 0; i < (size + 2); i++) {
dprintk_deb("gref_list[%d] = %u\n", i,
*(((uint32_t *) * vaddr) + i));
}
#endif
seg->all_handle[part] = ops.handle;
dprintk_deb("vaddr = %p, area->addr=%p, handle[%d]=%d\n", vaddr,
area->addr, part, seg->all_handle[part]);
out:
dprintk_out();
return ret;
}
int omx_xen_register_user_segment(omx_xenif_t * omx_xenif,
struct omx_ring_msg_register_user_segment *req)
{
struct backend_info *be = omx_xenif->be;
void *vaddr = NULL;
uint32_t **gref_list;
struct page **page_list;
struct omxback_dev *omxdev = be->omxdev;
struct omx_endpoint *endpoint;
struct omx_xen_user_region *region;
struct omx_xen_user_region_segment *seg;
int ret = 0;
int i = 0, k = 0;
uint8_t eid, nr_parts;
uint16_t first_page_offset, gref_offset;
uint32_t sid, id, nr_grefs, nr_pages, length,
gref[OMX_XEN_GRANT_PAGES_MAX];
uint64_t domU_vaddr;
int idx = 0, sidx = 0;
struct gnttab_map_grant_ref *map;
struct gnttab_unmap_grant_ref *unmap;
dprintk_in();
TIMER_START(&t_reg_seg);
sid = req->sid;
id = req->rid;
eid = req->eid;
domU_vaddr = req->aligned_vaddr;
nr_grefs = req->nr_grefs;
nr_pages = req->nr_pages;
nr_parts = req->nr_parts;
length = req->length;
dprintk_deb("nr_parts = %#x\n", nr_parts);
for (k = 0; k < nr_parts; k++) {
gref[k] = req->gref[k];
dprintk_deb("printing gref = %lu\n", gref[k]);
}
gref_offset = req->gref_offset;
first_page_offset = req->first_page_offset;
endpoint = omxdev->endpoints[eid];
region = rcu_dereference_protected(endpoint->xen_regions[id], 1);
if (unlikely(!region)) {
printk_err(KERN_ERR "Cannot access non-existing region %d\n",
id);
ret = -EINVAL;
goto out;
}
dprintk_deb("Got region @%#lx id=%u\n", (unsigned long)region, id);
seg = ®ion->segments[sid];
if (unlikely(!seg)) {
printk(KERN_ERR "Cannot access non-existing segment %d\n", sid);
ret = -EINVAL;
goto out;
}
dprintk_deb("Got segment @%#lx id=%u\n", (unsigned long)seg, sid);
seg->gref_offset = gref_offset;
dprintk_deb
("Offset of actual list of grant references (in the frontend) = %#x\n",
gref_offset);
for (k = 0; k < nr_parts; k++) {
seg->all_gref[k] = gref[k];
dprintk_deb("grant reference for list of grefs = %#x\n",
gref[k]);
}
seg->nr_parts = nr_parts;
dprintk_deb("parts of gref list = %#x\n", nr_parts);
TIMER_START(&t_alloc_pages);
gref_list = kzalloc(sizeof(uint32_t *) * nr_parts, GFP_ATOMIC);
if (!gref_list) {
ret = -ENOMEM;
printk_err("gref list is NULL, ENOMEM!!!\n");
goto out;
}
map =
kzalloc(sizeof(struct gnttab_map_grant_ref) * nr_pages,
GFP_ATOMIC);
if (!map) {
ret = -ENOMEM;
printk_err(" map is NULL, ENOMEM!!!\n");
goto out;
}
unmap =
kzalloc(sizeof(struct gnttab_unmap_grant_ref) * nr_pages,
GFP_ATOMIC);
if (!unmap) {
ret = -ENOMEM;
printk_err(" unmap is NULL, ENOMEM!!!\n");
goto out;
}
#ifdef OMX_XEN_COOKIES
seg->cookie = omx_xen_page_get_cookie(omx_xenif, nr_pages);
if (!seg->cookie) {
printk_err("cannot get cookie\n");
goto out;
}
page_list = seg->cookie->pages;
#else
page_list = kzalloc(sizeof(struct page *) * nr_pages, GFP_ATOMIC);
if (!page_list) {
ret = -ENOMEM;
printk_err(" page list is NULL, ENOMEM!!!\n");
goto out;
}
ret = alloc_xenballooned_pages(nr_pages, page_list, false /* lowmem */);
if (ret) {
printk_err("cannot allocate xenballooned_pages\n");
goto out;
}
#endif
TIMER_STOP(&t_alloc_pages);
TIMER_START(&t_accept_gref_list);
for (k = 0; k < nr_parts; k++) {
ret =
omx_xen_accept_gref_list(omx_xenif, seg, gref[k], &vaddr,
k);
if (ret < 0) {
printk_err("Cannot accept gref list, = %d\n", ret);
goto out;
}
gref_list[k] = (uint32_t *) vaddr;
if (!gref_list) {
printk_err("gref_list is NULL!!!, = %p\n", gref_list);
ret = -ENOSYS;
goto out;
}
}
TIMER_STOP(&t_accept_gref_list);
seg->gref_list = gref_list;
seg->nr_pages = nr_pages;
seg->first_page_offset = first_page_offset;
i = 0;
idx = 0;
sidx = 0;
seg->map = map;
seg->unmap = unmap;
while (i < nr_pages) {
void *tmp_vaddr;
unsigned long addr = (unsigned long)pfn_to_kaddr(page_to_pfn(page_list[i]));
if (sidx % 256 == 0)
dprintk_deb("gref_list[%d][%d] = %#x\n", idx, sidx,
gref_list[idx][sidx]);
gnttab_set_map_op(&map[i], addr, GNTMAP_host_map,
gref_list[idx][sidx], be->remoteDomain);
gnttab_set_unmap_op(&unmap[i], addr, GNTMAP_host_map, -1 /* handle */ );
i++;
if ((unlikely(i % nr_grefs == 0))) {
idx++;
sidx = 0;
} else {
sidx++;
}
//printk(KERN_INFO "idx=%d, i=%d, sidx=%d\n", idx, i, sidx);
}
TIMER_START(&t_accept_grants);
ret = gnttab_map_refs(map, NULL, page_list, nr_pages);
if (ret) {
printk_err("Error mapping, ret= %d\n", ret);
goto out;
}
TIMER_STOP(&t_accept_grants);
for (i = 0; i < nr_pages; i++) {
if (map[i].status) {
ret = -EINVAL;
printk_err("idx %d, status =%d\n", i, map[i].status);
goto out;
}
else {
//BUG_ON(map->map_ops[i].handle == -1);
unmap[i].handle = map[i].handle;
dprintk_deb("map handle=%d\n", map[i].handle);
}
}
seg->pages = page_list;
seg->nr_pages = nr_pages;
seg->length = length;
region->total_length += length;
dprintk_deb("total_length = %#lx, nrpages=%lu, pages = %#lx\n",
region->total_length, seg->nr_pages,
(unsigned long)seg->pages);
goto all_ok;
out:
printk_err("error registering, try to debug MORE!!!!\n");
all_ok:
TIMER_STOP(&t_reg_seg);
dprintk_out();
return ret;
}
int omx_xen_create_user_region(omx_xenif_t * omx_xenif, uint32_t id,
uint64_t vaddr, uint32_t nr_segments,
uint32_t nr_pages, uint32_t nr_grefs,
uint8_t eid)
{
struct backend_info *be = omx_xenif->be;
struct omxback_dev *omxdev = be->omxdev;
struct omx_endpoint *endpoint = omxdev->endpoints[eid];
struct omx_xen_user_region *region;
int ret = 0;
dprintk_in();
TIMER_START(&t_create_reg);
//udelay(1000);
/* allocate the relevant region */
region =
kzalloc(sizeof(struct omx_xen_user_region) +
nr_segments * sizeof(struct omx_xen_user_region_segment),
GFP_KERNEL);
if (!region) {
printk_err
("No memory to allocate the region/segment buffers\n");
ret = -ENOMEM;
goto out;
}
/* init stuff needed :S */
kref_init(®ion->refcount);
region->total_length = 0;
region->nr_vmalloc_segments = 0;
region->total_registered_length = 0;
region->id = id;
region->nr_segments = nr_segments;
region->eid = eid;
region->endpoint = endpoint;
region->dirty = 0;
if (unlikely(rcu_access_pointer(endpoint->xen_regions[id]) != NULL)) {
printk(KERN_ERR "Cannot create busy region %d\n", id);
ret = -EBUSY;
goto out;
}
rcu_assign_pointer(endpoint->xen_regions[id], region);
out:
TIMER_STOP(&t_create_reg);
dprintk_out();
return ret;
}
/* Various region/segment handler functions */
void
omx_xen_user_region_destroy_segments(struct omx_xen_user_region *region,
struct omx_endpoint *endpoint)
{
int i;
dprintk_in();
if (!endpoint) {
printk_err("endpoint is null!!\n");
return;
}
for (i = 0; i < region->nr_segments; i++)
omx_xen_deregister_user_segment(endpoint->be->omx_xenif,
region->id, i,
endpoint->endpoint_index);
dprintk_out();
}
static int omx_xenfront_probe(struct xenbus_device *dev,
const struct xenbus_device_id *id)
{
struct omx_xenfront_info *fe;
struct omx_xenif_sring *sring, *recv_sring;
int err = 0;
int i = 0;
dprintk_in();
dprintk_deb("Frontend Probe Fired!\n");
fe = kzalloc(sizeof(*fe), GFP_KERNEL);
dprintk_deb("fe info is @%#llx!\n", (unsigned long long)fe);
if (!fe) {
xenbus_dev_fatal(dev, -ENOMEM, "allocating info structure");
err = -ENOMEM;
goto out;
}
__omx_xen_frontend = fe;
for (i = 0; i < OMX_XEN_MAX_ENDPOINTS; i++) {
fe->endpoints[i] = NULL;
}
fe->requests = kzalloc(OMX_MAX_INFLIGHT_REQUESTS * sizeof(enum frontend_status), GFP_KERNEL);
spin_lock_init(&fe->status_lock);
fe->xbdev = dev;
fe->connected = OMXIF_STATE_DISCONNECTED;
init_waitqueue_head(&fe->wq);
fe->msg_workq =
create_singlethread_workqueue("ReQ_FE");
if (unlikely(!fe->msg_workq)) {
printk_err("Couldn't create msg_workq!\n");
err = -ENOMEM;
goto out;
}
INIT_WORK(&fe->msg_workq_task, omx_xenif_interrupt);
spin_lock_init(&fe->lock);
dprintk_deb("Setting up shared ring\n");
sring =
(struct omx_xenif_sring *)get_zeroed_page(GFP_NOIO | __GFP_HIGH);
if (!sring) {
xenbus_dev_fatal(dev, -ENOMEM, "allocating shared ring");
err = -ENOMEM;
goto out;
}
SHARED_RING_INIT(sring);
FRONT_RING_INIT(&fe->ring, sring, PAGE_SIZE);
err = xenbus_grant_ring(dev, virt_to_mfn(fe->ring.sring));
if (err < 0) {
free_page((unsigned long)sring);
fe->ring.sring = NULL;
printk_err("Failed to grant ring\n");
goto out;
}
fe->ring_ref = err;
recv_sring =
(struct omx_xenif_sring *)get_zeroed_page(GFP_NOIO | __GFP_HIGH);
if (!sring) {
xenbus_dev_fatal(dev, -ENOMEM, "allocating shared ring");
err = -ENOMEM;
goto out;
}
SHARED_RING_INIT(recv_sring);
FRONT_RING_INIT(&fe->recv_ring, recv_sring, PAGE_SIZE);
err = xenbus_grant_ring(dev, virt_to_mfn(fe->recv_ring.sring));
if (err < 0) {
free_page((unsigned long)recv_sring);
fe->recv_ring.sring = NULL;
printk_err("Failed to grant recv_ring\n");
goto out;
}
fe->recv_ring_ref = err;
fe->handle = simple_strtoul(strrchr(dev->nodename, '/') + 1, NULL, 0);
dprintk_deb("setting handle = %u\n", fe->handle);
dev_set_drvdata(&dev->dev, fe);
err = 0;
//omx_xenfront_dev->info = info;
//fe->endpoints = kzalloc(sizeof(struct omx_endpoint*) * OMX_XEN_MAX_ENDPOINTS, GFP_KERNEL);
xenbus_switch_state(dev, XenbusStateInitialising);
out:
dprintk_out();
return err;
}
