2009-07-13 22:34:54 +00:00
|
|
|
/*
|
|
|
|
* Copyright (c) 2009, Microsoft Corporation.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along with
|
|
|
|
* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
|
|
|
|
* Place - Suite 330, Boston, MA 02111-1307 USA.
|
|
|
|
*
|
|
|
|
* Authors:
|
2009-11-23 17:00:22 +00:00
|
|
|
* Haiyang Zhang <haiyangz@microsoft.com>
|
2009-07-13 22:34:54 +00:00
|
|
|
* Hank Janssen <hjanssen@microsoft.com>
|
|
|
|
*/
|
2011-03-29 20:58:48 +00:00
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
|
2009-07-14 22:08:20 +00:00
|
|
|
#include <linux/kernel.h>
|
2011-02-11 17:59:43 +00:00
|
|
|
#include <linux/sched.h>
|
|
|
|
#include <linux/wait.h>
|
2009-07-15 18:06:01 +00:00
|
|
|
#include <linux/mm.h>
|
2009-07-16 18:50:41 +00:00
|
|
|
#include <linux/delay.h>
|
2009-09-02 17:33:05 +00:00
|
|
|
#include <linux/io.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 08:04:11 +00:00
|
|
|
#include <linux/slab.h>
|
2011-05-13 02:34:15 +00:00
|
|
|
|
|
|
|
#include "hyperv.h"
|
2011-05-13 02:34:37 +00:00
|
|
|
#include "hyperv_net.h"
|
2009-07-13 22:34:54 +00:00
|
|
|
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static struct netvsc_device *alloc_net_device(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
net_device = kzalloc(sizeof(struct netvsc_device), GFP_KERNEL);
|
|
|
|
if (!net_device)
|
2009-07-13 22:34:54 +00:00
|
|
|
return NULL;
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Set to 2 to allow both inbound and outbound traffic */
|
2010-12-10 20:03:59 +00:00
|
|
|
atomic_cmpxchg(&net_device->refcnt, 0, 2);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
net_device->dev = device;
|
2011-01-26 20:12:11 +00:00
|
|
|
device->ext = net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
return net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static void free_net_device(struct netvsc_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2011-02-18 23:05:53 +00:00
|
|
|
WARN_ON(atomic_read(&device->refcnt) != 0);
|
2011-01-26 20:12:11 +00:00
|
|
|
device->dev->ext = NULL;
|
2010-12-10 20:03:54 +00:00
|
|
|
kfree(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Get the net device object iff exists and its refcount > 1 */
|
2010-12-10 20:03:55 +00:00
|
|
|
static struct netvsc_device *get_outbound_net_device(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
net_device = device->ext;
|
2010-12-10 20:03:59 +00:00
|
|
|
if (net_device && atomic_read(&net_device->refcnt) > 1)
|
|
|
|
atomic_inc(&net_device->refcnt);
|
2009-07-13 22:34:54 +00:00
|
|
|
else
|
2010-12-10 20:03:54 +00:00
|
|
|
net_device = NULL;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
return net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Get the net device object iff exists and its refcount > 0 */
|
2010-12-10 20:03:55 +00:00
|
|
|
static struct netvsc_device *get_inbound_net_device(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
net_device = device->ext;
|
2010-12-10 20:03:59 +00:00
|
|
|
if (net_device && atomic_read(&net_device->refcnt))
|
|
|
|
atomic_inc(&net_device->refcnt);
|
2009-07-13 22:34:54 +00:00
|
|
|
else
|
2010-12-10 20:03:54 +00:00
|
|
|
net_device = NULL;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
return net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static void put_net_device(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
net_device = device->ext;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
atomic_dec(&net_device->refcnt);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static struct netvsc_device *release_outbound_net_device(
|
|
|
|
struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
net_device = device->ext;
|
2010-12-10 20:03:54 +00:00
|
|
|
if (net_device == NULL)
|
2009-07-13 22:34:54 +00:00
|
|
|
return NULL;
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Busy wait until the ref drop to 2, then set it to 1 */
|
2010-12-10 20:03:59 +00:00
|
|
|
while (atomic_cmpxchg(&net_device->refcnt, 2, 1) != 2)
|
2009-07-16 18:50:41 +00:00
|
|
|
udelay(100);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
return net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static struct netvsc_device *release_inbound_net_device(
|
|
|
|
struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
net_device = device->ext;
|
2010-12-10 20:03:54 +00:00
|
|
|
if (net_device == NULL)
|
2009-07-13 22:34:54 +00:00
|
|
|
return NULL;
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Busy wait until the ref drop to 1, then set it to 0 */
|
2010-12-10 20:03:59 +00:00
|
|
|
while (atomic_cmpxchg(&net_device->refcnt, 1, 0) != 1)
|
2009-07-16 18:50:41 +00:00
|
|
|
udelay(100);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
device->ext = NULL;
|
2010-12-10 20:03:54 +00:00
|
|
|
return net_device;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2011-04-21 19:30:43 +00:00
|
|
|
static int netvsc_destroy_recv_buf(struct netvsc_device *net_device)
|
|
|
|
{
|
|
|
|
struct nvsp_message *revoke_packet;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If we got a section count, it means we received a
|
|
|
|
* SendReceiveBufferComplete msg (ie sent
|
|
|
|
* NvspMessage1TypeSendReceiveBuffer msg) therefore, we need
|
|
|
|
* to send a revoke msg here
|
|
|
|
*/
|
|
|
|
if (net_device->recv_section_cnt) {
|
|
|
|
/* Send the revoke receive buffer */
|
|
|
|
revoke_packet = &net_device->revoke_packet;
|
|
|
|
memset(revoke_packet, 0, sizeof(struct nvsp_message));
|
|
|
|
|
|
|
|
revoke_packet->hdr.msg_type =
|
|
|
|
NVSP_MSG1_TYPE_REVOKE_RECV_BUF;
|
|
|
|
revoke_packet->msg.v1_msg.
|
|
|
|
revoke_recv_buf.id = NETVSC_RECEIVE_BUFFER_ID;
|
|
|
|
|
|
|
|
ret = vmbus_sendpacket(net_device->dev->channel,
|
|
|
|
revoke_packet,
|
|
|
|
sizeof(struct nvsp_message),
|
|
|
|
(unsigned long)revoke_packet,
|
|
|
|
VM_PKT_DATA_INBAND, 0);
|
|
|
|
/*
|
|
|
|
* If we failed here, we might as well return and
|
|
|
|
* have a leak rather than continue and a bugchk
|
|
|
|
*/
|
|
|
|
if (ret != 0) {
|
|
|
|
dev_err(&net_device->dev->device, "unable to send "
|
|
|
|
"revoke receive buffer to netvsp");
|
2011-08-25 16:49:12 +00:00
|
|
|
return ret;
|
2011-04-21 19:30:43 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Teardown the gpadl on the vsp end */
|
|
|
|
if (net_device->recv_buf_gpadl_handle) {
|
|
|
|
ret = vmbus_teardown_gpadl(net_device->dev->channel,
|
|
|
|
net_device->recv_buf_gpadl_handle);
|
|
|
|
|
|
|
|
/* If we failed here, we might as well return and have a leak
|
|
|
|
* rather than continue and a bugchk
|
|
|
|
*/
|
|
|
|
if (ret != 0) {
|
|
|
|
dev_err(&net_device->dev->device,
|
|
|
|
"unable to teardown receive buffer's gpadl");
|
2011-08-25 16:49:12 +00:00
|
|
|
return -ret;
|
2011-04-21 19:30:43 +00:00
|
|
|
}
|
|
|
|
net_device->recv_buf_gpadl_handle = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (net_device->recv_buf) {
|
|
|
|
/* Free up the receive buffer */
|
|
|
|
free_pages((unsigned long)net_device->recv_buf,
|
|
|
|
get_order(net_device->recv_buf_size));
|
|
|
|
net_device->recv_buf = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (net_device->recv_section) {
|
|
|
|
net_device->recv_section_cnt = 0;
|
|
|
|
kfree(net_device->recv_section);
|
|
|
|
net_device->recv_section = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static int netvsc_init_recv_buf(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2009-09-02 17:33:05 +00:00
|
|
|
int ret = 0;
|
2011-05-10 14:55:41 +00:00
|
|
|
int t;
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct nvsp_message *init_packet;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_outbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "unable to get net device..."
|
2009-09-02 17:33:05 +00:00
|
|
|
"device being destroyed?");
|
2011-08-25 16:49:13 +00:00
|
|
|
return -ENODEV;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
net_device->recv_buf =
|
2011-02-11 17:59:00 +00:00
|
|
|
(void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO,
|
|
|
|
get_order(net_device->recv_buf_size));
|
2010-12-10 20:03:59 +00:00
|
|
|
if (!net_device->recv_buf) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "unable to allocate receive "
|
|
|
|
"buffer of size %d", net_device->recv_buf_size);
|
2011-08-25 16:49:13 +00:00
|
|
|
ret = -ENOMEM;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/*
|
|
|
|
* Establish the gpadl handle for this buffer on this
|
|
|
|
* channel. Note: This call uses the vmbus connection rather
|
|
|
|
* than the channel to establish the gpadl handle.
|
|
|
|
*/
|
2010-12-10 20:03:59 +00:00
|
|
|
ret = vmbus_establish_gpadl(device->channel, net_device->recv_buf,
|
|
|
|
net_device->recv_buf_size,
|
|
|
|
&net_device->recv_buf_gpadl_handle);
|
2009-09-02 17:33:05 +00:00
|
|
|
if (ret != 0) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device,
|
|
|
|
"unable to establish receive buffer's gpadl");
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Notify the NetVsp of the gpadl handle */
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet = &net_device->channel_init_pkt;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
memset(init_packet, 0, sizeof(struct nvsp_message));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->hdr.msg_type = NVSP_MSG1_TYPE_SEND_RECV_BUF;
|
|
|
|
init_packet->msg.v1_msg.send_recv_buf.
|
|
|
|
gpadl_handle = net_device->recv_buf_gpadl_handle;
|
|
|
|
init_packet->msg.v1_msg.
|
|
|
|
send_recv_buf.id = NETVSC_RECEIVE_BUFFER_ID;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Send the gpadl notification request */
|
2010-12-10 20:03:54 +00:00
|
|
|
ret = vmbus_sendpacket(device->channel, init_packet,
|
2010-10-21 16:43:24 +00:00
|
|
|
sizeof(struct nvsp_message),
|
2010-12-10 20:03:54 +00:00
|
|
|
(unsigned long)init_packet,
|
2011-01-26 20:12:13 +00:00
|
|
|
VM_PKT_DATA_INBAND,
|
2010-10-21 16:43:24 +00:00
|
|
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
2009-09-02 17:33:05 +00:00
|
|
|
if (ret != 0) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device,
|
|
|
|
"unable to send receive buffer's gpadl to netvsp");
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2011-06-16 20:16:35 +00:00
|
|
|
t = wait_for_completion_timeout(&net_device->channel_init_wait, 5*HZ);
|
2011-05-10 14:55:41 +00:00
|
|
|
BUG_ON(t == 0);
|
2011-02-11 17:59:43 +00:00
|
|
|
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Check the response */
|
2010-12-10 20:03:59 +00:00
|
|
|
if (init_packet->msg.v1_msg.
|
|
|
|
send_recv_buf_complete.status != NVSP_STAT_SUCCESS) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Unable to complete receive buffer "
|
2009-09-02 17:33:05 +00:00
|
|
|
"initialzation with NetVsp - status %d",
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->msg.v1_msg.
|
|
|
|
send_recv_buf_complete.status);
|
2011-08-25 16:49:13 +00:00
|
|
|
ret = -EINVAL;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Parse the response */
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
net_device->recv_section_cnt = init_packet->msg.
|
|
|
|
v1_msg.send_recv_buf_complete.num_sections;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
net_device->recv_section = kmalloc(net_device->recv_section_cnt
|
2010-12-10 20:03:54 +00:00
|
|
|
* sizeof(struct nvsp_1_receive_buffer_section), GFP_KERNEL);
|
2010-12-10 20:03:59 +00:00
|
|
|
if (net_device->recv_section == NULL) {
|
2011-08-25 16:49:13 +00:00
|
|
|
ret = -EINVAL;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
memcpy(net_device->recv_section,
|
|
|
|
init_packet->msg.v1_msg.
|
|
|
|
send_recv_buf_complete.sections,
|
|
|
|
net_device->recv_section_cnt *
|
2010-12-10 20:03:54 +00:00
|
|
|
sizeof(struct nvsp_1_receive_buffer_section));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-09-02 17:33:05 +00:00
|
|
|
/*
|
|
|
|
* For 1st release, there should only be 1 section that represents the
|
|
|
|
* entire receive buffer
|
|
|
|
*/
|
2010-12-10 20:03:59 +00:00
|
|
|
if (net_device->recv_section_cnt != 1 ||
|
|
|
|
net_device->recv_section->offset != 0) {
|
2011-08-25 16:49:13 +00:00
|
|
|
ret = -EINVAL;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2011-02-11 17:59:43 +00:00
|
|
|
goto exit;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-02-11 17:59:43 +00:00
|
|
|
cleanup:
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_destroy_recv_buf(net_device);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-02-11 17:59:43 +00:00
|
|
|
exit:
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static int netvsc_connect_vsp(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2011-05-10 14:55:41 +00:00
|
|
|
int ret, t;
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct nvsp_message *init_packet;
|
|
|
|
int ndis_version;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_outbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "unable to get net device..."
|
2009-09-02 17:33:05 +00:00
|
|
|
"device being destroyed?");
|
2011-08-25 16:49:14 +00:00
|
|
|
return -ENODEV;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet = &net_device->channel_init_pkt;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
memset(init_packet, 0, sizeof(struct nvsp_message));
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->hdr.msg_type = NVSP_MSG_TYPE_INIT;
|
|
|
|
init_packet->msg.init_msg.init.min_protocol_ver =
|
2010-12-10 20:03:54 +00:00
|
|
|
NVSP_MIN_PROTOCOL_VERSION;
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->msg.init_msg.init.max_protocol_ver =
|
2010-12-10 20:03:54 +00:00
|
|
|
NVSP_MAX_PROTOCOL_VERSION;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Send the init request */
|
2010-12-10 20:03:54 +00:00
|
|
|
ret = vmbus_sendpacket(device->channel, init_packet,
|
2010-10-21 16:43:24 +00:00
|
|
|
sizeof(struct nvsp_message),
|
2010-12-10 20:03:54 +00:00
|
|
|
(unsigned long)init_packet,
|
2011-01-26 20:12:13 +00:00
|
|
|
VM_PKT_DATA_INBAND,
|
2010-10-21 16:43:24 +00:00
|
|
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
2009-09-02 17:33:05 +00:00
|
|
|
|
2011-03-29 20:58:45 +00:00
|
|
|
if (ret != 0)
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-06-16 20:16:35 +00:00
|
|
|
t = wait_for_completion_timeout(&net_device->channel_init_wait, 5*HZ);
|
2011-05-10 14:55:41 +00:00
|
|
|
|
|
|
|
if (t == 0) {
|
2011-02-11 17:59:43 +00:00
|
|
|
ret = -ETIMEDOUT;
|
|
|
|
goto cleanup;
|
|
|
|
}
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
if (init_packet->msg.init_msg.init_complete.status !=
|
|
|
|
NVSP_STAT_SUCCESS) {
|
2011-08-25 16:49:14 +00:00
|
|
|
ret = -EINVAL;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
if (init_packet->msg.init_msg.init_complete.
|
|
|
|
negotiated_protocol_ver != NVSP_PROTOCOL_VERSION_1) {
|
2011-08-25 16:49:14 +00:00
|
|
|
ret = -EPROTO;
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Send the ndis version */
|
2010-12-10 20:03:54 +00:00
|
|
|
memset(init_packet, 0, sizeof(struct nvsp_message));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
ndis_version = 0x00050000;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->hdr.msg_type = NVSP_MSG1_TYPE_SEND_NDIS_VER;
|
|
|
|
init_packet->msg.v1_msg.
|
|
|
|
send_ndis_ver.ndis_major_ver =
|
2010-12-10 20:03:54 +00:00
|
|
|
(ndis_version & 0xFFFF0000) >> 16;
|
2010-12-10 20:03:59 +00:00
|
|
|
init_packet->msg.v1_msg.
|
|
|
|
send_ndis_ver.ndis_minor_ver =
|
2010-12-10 20:03:54 +00:00
|
|
|
ndis_version & 0xFFFF;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Send the init request */
|
2010-12-10 20:03:54 +00:00
|
|
|
ret = vmbus_sendpacket(device->channel, init_packet,
|
2011-02-11 17:59:43 +00:00
|
|
|
sizeof(struct nvsp_message),
|
|
|
|
(unsigned long)init_packet,
|
|
|
|
VM_PKT_DATA_INBAND, 0);
|
2011-08-25 16:49:14 +00:00
|
|
|
if (ret != 0)
|
2011-02-11 17:59:43 +00:00
|
|
|
goto cleanup;
|
2009-07-27 20:47:24 +00:00
|
|
|
|
|
|
|
/* Post the big receive buffer to NetVSP */
|
2010-12-10 20:03:55 +00:00
|
|
|
ret = netvsc_init_recv_buf(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-02-11 17:59:43 +00:00
|
|
|
cleanup:
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2011-04-21 19:30:47 +00:00
|
|
|
static void netvsc_disconnect_vsp(struct netvsc_device *net_device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_destroy_recv_buf(net_device);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-03-04 22:11:00 +00:00
|
|
|
/*
|
2010-12-10 20:03:55 +00:00
|
|
|
* netvsc_device_remove - Callback when the root bus device is removed
|
2009-09-02 17:33:05 +00:00
|
|
|
*/
|
2011-05-10 14:54:54 +00:00
|
|
|
int netvsc_device_remove(struct hv_device *device)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct hv_netvsc_packet *netvsc_packet, *pos;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Stop outbound traffic ie sends and receives completions */
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = release_outbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "No net device present!!");
|
2011-08-25 16:49:15 +00:00
|
|
|
return -ENODEV;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Wait for all send completions */
|
2010-12-10 20:03:59 +00:00
|
|
|
while (atomic_read(&net_device->num_outstanding_sends)) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device,
|
|
|
|
"waiting for %d requests to complete...",
|
|
|
|
atomic_read(&net_device->num_outstanding_sends));
|
2009-07-16 18:50:41 +00:00
|
|
|
udelay(100);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2011-04-21 19:30:47 +00:00
|
|
|
netvsc_disconnect_vsp(net_device);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Stop inbound traffic ie receives and sends completions */
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = release_inbound_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* At this point, no one should be accessing netDevice except in here */
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_notice(&device->device, "net device safe to remove");
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Now, we can close the channel safely */
|
2010-12-10 20:03:54 +00:00
|
|
|
vmbus_close(device->channel);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Release all resources */
|
2010-12-10 20:03:54 +00:00
|
|
|
list_for_each_entry_safe(netvsc_packet, pos,
|
2010-12-10 20:03:59 +00:00
|
|
|
&net_device->recv_pkt_list, list_ent) {
|
2010-12-10 20:03:58 +00:00
|
|
|
list_del(&netvsc_packet->list_ent);
|
2010-12-10 20:03:54 +00:00
|
|
|
kfree(netvsc_packet);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
free_net_device(net_device);
|
2009-09-02 17:33:05 +00:00
|
|
|
return 0;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static void netvsc_send_completion(struct hv_device *device,
|
2010-12-10 20:03:54 +00:00
|
|
|
struct vmpacket_descriptor *packet)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct nvsp_message *nvsp_packet;
|
|
|
|
struct hv_netvsc_packet *nvsc_packet;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_inbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "unable to get net device..."
|
2009-09-02 17:33:05 +00:00
|
|
|
"device being destroyed?");
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
nvsp_packet = (struct nvsp_message *)((unsigned long)packet +
|
2011-01-26 20:12:13 +00:00
|
|
|
(packet->offset8 << 3));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
if ((nvsp_packet->hdr.msg_type == NVSP_MSG_TYPE_INIT_COMPLETE) ||
|
|
|
|
(nvsp_packet->hdr.msg_type ==
|
|
|
|
NVSP_MSG1_TYPE_SEND_RECV_BUF_COMPLETE) ||
|
|
|
|
(nvsp_packet->hdr.msg_type ==
|
|
|
|
NVSP_MSG1_TYPE_SEND_SEND_BUF_COMPLETE)) {
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Copy the response back */
|
2010-12-10 20:03:59 +00:00
|
|
|
memcpy(&net_device->channel_init_pkt, nvsp_packet,
|
2009-09-02 17:33:05 +00:00
|
|
|
sizeof(struct nvsp_message));
|
2011-05-10 14:55:41 +00:00
|
|
|
complete(&net_device->channel_init_wait);
|
2010-12-10 20:03:59 +00:00
|
|
|
} else if (nvsp_packet->hdr.msg_type ==
|
|
|
|
NVSP_MSG1_TYPE_SEND_RNDIS_PKT_COMPLETE) {
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Get the send context */
|
2010-12-10 20:03:54 +00:00
|
|
|
nvsc_packet = (struct hv_netvsc_packet *)(unsigned long)
|
2011-01-26 20:12:13 +00:00
|
|
|
packet->trans_id;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Notify the layer above us */
|
2010-12-10 20:03:58 +00:00
|
|
|
nvsc_packet->completion.send.send_completion(
|
|
|
|
nvsc_packet->completion.send.send_completion_ctx);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
atomic_dec(&net_device->num_outstanding_sends);
|
2009-09-02 17:33:05 +00:00
|
|
|
} else {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Unknown send completion packet type- "
|
2010-12-10 20:03:59 +00:00
|
|
|
"%d received!!", nvsp_packet->hdr.msg_type);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2011-05-13 02:34:49 +00:00
|
|
|
int netvsc_send(struct hv_device *device,
|
2010-12-10 20:03:54 +00:00
|
|
|
struct hv_netvsc_packet *packet)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
2009-09-02 17:33:05 +00:00
|
|
|
int ret = 0;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-08-28 23:20:53 +00:00
|
|
|
struct nvsp_message sendMessage;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_outbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "net device (%p) shutting down..."
|
2010-12-10 20:03:54 +00:00
|
|
|
"ignoring outbound packets", net_device);
|
2011-08-25 16:49:15 +00:00
|
|
|
return -ENODEV;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
sendMessage.hdr.msg_type = NVSP_MSG1_TYPE_SEND_RNDIS_PKT;
|
2010-12-10 20:03:58 +00:00
|
|
|
if (packet->is_data_pkt) {
|
2009-09-02 17:33:05 +00:00
|
|
|
/* 0 is RMC_DATA; */
|
2010-12-10 20:03:59 +00:00
|
|
|
sendMessage.msg.v1_msg.send_rndis_pkt.channel_type = 0;
|
2009-09-02 17:33:05 +00:00
|
|
|
} else {
|
|
|
|
/* 1 is RMC_CONTROL; */
|
2010-12-10 20:03:59 +00:00
|
|
|
sendMessage.msg.v1_msg.send_rndis_pkt.channel_type = 1;
|
2009-09-02 17:33:05 +00:00
|
|
|
}
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Not using send buffer section */
|
2010-12-10 20:03:59 +00:00
|
|
|
sendMessage.msg.v1_msg.send_rndis_pkt.send_buf_section_index =
|
|
|
|
0xFFFFFFFF;
|
|
|
|
sendMessage.msg.v1_msg.send_rndis_pkt.send_buf_section_size = 0;
|
2009-09-02 17:33:05 +00:00
|
|
|
|
2010-12-10 20:03:58 +00:00
|
|
|
if (packet->page_buf_cnt) {
|
2010-12-10 20:03:54 +00:00
|
|
|
ret = vmbus_sendpacket_pagebuffer(device->channel,
|
2010-12-10 20:03:58 +00:00
|
|
|
packet->page_buf,
|
|
|
|
packet->page_buf_cnt,
|
2010-10-21 16:32:46 +00:00
|
|
|
&sendMessage,
|
|
|
|
sizeof(struct nvsp_message),
|
2010-12-10 20:03:54 +00:00
|
|
|
(unsigned long)packet);
|
2009-09-02 17:33:05 +00:00
|
|
|
} else {
|
2010-12-10 20:03:54 +00:00
|
|
|
ret = vmbus_sendpacket(device->channel, &sendMessage,
|
2011-06-17 14:58:04 +00:00
|
|
|
sizeof(struct nvsp_message),
|
|
|
|
(unsigned long)packet,
|
|
|
|
VM_PKT_DATA_INBAND,
|
|
|
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret != 0)
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Unable to send packet %p ret %d",
|
2010-12-10 20:03:54 +00:00
|
|
|
packet, ret);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:59 +00:00
|
|
|
atomic_inc(&net_device->num_outstanding_sends);
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2011-04-21 19:30:42 +00:00
|
|
|
static void netvsc_send_recv_completion(struct hv_device *device,
|
|
|
|
u64 transaction_id)
|
|
|
|
{
|
|
|
|
struct nvsp_message recvcompMessage;
|
|
|
|
int retries = 0;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
recvcompMessage.hdr.msg_type =
|
|
|
|
NVSP_MSG1_TYPE_SEND_RNDIS_PKT_COMPLETE;
|
|
|
|
|
|
|
|
/* FIXME: Pass in the status */
|
|
|
|
recvcompMessage.msg.v1_msg.send_rndis_pkt_complete.status =
|
|
|
|
NVSP_STAT_SUCCESS;
|
|
|
|
|
|
|
|
retry_send_cmplt:
|
|
|
|
/* Send the completion */
|
|
|
|
ret = vmbus_sendpacket(device->channel, &recvcompMessage,
|
|
|
|
sizeof(struct nvsp_message), transaction_id,
|
|
|
|
VM_PKT_COMP, 0);
|
|
|
|
if (ret == 0) {
|
|
|
|
/* success */
|
|
|
|
/* no-op */
|
2011-08-25 16:48:58 +00:00
|
|
|
} else if (ret == -EAGAIN) {
|
2011-04-21 19:30:42 +00:00
|
|
|
/* no more room...wait a bit and attempt to retry 3 times */
|
|
|
|
retries++;
|
|
|
|
dev_err(&device->device, "unable to send receive completion pkt"
|
|
|
|
" (tid %llx)...retrying %d", transaction_id, retries);
|
|
|
|
|
|
|
|
if (retries < 4) {
|
|
|
|
udelay(100);
|
|
|
|
goto retry_send_cmplt;
|
|
|
|
} else {
|
|
|
|
dev_err(&device->device, "unable to send receive "
|
|
|
|
"completion pkt (tid %llx)...give up retrying",
|
|
|
|
transaction_id);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
dev_err(&device->device, "unable to send receive "
|
|
|
|
"completion pkt - %llx", transaction_id);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-04-21 19:30:41 +00:00
|
|
|
/* Send a receive completion packet to RNDIS device (ie NetVsp) */
|
|
|
|
static void netvsc_receive_completion(void *context)
|
|
|
|
{
|
|
|
|
struct hv_netvsc_packet *packet = context;
|
|
|
|
struct hv_device *device = (struct hv_device *)packet->device;
|
|
|
|
struct netvsc_device *net_device;
|
|
|
|
u64 transaction_id = 0;
|
|
|
|
bool fsend_receive_comp = false;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Even though it seems logical to do a GetOutboundNetDevice() here to
|
|
|
|
* send out receive completion, we are using GetInboundNetDevice()
|
|
|
|
* since we may have disable outbound traffic already.
|
|
|
|
*/
|
|
|
|
net_device = get_inbound_net_device(device);
|
|
|
|
if (!net_device) {
|
|
|
|
dev_err(&device->device, "unable to get net device..."
|
|
|
|
"device being destroyed?");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Overloading use of the lock. */
|
|
|
|
spin_lock_irqsave(&net_device->recv_pkt_list_lock, flags);
|
|
|
|
|
|
|
|
packet->xfer_page_pkt->count--;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Last one in the line that represent 1 xfer page packet.
|
|
|
|
* Return the xfer page packet itself to the freelist
|
|
|
|
*/
|
|
|
|
if (packet->xfer_page_pkt->count == 0) {
|
|
|
|
fsend_receive_comp = true;
|
|
|
|
transaction_id = packet->completion.recv.recv_completion_tid;
|
|
|
|
list_add_tail(&packet->xfer_page_pkt->list_ent,
|
|
|
|
&net_device->recv_pkt_list);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Put the packet back */
|
|
|
|
list_add_tail(&packet->list_ent, &net_device->recv_pkt_list);
|
|
|
|
spin_unlock_irqrestore(&net_device->recv_pkt_list_lock, flags);
|
|
|
|
|
|
|
|
/* Send a receive completion for the xfer page packet */
|
|
|
|
if (fsend_receive_comp)
|
|
|
|
netvsc_send_recv_completion(device, transaction_id);
|
|
|
|
|
|
|
|
put_net_device(device);
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static void netvsc_receive(struct hv_device *device,
|
2010-12-10 20:03:54 +00:00
|
|
|
struct vmpacket_descriptor *packet)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2010-12-10 20:03:54 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct vmtransfer_page_packet_header *vmxferpage_packet;
|
|
|
|
struct nvsp_message *nvsp_packet;
|
|
|
|
struct hv_netvsc_packet *netvsc_packet = NULL;
|
2009-07-14 22:12:46 +00:00
|
|
|
unsigned long start;
|
2010-12-10 20:03:54 +00:00
|
|
|
unsigned long end, end_virtual;
|
2009-08-27 22:58:15 +00:00
|
|
|
/* struct netvsc_driver *netvscDriver; */
|
2010-12-10 20:03:54 +00:00
|
|
|
struct xferpage_packet *xferpage_packet = NULL;
|
2009-09-02 17:33:05 +00:00
|
|
|
int i, j;
|
2010-12-10 20:03:54 +00:00
|
|
|
int count = 0, bytes_remain = 0;
|
2009-07-15 21:56:15 +00:00
|
|
|
unsigned long flags;
|
2011-04-26 16:20:22 +00:00
|
|
|
|
2009-09-12 01:46:43 +00:00
|
|
|
LIST_HEAD(listHead);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_inbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "unable to get net device..."
|
2009-09-02 17:33:05 +00:00
|
|
|
"device being destroyed?");
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2009-09-02 17:33:05 +00:00
|
|
|
/*
|
|
|
|
* All inbound packets other than send completion should be xfer page
|
|
|
|
* packet
|
|
|
|
*/
|
2011-01-26 20:12:13 +00:00
|
|
|
if (packet->type != VM_PKT_DATA_USING_XFER_PAGES) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Unknown packet type received - %d",
|
2011-01-26 20:12:13 +00:00
|
|
|
packet->type);
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
nvsp_packet = (struct nvsp_message *)((unsigned long)packet +
|
2011-01-26 20:12:13 +00:00
|
|
|
(packet->offset8 << 3));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Make sure this is a valid nvsp packet */
|
2010-12-10 20:03:59 +00:00
|
|
|
if (nvsp_packet->hdr.msg_type !=
|
|
|
|
NVSP_MSG1_TYPE_SEND_RNDIS_PKT) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Unknown nvsp packet type received-"
|
|
|
|
" %d", nvsp_packet->hdr.msg_type);
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
vmxferpage_packet = (struct vmtransfer_page_packet_header *)packet;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:13 +00:00
|
|
|
if (vmxferpage_packet->xfer_pageset_id != NETVSC_RECEIVE_BUFFER_ID) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Invalid xfer page set id - "
|
2009-09-02 17:33:05 +00:00
|
|
|
"expecting %x got %x", NETVSC_RECEIVE_BUFFER_ID,
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->xfer_pageset_id);
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/*
|
|
|
|
* Grab free packets (range count + 1) to represent this xfer
|
|
|
|
* page packet. +1 to represent the xfer page packet itself.
|
|
|
|
* We grab it here so that we know exactly how many we can
|
|
|
|
* fulfil
|
|
|
|
*/
|
2010-12-10 20:03:59 +00:00
|
|
|
spin_lock_irqsave(&net_device->recv_pkt_list_lock, flags);
|
|
|
|
while (!list_empty(&net_device->recv_pkt_list)) {
|
|
|
|
list_move_tail(net_device->recv_pkt_list.next, &listHead);
|
2011-01-26 20:12:13 +00:00
|
|
|
if (++count == vmxferpage_packet->range_cnt + 1)
|
2009-07-13 22:34:54 +00:00
|
|
|
break;
|
|
|
|
}
|
2010-12-10 20:03:59 +00:00
|
|
|
spin_unlock_irqrestore(&net_device->recv_pkt_list_lock, flags);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/*
|
|
|
|
* We need at least 2 netvsc pkts (1 to represent the xfer
|
|
|
|
* page and at least 1 for the range) i.e. we can handled
|
|
|
|
* some of the xfer page packet ranges...
|
|
|
|
*/
|
2009-09-02 17:33:05 +00:00
|
|
|
if (count < 2) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Got only %d netvsc pkt...needed "
|
|
|
|
"%d pkts. Dropping this xfer page packet completely!",
|
|
|
|
count, vmxferpage_packet->range_cnt + 1);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Return it to the freelist */
|
2010-12-10 20:03:59 +00:00
|
|
|
spin_lock_irqsave(&net_device->recv_pkt_list_lock, flags);
|
2009-09-02 17:33:05 +00:00
|
|
|
for (i = count; i != 0; i--) {
|
2009-10-28 22:23:37 +00:00
|
|
|
list_move_tail(listHead.next,
|
2010-12-10 20:03:59 +00:00
|
|
|
&net_device->recv_pkt_list);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
2010-12-10 20:03:59 +00:00
|
|
|
spin_unlock_irqrestore(&net_device->recv_pkt_list_lock,
|
2009-09-02 17:33:05 +00:00
|
|
|
flags);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_send_recv_completion(device,
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->d.trans_id);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Remove the 1st packet to represent the xfer page packet itself */
|
2010-12-10 20:03:54 +00:00
|
|
|
xferpage_packet = (struct xferpage_packet *)listHead.next;
|
2010-12-10 20:03:58 +00:00
|
|
|
list_del(&xferpage_packet->list_ent);
|
2009-09-12 01:46:43 +00:00
|
|
|
|
2009-09-02 17:33:05 +00:00
|
|
|
/* This is how much we can satisfy */
|
2010-12-10 20:03:58 +00:00
|
|
|
xferpage_packet->count = count - 1;
|
2009-09-02 17:33:05 +00:00
|
|
|
|
2011-01-26 20:12:13 +00:00
|
|
|
if (xferpage_packet->count != vmxferpage_packet->range_cnt) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "Needed %d netvsc pkts to satisy "
|
|
|
|
"this xfer page...got %d",
|
|
|
|
vmxferpage_packet->range_cnt, xferpage_packet->count);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Each range represents 1 RNDIS pkt that contains 1 ethernet frame */
|
2009-09-02 17:33:05 +00:00
|
|
|
for (i = 0; i < (count - 1); i++) {
|
2010-12-10 20:03:54 +00:00
|
|
|
netvsc_packet = (struct hv_netvsc_packet *)listHead.next;
|
2010-12-10 20:03:58 +00:00
|
|
|
list_del(&netvsc_packet->list_ent);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Initialize the netvsc packet */
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->xfer_page_pkt = xferpage_packet;
|
|
|
|
netvsc_packet->completion.recv.recv_completion =
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_receive_completion;
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->completion.recv.recv_completion_ctx =
|
2010-12-10 20:03:54 +00:00
|
|
|
netvsc_packet;
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->device = device;
|
2009-09-02 17:33:05 +00:00
|
|
|
/* Save this so that we can send it back */
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->completion.recv.recv_completion_tid =
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->d.trans_id;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->total_data_buflen =
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->ranges[i].byte_count;
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->page_buf_cnt = 1;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[0].len =
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->ranges[i].byte_count;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
start = virt_to_phys((void *)((unsigned long)net_device->
|
2011-01-26 20:12:13 +00:00
|
|
|
recv_buf + vmxferpage_packet->ranges[i].byte_offset));
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[0].pfn = start >> PAGE_SHIFT;
|
2010-12-10 20:03:59 +00:00
|
|
|
end_virtual = (unsigned long)net_device->recv_buf
|
2011-01-26 20:12:13 +00:00
|
|
|
+ vmxferpage_packet->ranges[i].byte_offset
|
|
|
|
+ vmxferpage_packet->ranges[i].byte_count - 1;
|
2010-12-10 20:03:54 +00:00
|
|
|
end = virt_to_phys((void *)end_virtual);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Calculate the page relative offset */
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[0].offset =
|
2011-01-26 20:12:13 +00:00
|
|
|
vmxferpage_packet->ranges[i].byte_offset &
|
2010-12-10 20:03:54 +00:00
|
|
|
(PAGE_SIZE - 1);
|
2009-09-02 17:33:05 +00:00
|
|
|
if ((end >> PAGE_SHIFT) != (start >> PAGE_SHIFT)) {
|
|
|
|
/* Handle frame across multiple pages: */
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[0].len =
|
|
|
|
(netvsc_packet->page_buf[0].pfn <<
|
2010-12-10 20:03:54 +00:00
|
|
|
PAGE_SHIFT)
|
2009-09-02 17:33:05 +00:00
|
|
|
+ PAGE_SIZE - start;
|
2010-12-10 20:03:58 +00:00
|
|
|
bytes_remain = netvsc_packet->total_data_buflen -
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[0].len;
|
2009-09-02 17:33:05 +00:00
|
|
|
for (j = 1; j < NETVSC_PACKET_MAXPAGE; j++) {
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[j].offset = 0;
|
2010-12-10 20:03:54 +00:00
|
|
|
if (bytes_remain <= PAGE_SIZE) {
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[j].len =
|
2010-12-10 20:03:54 +00:00
|
|
|
bytes_remain;
|
|
|
|
bytes_remain = 0;
|
2009-09-02 17:33:05 +00:00
|
|
|
} else {
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[j].len =
|
2010-12-10 20:03:54 +00:00
|
|
|
PAGE_SIZE;
|
|
|
|
bytes_remain -= PAGE_SIZE;
|
2009-09-02 17:33:05 +00:00
|
|
|
}
|
2011-01-26 20:12:11 +00:00
|
|
|
netvsc_packet->page_buf[j].pfn =
|
2010-12-10 20:03:54 +00:00
|
|
|
virt_to_phys((void *)(end_virtual -
|
|
|
|
bytes_remain)) >> PAGE_SHIFT;
|
2010-12-10 20:03:58 +00:00
|
|
|
netvsc_packet->page_buf_cnt++;
|
2010-12-10 20:03:54 +00:00
|
|
|
if (bytes_remain == 0)
|
2009-09-02 17:33:05 +00:00
|
|
|
break;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Pass it to the upper layer */
|
2011-05-13 02:34:58 +00:00
|
|
|
rndis_filter_receive(device, netvsc_packet);
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_receive_completion(netvsc_packet->
|
2010-12-10 20:03:58 +00:00
|
|
|
completion.recv.recv_completion_ctx);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
static void netvsc_channel_cb(void *context)
|
2009-07-13 22:34:54 +00:00
|
|
|
{
|
2009-09-02 17:33:05 +00:00
|
|
|
int ret;
|
2010-12-10 20:03:54 +00:00
|
|
|
struct hv_device *device = context;
|
|
|
|
struct netvsc_device *net_device;
|
|
|
|
u32 bytes_recvd;
|
|
|
|
u64 request_id;
|
2010-04-27 20:23:47 +00:00
|
|
|
unsigned char *packet;
|
2009-08-27 23:02:36 +00:00
|
|
|
struct vmpacket_descriptor *desc;
|
2010-04-27 20:23:47 +00:00
|
|
|
unsigned char *buffer;
|
|
|
|
int bufferlen = NETVSC_PACKET_SIZE;
|
2009-07-13 22:34:54 +00:00
|
|
|
|
2010-04-27 20:23:47 +00:00
|
|
|
packet = kzalloc(NETVSC_PACKET_SIZE * sizeof(unsigned char),
|
2010-12-17 09:40:24 +00:00
|
|
|
GFP_ATOMIC);
|
2010-04-27 20:23:47 +00:00
|
|
|
if (!packet)
|
|
|
|
return;
|
|
|
|
buffer = packet;
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
net_device = get_inbound_net_device(device);
|
2010-12-10 20:03:54 +00:00
|
|
|
if (!net_device) {
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device, "net device (%p) shutting down..."
|
2010-12-10 20:03:54 +00:00
|
|
|
"ignoring inbound packets", net_device);
|
2010-04-27 20:23:47 +00:00
|
|
|
goto out;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-09-02 17:33:05 +00:00
|
|
|
do {
|
2010-10-21 16:09:48 +00:00
|
|
|
ret = vmbus_recvpacket_raw(device->channel, buffer, bufferlen,
|
2010-12-10 20:03:54 +00:00
|
|
|
&bytes_recvd, &request_id);
|
2009-09-02 17:33:05 +00:00
|
|
|
if (ret == 0) {
|
2010-12-10 20:03:54 +00:00
|
|
|
if (bytes_recvd > 0) {
|
2009-09-02 17:33:05 +00:00
|
|
|
desc = (struct vmpacket_descriptor *)buffer;
|
2011-01-26 20:12:13 +00:00
|
|
|
switch (desc->type) {
|
|
|
|
case VM_PKT_COMP:
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_send_completion(device, desc);
|
2009-09-02 17:33:05 +00:00
|
|
|
break;
|
|
|
|
|
2011-01-26 20:12:13 +00:00
|
|
|
case VM_PKT_DATA_USING_XFER_PAGES:
|
2010-12-10 20:03:55 +00:00
|
|
|
netvsc_receive(device, desc);
|
2009-09-02 17:33:05 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device,
|
2009-09-02 17:33:05 +00:00
|
|
|
"unhandled packet type %d, "
|
|
|
|
"tid %llx len %d\n",
|
2011-01-26 20:12:13 +00:00
|
|
|
desc->type, request_id,
|
2010-12-10 20:03:54 +00:00
|
|
|
bytes_recvd);
|
2009-09-02 17:33:05 +00:00
|
|
|
break;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
2009-07-27 20:47:24 +00:00
|
|
|
/* reset */
|
2010-04-27 20:23:47 +00:00
|
|
|
if (bufferlen > NETVSC_PACKET_SIZE) {
|
2009-07-15 19:48:29 +00:00
|
|
|
kfree(buffer);
|
2009-07-13 22:34:54 +00:00
|
|
|
buffer = packet;
|
2010-04-27 20:23:47 +00:00
|
|
|
bufferlen = NETVSC_PACKET_SIZE;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
2009-09-02 17:33:05 +00:00
|
|
|
} else {
|
2009-07-27 20:47:24 +00:00
|
|
|
/* reset */
|
2010-04-27 20:23:47 +00:00
|
|
|
if (bufferlen > NETVSC_PACKET_SIZE) {
|
2009-07-15 19:48:29 +00:00
|
|
|
kfree(buffer);
|
2009-07-13 22:34:54 +00:00
|
|
|
buffer = packet;
|
2010-04-27 20:23:47 +00:00
|
|
|
bufferlen = NETVSC_PACKET_SIZE;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
break;
|
|
|
|
}
|
2011-08-25 16:48:59 +00:00
|
|
|
} else if (ret == -ENOBUFS) {
|
2009-09-02 17:33:05 +00:00
|
|
|
/* Handle large packet */
|
2010-12-10 20:03:54 +00:00
|
|
|
buffer = kmalloc(bytes_recvd, GFP_ATOMIC);
|
2009-09-02 17:33:05 +00:00
|
|
|
if (buffer == NULL) {
|
2009-07-27 20:47:24 +00:00
|
|
|
/* Try again next time around */
|
2011-03-29 20:58:48 +00:00
|
|
|
dev_err(&device->device,
|
2009-09-02 17:33:05 +00:00
|
|
|
"unable to allocate buffer of size "
|
2010-12-10 20:03:54 +00:00
|
|
|
"(%d)!!", bytes_recvd);
|
2009-07-13 22:34:54 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2010-12-10 20:03:54 +00:00
|
|
|
bufferlen = bytes_recvd;
|
2009-07-13 22:34:54 +00:00
|
|
|
}
|
|
|
|
} while (1);
|
|
|
|
|
2010-12-10 20:03:55 +00:00
|
|
|
put_net_device(device);
|
2010-04-27 20:23:47 +00:00
|
|
|
out:
|
|
|
|
kfree(buffer);
|
2009-07-13 22:34:54 +00:00
|
|
|
return;
|
|
|
|
}
|
2011-04-21 19:30:40 +00:00
|
|
|
|
2011-04-21 19:30:45 +00:00
|
|
|
/*
|
|
|
|
* netvsc_device_add - Callback when the device belonging to this
|
|
|
|
* driver is added
|
|
|
|
*/
|
2011-05-10 14:54:53 +00:00
|
|
|
int netvsc_device_add(struct hv_device *device, void *additional_info)
|
2011-04-21 19:30:45 +00:00
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
int i;
|
2011-05-13 02:35:05 +00:00
|
|
|
int ring_size =
|
|
|
|
((struct netvsc_device_info *)additional_info)->ring_size;
|
2011-04-21 19:30:45 +00:00
|
|
|
struct netvsc_device *net_device;
|
|
|
|
struct hv_netvsc_packet *packet, *pos;
|
|
|
|
|
|
|
|
net_device = alloc_net_device(device);
|
|
|
|
if (!net_device) {
|
|
|
|
ret = -1;
|
|
|
|
goto cleanup;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialize the NetVSC channel extension */
|
|
|
|
net_device->recv_buf_size = NETVSC_RECEIVE_BUFFER_SIZE;
|
|
|
|
spin_lock_init(&net_device->recv_pkt_list_lock);
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&net_device->recv_pkt_list);
|
|
|
|
|
|
|
|
for (i = 0; i < NETVSC_RECEIVE_PACKETLIST_COUNT; i++) {
|
|
|
|
packet = kzalloc(sizeof(struct hv_netvsc_packet) +
|
|
|
|
(NETVSC_RECEIVE_SG_COUNT *
|
|
|
|
sizeof(struct hv_page_buffer)), GFP_KERNEL);
|
|
|
|
if (!packet)
|
|
|
|
break;
|
|
|
|
|
|
|
|
list_add_tail(&packet->list_ent,
|
|
|
|
&net_device->recv_pkt_list);
|
|
|
|
}
|
2011-05-10 14:55:41 +00:00
|
|
|
init_completion(&net_device->channel_init_wait);
|
2011-04-21 19:30:45 +00:00
|
|
|
|
|
|
|
/* Open the channel */
|
2011-05-13 02:35:05 +00:00
|
|
|
ret = vmbus_open(device->channel, ring_size * PAGE_SIZE,
|
|
|
|
ring_size * PAGE_SIZE, NULL, 0,
|
2011-04-21 19:30:45 +00:00
|
|
|
netvsc_channel_cb, device);
|
|
|
|
|
|
|
|
if (ret != 0) {
|
|
|
|
dev_err(&device->device, "unable to open channel: %d", ret);
|
|
|
|
ret = -1;
|
|
|
|
goto cleanup;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Channel is opened */
|
|
|
|
pr_info("hv_netvsc channel opened successfully");
|
|
|
|
|
|
|
|
/* Connect with the NetVsp */
|
|
|
|
ret = netvsc_connect_vsp(device);
|
|
|
|
if (ret != 0) {
|
|
|
|
dev_err(&device->device,
|
|
|
|
"unable to connect to NetVSP - %d", ret);
|
|
|
|
ret = -1;
|
|
|
|
goto close;
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
close:
|
|
|
|
/* Now, we can close the channel safely */
|
|
|
|
vmbus_close(device->channel);
|
|
|
|
|
|
|
|
cleanup:
|
|
|
|
|
|
|
|
if (net_device) {
|
|
|
|
list_for_each_entry_safe(packet, pos,
|
|
|
|
&net_device->recv_pkt_list,
|
|
|
|
list_ent) {
|
|
|
|
list_del(&packet->list_ent);
|
|
|
|
kfree(packet);
|
|
|
|
}
|
|
|
|
|
|
|
|
release_outbound_net_device(device);
|
|
|
|
release_inbound_net_device(device);
|
|
|
|
|
|
|
|
free_net_device(net_device);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|