Commit | Line | Data |
---|---|---|
fceaf24a | 1 | /* |
fceaf24a HJ |
2 | * Copyright (c) 2009, Microsoft Corporation. |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify it | |
5 | * under the terms and conditions of the GNU General Public License, | |
6 | * version 2, as published by the Free Software Foundation. | |
7 | * | |
8 | * This program is distributed in the hope it will be useful, but WITHOUT | |
9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
11 | * more details. | |
12 | * | |
13 | * You should have received a copy of the GNU General Public License along with | |
14 | * this program; if not, write to the Free Software Foundation, Inc., 59 Temple | |
15 | * Place - Suite 330, Boston, MA 02111-1307 USA. | |
16 | * | |
17 | * Authors: | |
18 | * Haiyang Zhang <haiyangz@microsoft.com> | |
19 | * Hank Janssen <hjanssen@microsoft.com> | |
fceaf24a | 20 | */ |
5654e932 | 21 | #include <linux/kernel.h> |
45da89e5 | 22 | #include <linux/highmem.h> |
5a0e3ad6 | 23 | #include <linux/slab.h> |
0120ee0d | 24 | #include <linux/io.h> |
9f8bd8ba SH |
25 | #include <linux/if_ether.h> |
26 | ||
4983b39a | 27 | #include "osd.h" |
645954c5 | 28 | #include "logging.h" |
a82c7a2a | 29 | #include "netvsc_api.h" |
043efcc3 | 30 | #include "rndis_filter.h" |
fceaf24a | 31 | |
454f18a9 | 32 | /* Data types */ |
e681b954 | 33 | struct rndis_filter_driver_object { |
454f18a9 | 34 | /* The original driver */ |
7e23a6e9 | 35 | struct netvsc_driver InnerDriver; |
e681b954 | 36 | }; |
fceaf24a | 37 | |
e681b954 | 38 | enum rndis_device_state { |
fceaf24a HJ |
39 | RNDIS_DEV_UNINITIALIZED = 0, |
40 | RNDIS_DEV_INITIALIZING, | |
41 | RNDIS_DEV_INITIALIZED, | |
42 | RNDIS_DEV_DATAINITIALIZED, | |
e681b954 | 43 | }; |
fceaf24a | 44 | |
e681b954 | 45 | struct rndis_device { |
ce9ea4cf | 46 | struct netvsc_device *NetDevice; |
fceaf24a | 47 | |
e681b954 | 48 | enum rndis_device_state State; |
0120ee0d | 49 | u32 LinkStatus; |
f4888417 | 50 | atomic_t NewRequestId; |
fceaf24a | 51 | |
880fb89c | 52 | spinlock_t request_lock; |
1f5459bc | 53 | struct list_head RequestList; |
fceaf24a | 54 | |
9f8bd8ba | 55 | unsigned char HwMacAddr[ETH_ALEN]; |
e681b954 | 56 | }; |
fceaf24a | 57 | |
e681b954 | 58 | struct rndis_request { |
1f5459bc | 59 | struct list_head ListEntry; |
aedb444a | 60 | struct osd_waitevent *WaitEvent; |
fceaf24a | 61 | |
0120ee0d GKH |
62 | /* |
63 | * FIXME: We assumed a fixed size response here. If we do ever need to | |
64 | * handle a bigger response, we can either define a max response | |
65 | * message or add a response buffer variable above this field | |
66 | */ | |
9f33d054 | 67 | struct rndis_message ResponseMessage; |
fceaf24a | 68 | |
454f18a9 | 69 | /* Simplify allocation by having a netvsc packet inline */ |
4193d4f4 | 70 | struct hv_netvsc_packet Packet; |
ee3d7ddf | 71 | struct hv_page_buffer Buffer; |
454f18a9 | 72 | /* FIXME: We assumed a fixed size request here. */ |
9f33d054 | 73 | struct rndis_message RequestMessage; |
e681b954 | 74 | }; |
fceaf24a HJ |
75 | |
76 | ||
e681b954 | 77 | struct rndis_filter_packet { |
0120ee0d | 78 | void *CompletionContext; |
211ccd6e | 79 | void (*OnCompletion)(void *context); |
9f33d054 | 80 | struct rndis_message Message; |
e681b954 | 81 | }; |
fceaf24a | 82 | |
454f18a9 | 83 | |
0120ee0d GKH |
84 | static int RndisFilterOnDeviceAdd(struct hv_device *Device, |
85 | void *AdditionalInfo); | |
454f18a9 | 86 | |
0120ee0d | 87 | static int RndisFilterOnDeviceRemove(struct hv_device *Device); |
fceaf24a | 88 | |
0120ee0d | 89 | static void RndisFilterOnCleanup(struct hv_driver *Driver); |
fceaf24a | 90 | |
0120ee0d GKH |
91 | static int RndisFilterOnSend(struct hv_device *Device, |
92 | struct hv_netvsc_packet *Packet); | |
93 | ||
94 | static void RndisFilterOnSendCompletion(void *Context); | |
95 | ||
96 | static void RndisFilterOnSendRequestCompletion(void *Context); | |
454f18a9 BP |
97 | |
98 | ||
99 | /* The one and only */ | |
e681b954 | 100 | static struct rndis_filter_driver_object gRndisFilter; |
fceaf24a | 101 | |
0120ee0d | 102 | static struct rndis_device *GetRndisDevice(void) |
fceaf24a | 103 | { |
e681b954 | 104 | struct rndis_device *device; |
fceaf24a | 105 | |
e681b954 | 106 | device = kzalloc(sizeof(struct rndis_device), GFP_KERNEL); |
fceaf24a | 107 | if (!device) |
fceaf24a | 108 | return NULL; |
fceaf24a | 109 | |
880fb89c | 110 | spin_lock_init(&device->request_lock); |
fceaf24a | 111 | |
1f5459bc | 112 | INIT_LIST_HEAD(&device->RequestList); |
fceaf24a HJ |
113 | |
114 | device->State = RNDIS_DEV_UNINITIALIZED; | |
115 | ||
116 | return device; | |
117 | } | |
118 | ||
0120ee0d GKH |
119 | static struct rndis_request *GetRndisRequest(struct rndis_device *Device, |
120 | u32 MessageType, | |
121 | u32 MessageLength) | |
fceaf24a | 122 | { |
e681b954 | 123 | struct rndis_request *request; |
9f33d054 GKH |
124 | struct rndis_message *rndisMessage; |
125 | struct rndis_set_request *set; | |
880fb89c | 126 | unsigned long flags; |
fceaf24a | 127 | |
e681b954 | 128 | request = kzalloc(sizeof(struct rndis_request), GFP_KERNEL); |
fceaf24a | 129 | if (!request) |
fceaf24a | 130 | return NULL; |
fceaf24a | 131 | |
bfc30aae | 132 | request->WaitEvent = osd_WaitEventCreate(); |
0120ee0d | 133 | if (!request->WaitEvent) { |
8c69f52a | 134 | kfree(request); |
fceaf24a HJ |
135 | return NULL; |
136 | } | |
137 | ||
138 | rndisMessage = &request->RequestMessage; | |
139 | rndisMessage->NdisMessageType = MessageType; | |
140 | rndisMessage->MessageLength = MessageLength; | |
141 | ||
0120ee0d GKH |
142 | /* |
143 | * Set the request id. This field is always after the rndis header for | |
144 | * request/response packet types so we just used the SetRequest as a | |
145 | * template | |
146 | */ | |
fceaf24a | 147 | set = &rndisMessage->Message.SetRequest; |
f4888417 | 148 | set->RequestId = atomic_inc_return(&Device->NewRequestId); |
fceaf24a | 149 | |
454f18a9 | 150 | /* Add to the request list */ |
880fb89c | 151 | spin_lock_irqsave(&Device->request_lock, flags); |
1f5459bc | 152 | list_add_tail(&request->ListEntry, &Device->RequestList); |
880fb89c | 153 | spin_unlock_irqrestore(&Device->request_lock, flags); |
fceaf24a HJ |
154 | |
155 | return request; | |
156 | } | |
157 | ||
0120ee0d GKH |
158 | static void PutRndisRequest(struct rndis_device *Device, |
159 | struct rndis_request *Request) | |
fceaf24a | 160 | { |
880fb89c GKH |
161 | unsigned long flags; |
162 | ||
163 | spin_lock_irqsave(&Device->request_lock, flags); | |
1f5459bc | 164 | list_del(&Request->ListEntry); |
880fb89c | 165 | spin_unlock_irqrestore(&Device->request_lock, flags); |
fceaf24a | 166 | |
420beac4 | 167 | kfree(Request->WaitEvent); |
8c69f52a | 168 | kfree(Request); |
fceaf24a HJ |
169 | } |
170 | ||
0120ee0d | 171 | static void DumpRndisMessage(struct rndis_message *RndisMessage) |
fceaf24a | 172 | { |
0120ee0d | 173 | switch (RndisMessage->NdisMessageType) { |
fceaf24a | 174 | case REMOTE_NDIS_PACKET_MSG: |
0120ee0d GKH |
175 | DPRINT_DBG(NETVSC, "REMOTE_NDIS_PACKET_MSG (len %u, " |
176 | "data offset %u data len %u, # oob %u, " | |
177 | "oob offset %u, oob len %u, pkt offset %u, " | |
178 | "pkt len %u", | |
179 | RndisMessage->MessageLength, | |
180 | RndisMessage->Message.Packet.DataOffset, | |
181 | RndisMessage->Message.Packet.DataLength, | |
182 | RndisMessage->Message.Packet.NumOOBDataElements, | |
183 | RndisMessage->Message.Packet.OOBDataOffset, | |
184 | RndisMessage->Message.Packet.OOBDataLength, | |
185 | RndisMessage->Message.Packet.PerPacketInfoOffset, | |
186 | RndisMessage->Message.Packet.PerPacketInfoLength); | |
fceaf24a HJ |
187 | break; |
188 | ||
189 | case REMOTE_NDIS_INITIALIZE_CMPLT: | |
0120ee0d GKH |
190 | DPRINT_DBG(NETVSC, "REMOTE_NDIS_INITIALIZE_CMPLT " |
191 | "(len %u, id 0x%x, status 0x%x, major %d, minor %d, " | |
192 | "device flags %d, max xfer size 0x%x, max pkts %u, " | |
193 | "pkt aligned %u)", | |
fceaf24a HJ |
194 | RndisMessage->MessageLength, |
195 | RndisMessage->Message.InitializeComplete.RequestId, | |
196 | RndisMessage->Message.InitializeComplete.Status, | |
197 | RndisMessage->Message.InitializeComplete.MajorVersion, | |
198 | RndisMessage->Message.InitializeComplete.MinorVersion, | |
199 | RndisMessage->Message.InitializeComplete.DeviceFlags, | |
200 | RndisMessage->Message.InitializeComplete.MaxTransferSize, | |
201 | RndisMessage->Message.InitializeComplete.MaxPacketsPerMessage, | |
202 | RndisMessage->Message.InitializeComplete.PacketAlignmentFactor); | |
203 | break; | |
204 | ||
205 | case REMOTE_NDIS_QUERY_CMPLT: | |
0120ee0d GKH |
206 | DPRINT_DBG(NETVSC, "REMOTE_NDIS_QUERY_CMPLT " |
207 | "(len %u, id 0x%x, status 0x%x, buf len %u, " | |
208 | "buf offset %u)", | |
fceaf24a HJ |
209 | RndisMessage->MessageLength, |
210 | RndisMessage->Message.QueryComplete.RequestId, | |
211 | RndisMessage->Message.QueryComplete.Status, | |
212 | RndisMessage->Message.QueryComplete.InformationBufferLength, | |
213 | RndisMessage->Message.QueryComplete.InformationBufferOffset); | |
214 | break; | |
215 | ||
216 | case REMOTE_NDIS_SET_CMPLT: | |
0120ee0d GKH |
217 | DPRINT_DBG(NETVSC, |
218 | "REMOTE_NDIS_SET_CMPLT (len %u, id 0x%x, status 0x%x)", | |
fceaf24a HJ |
219 | RndisMessage->MessageLength, |
220 | RndisMessage->Message.SetComplete.RequestId, | |
221 | RndisMessage->Message.SetComplete.Status); | |
222 | break; | |
223 | ||
224 | case REMOTE_NDIS_INDICATE_STATUS_MSG: | |
0120ee0d GKH |
225 | DPRINT_DBG(NETVSC, "REMOTE_NDIS_INDICATE_STATUS_MSG " |
226 | "(len %u, status 0x%x, buf len %u, buf offset %u)", | |
fceaf24a HJ |
227 | RndisMessage->MessageLength, |
228 | RndisMessage->Message.IndicateStatus.Status, | |
229 | RndisMessage->Message.IndicateStatus.StatusBufferLength, | |
230 | RndisMessage->Message.IndicateStatus.StatusBufferOffset); | |
231 | break; | |
232 | ||
233 | default: | |
234 | DPRINT_DBG(NETVSC, "0x%x (len %u)", | |
235 | RndisMessage->NdisMessageType, | |
236 | RndisMessage->MessageLength); | |
237 | break; | |
238 | } | |
239 | } | |
240 | ||
0120ee0d GKH |
241 | static int RndisFilterSendRequest(struct rndis_device *Device, |
242 | struct rndis_request *Request) | |
fceaf24a | 243 | { |
0120ee0d | 244 | int ret; |
4193d4f4 | 245 | struct hv_netvsc_packet *packet; |
fceaf24a HJ |
246 | |
247 | DPRINT_ENTER(NETVSC); | |
248 | ||
454f18a9 | 249 | /* Setup the packet to send it */ |
fceaf24a HJ |
250 | packet = &Request->Packet; |
251 | ||
0e727613 | 252 | packet->IsDataPacket = false; |
fceaf24a HJ |
253 | packet->TotalDataBufferLength = Request->RequestMessage.MessageLength; |
254 | packet->PageBufferCount = 1; | |
255 | ||
0120ee0d GKH |
256 | packet->PageBuffers[0].Pfn = virt_to_phys(&Request->RequestMessage) >> |
257 | PAGE_SHIFT; | |
fceaf24a | 258 | packet->PageBuffers[0].Length = Request->RequestMessage.MessageLength; |
0120ee0d GKH |
259 | packet->PageBuffers[0].Offset = |
260 | (unsigned long)&Request->RequestMessage & (PAGE_SIZE - 1); | |
fceaf24a | 261 | |
454f18a9 | 262 | packet->Completion.Send.SendCompletionContext = Request;/* packet; */ |
0120ee0d GKH |
263 | packet->Completion.Send.OnSendCompletion = |
264 | RndisFilterOnSendRequestCompletion; | |
c4b0bc94 | 265 | packet->Completion.Send.SendCompletionTid = (unsigned long)Device; |
fceaf24a HJ |
266 | |
267 | ret = gRndisFilter.InnerDriver.OnSend(Device->NetDevice->Device, packet); | |
268 | DPRINT_EXIT(NETVSC); | |
269 | return ret; | |
270 | } | |
271 | ||
e681b954 | 272 | static void RndisFilterReceiveResponse(struct rndis_device *Device, |
9f33d054 | 273 | struct rndis_message *Response) |
fceaf24a | 274 | { |
e681b954 | 275 | struct rndis_request *request = NULL; |
0e727613 | 276 | bool found = false; |
880fb89c | 277 | unsigned long flags; |
fceaf24a HJ |
278 | |
279 | DPRINT_ENTER(NETVSC); | |
280 | ||
880fb89c | 281 | spin_lock_irqsave(&Device->request_lock, flags); |
1f5459bc | 282 | list_for_each_entry(request, &Device->RequestList, ListEntry) { |
0120ee0d GKH |
283 | /* |
284 | * All request/response message contains RequestId as the 1st | |
285 | * field | |
286 | */ | |
287 | if (request->RequestMessage.Message.InitializeRequest.RequestId | |
288 | == Response->Message.InitializeComplete.RequestId) { | |
289 | DPRINT_DBG(NETVSC, "found rndis request for " | |
290 | "this response (id 0x%x req type 0x%x res " | |
291 | "type 0x%x)", | |
292 | request->RequestMessage.Message.InitializeRequest.RequestId, | |
293 | request->RequestMessage.NdisMessageType, | |
294 | Response->NdisMessageType); | |
fceaf24a | 295 | |
0e727613 | 296 | found = true; |
fceaf24a HJ |
297 | break; |
298 | } | |
299 | } | |
880fb89c | 300 | spin_unlock_irqrestore(&Device->request_lock, flags); |
fceaf24a | 301 | |
0120ee0d GKH |
302 | if (found) { |
303 | if (Response->MessageLength <= sizeof(struct rndis_message)) { | |
304 | memcpy(&request->ResponseMessage, Response, | |
305 | Response->MessageLength); | |
306 | } else { | |
307 | DPRINT_ERR(NETVSC, "rndis response buffer overflow " | |
308 | "detected (size %u max %zu)", | |
309 | Response->MessageLength, | |
310 | sizeof(struct rndis_filter_packet)); | |
311 | ||
312 | if (Response->NdisMessageType == | |
313 | REMOTE_NDIS_RESET_CMPLT) { | |
314 | /* does not have a request id field */ | |
fceaf24a | 315 | request->ResponseMessage.Message.ResetComplete.Status = STATUS_BUFFER_OVERFLOW; |
0120ee0d | 316 | } else { |
fceaf24a HJ |
317 | request->ResponseMessage.Message.InitializeComplete.Status = STATUS_BUFFER_OVERFLOW; |
318 | } | |
319 | } | |
320 | ||
bfc30aae | 321 | osd_WaitEventSet(request->WaitEvent); |
0120ee0d GKH |
322 | } else { |
323 | DPRINT_ERR(NETVSC, "no rndis request found for this response " | |
324 | "(id 0x%x res type 0x%x)", | |
325 | Response->Message.InitializeComplete.RequestId, | |
326 | Response->NdisMessageType); | |
fceaf24a HJ |
327 | } |
328 | ||
329 | DPRINT_EXIT(NETVSC); | |
330 | } | |
331 | ||
e681b954 | 332 | static void RndisFilterReceiveIndicateStatus(struct rndis_device *Device, |
9f33d054 | 333 | struct rndis_message *Response) |
fceaf24a | 334 | { |
0120ee0d GKH |
335 | struct rndis_indicate_status *indicate = |
336 | &Response->Message.IndicateStatus; | |
fceaf24a | 337 | |
0120ee0d | 338 | if (indicate->Status == RNDIS_STATUS_MEDIA_CONNECT) { |
fceaf24a | 339 | gRndisFilter.InnerDriver.OnLinkStatusChanged(Device->NetDevice->Device, 1); |
0120ee0d | 340 | } else if (indicate->Status == RNDIS_STATUS_MEDIA_DISCONNECT) { |
fceaf24a | 341 | gRndisFilter.InnerDriver.OnLinkStatusChanged(Device->NetDevice->Device, 0); |
0120ee0d GKH |
342 | } else { |
343 | /* | |
344 | * TODO: | |
345 | */ | |
fceaf24a HJ |
346 | } |
347 | } | |
348 | ||
e681b954 | 349 | static void RndisFilterReceiveData(struct rndis_device *Device, |
9f33d054 GKH |
350 | struct rndis_message *Message, |
351 | struct hv_netvsc_packet *Packet) | |
fceaf24a | 352 | { |
9f33d054 | 353 | struct rndis_packet *rndisPacket; |
4d643114 | 354 | u32 dataOffset; |
fceaf24a HJ |
355 | |
356 | DPRINT_ENTER(NETVSC); | |
357 | ||
454f18a9 | 358 | /* empty ethernet frame ?? */ |
45e44314 BP |
359 | /* ASSERT(Packet->PageBuffers[0].Length > */ |
360 | /* RNDIS_MESSAGE_SIZE(struct rndis_packet)); */ | |
fceaf24a HJ |
361 | |
362 | rndisPacket = &Message->Message.Packet; | |
363 | ||
0120ee0d GKH |
364 | /* |
365 | * FIXME: Handle multiple rndis pkt msgs that maybe enclosed in this | |
366 | * netvsc packet (ie TotalDataBufferLength != MessageLength) | |
367 | */ | |
fceaf24a | 368 | |
454f18a9 | 369 | /* Remove the rndis header and pass it back up the stack */ |
fceaf24a HJ |
370 | dataOffset = RNDIS_HEADER_SIZE + rndisPacket->DataOffset; |
371 | ||
372 | Packet->TotalDataBufferLength -= dataOffset; | |
373 | Packet->PageBuffers[0].Offset += dataOffset; | |
374 | Packet->PageBuffers[0].Length -= dataOffset; | |
375 | ||
0e727613 | 376 | Packet->IsDataPacket = true; |
fceaf24a | 377 | |
0120ee0d GKH |
378 | gRndisFilter.InnerDriver.OnReceiveCallback(Device->NetDevice->Device, |
379 | Packet); | |
fceaf24a HJ |
380 | |
381 | DPRINT_EXIT(NETVSC); | |
382 | } | |
383 | ||
0120ee0d GKH |
384 | static int RndisFilterOnReceive(struct hv_device *Device, |
385 | struct hv_netvsc_packet *Packet) | |
fceaf24a | 386 | { |
ce9ea4cf | 387 | struct netvsc_device *netDevice = Device->Extension; |
e681b954 | 388 | struct rndis_device *rndisDevice; |
9f33d054 GKH |
389 | struct rndis_message rndisMessage; |
390 | struct rndis_message *rndisHeader; | |
fceaf24a HJ |
391 | |
392 | DPRINT_ENTER(NETVSC); | |
393 | ||
8a62d716 BP |
394 | if (!netDevice) |
395 | return -EINVAL; | |
396 | ||
454f18a9 | 397 | /* Make sure the rndis device state is initialized */ |
0120ee0d GKH |
398 | if (!netDevice->Extension) { |
399 | DPRINT_ERR(NETVSC, "got rndis message but no rndis device..." | |
400 | "dropping this message!"); | |
fceaf24a HJ |
401 | DPRINT_EXIT(NETVSC); |
402 | return -1; | |
403 | } | |
404 | ||
0120ee0d GKH |
405 | rndisDevice = (struct rndis_device *)netDevice->Extension; |
406 | if (rndisDevice->State == RNDIS_DEV_UNINITIALIZED) { | |
407 | DPRINT_ERR(NETVSC, "got rndis message but rndis device " | |
408 | "uninitialized...dropping this message!"); | |
fceaf24a HJ |
409 | DPRINT_EXIT(NETVSC); |
410 | return -1; | |
411 | } | |
412 | ||
0120ee0d GKH |
413 | rndisHeader = (struct rndis_message *)kmap_atomic( |
414 | pfn_to_page(Packet->PageBuffers[0].Pfn), KM_IRQ0); | |
fceaf24a | 415 | |
0120ee0d GKH |
416 | rndisHeader = (void *)((unsigned long)rndisHeader + |
417 | Packet->PageBuffers[0].Offset); | |
fceaf24a | 418 | |
454f18a9 | 419 | /* Make sure we got a valid rndis message */ |
0120ee0d GKH |
420 | /* |
421 | * FIXME: There seems to be a bug in set completion msg where its | |
422 | * MessageLength is 16 bytes but the ByteCount field in the xfer page | |
423 | * range shows 52 bytes | |
424 | * */ | |
fceaf24a | 425 | #if 0 |
0120ee0d GKH |
426 | if (Packet->TotalDataBufferLength != rndisHeader->MessageLength) { |
427 | kunmap_atomic(rndisHeader - Packet->PageBuffers[0].Offset, | |
428 | KM_IRQ0); | |
429 | ||
430 | DPRINT_ERR(NETVSC, "invalid rndis message? (expected %u " | |
431 | "bytes got %u)...dropping this message!", | |
432 | rndisHeader->MessageLength, | |
433 | Packet->TotalDataBufferLength); | |
fceaf24a HJ |
434 | DPRINT_EXIT(NETVSC); |
435 | return -1; | |
436 | } | |
437 | #endif | |
438 | ||
0120ee0d GKH |
439 | if ((rndisHeader->NdisMessageType != REMOTE_NDIS_PACKET_MSG) && |
440 | (rndisHeader->MessageLength > sizeof(struct rndis_message))) { | |
441 | DPRINT_ERR(NETVSC, "incoming rndis message buffer overflow " | |
442 | "detected (got %u, max %zu)...marking it an error!", | |
443 | rndisHeader->MessageLength, | |
444 | sizeof(struct rndis_message)); | |
fceaf24a HJ |
445 | } |
446 | ||
0120ee0d GKH |
447 | memcpy(&rndisMessage, rndisHeader, |
448 | (rndisHeader->MessageLength > sizeof(struct rndis_message)) ? | |
449 | sizeof(struct rndis_message) : | |
450 | rndisHeader->MessageLength); | |
fceaf24a | 451 | |
45da89e5 | 452 | kunmap_atomic(rndisHeader - Packet->PageBuffers[0].Offset, KM_IRQ0); |
fceaf24a HJ |
453 | |
454 | DumpRndisMessage(&rndisMessage); | |
455 | ||
0120ee0d | 456 | switch (rndisMessage.NdisMessageType) { |
fceaf24a | 457 | case REMOTE_NDIS_PACKET_MSG: |
0120ee0d | 458 | /* data msg */ |
fceaf24a HJ |
459 | RndisFilterReceiveData(rndisDevice, &rndisMessage, Packet); |
460 | break; | |
461 | ||
fceaf24a HJ |
462 | case REMOTE_NDIS_INITIALIZE_CMPLT: |
463 | case REMOTE_NDIS_QUERY_CMPLT: | |
464 | case REMOTE_NDIS_SET_CMPLT: | |
454f18a9 BP |
465 | /* case REMOTE_NDIS_RESET_CMPLT: */ |
466 | /* case REMOTE_NDIS_KEEPALIVE_CMPLT: */ | |
0120ee0d | 467 | /* completion msgs */ |
fceaf24a HJ |
468 | RndisFilterReceiveResponse(rndisDevice, &rndisMessage); |
469 | break; | |
470 | ||
fceaf24a | 471 | case REMOTE_NDIS_INDICATE_STATUS_MSG: |
0120ee0d | 472 | /* notification msgs */ |
fceaf24a HJ |
473 | RndisFilterReceiveIndicateStatus(rndisDevice, &rndisMessage); |
474 | break; | |
475 | default: | |
0120ee0d GKH |
476 | DPRINT_ERR(NETVSC, "unhandled rndis message (type %u len %u)", |
477 | rndisMessage.NdisMessageType, | |
478 | rndisMessage.MessageLength); | |
fceaf24a HJ |
479 | break; |
480 | } | |
481 | ||
482 | DPRINT_EXIT(NETVSC); | |
483 | return 0; | |
484 | } | |
485 | ||
0120ee0d GKH |
486 | static int RndisFilterQueryDevice(struct rndis_device *Device, u32 Oid, |
487 | void *Result, u32 *ResultSize) | |
fceaf24a | 488 | { |
e681b954 | 489 | struct rndis_request *request; |
4d643114 | 490 | u32 inresultSize = *ResultSize; |
9f33d054 GKH |
491 | struct rndis_query_request *query; |
492 | struct rndis_query_complete *queryComplete; | |
0120ee0d | 493 | int ret = 0; |
fceaf24a HJ |
494 | |
495 | DPRINT_ENTER(NETVSC); | |
496 | ||
8a62d716 BP |
497 | if (!Result) |
498 | return -EINVAL; | |
fceaf24a HJ |
499 | |
500 | *ResultSize = 0; | |
0120ee0d GKH |
501 | request = GetRndisRequest(Device, REMOTE_NDIS_QUERY_MSG, |
502 | RNDIS_MESSAGE_SIZE(struct rndis_query_request)); | |
503 | if (!request) { | |
fceaf24a HJ |
504 | ret = -1; |
505 | goto Cleanup; | |
506 | } | |
507 | ||
454f18a9 | 508 | /* Setup the rndis query */ |
fceaf24a HJ |
509 | query = &request->RequestMessage.Message.QueryRequest; |
510 | query->Oid = Oid; | |
9f33d054 | 511 | query->InformationBufferOffset = sizeof(struct rndis_query_request); |
fceaf24a HJ |
512 | query->InformationBufferLength = 0; |
513 | query->DeviceVcHandle = 0; | |
514 | ||
515 | ret = RndisFilterSendRequest(Device, request); | |
516 | if (ret != 0) | |
fceaf24a | 517 | goto Cleanup; |
fceaf24a | 518 | |
bfc30aae | 519 | osd_WaitEventWait(request->WaitEvent); |
fceaf24a | 520 | |
454f18a9 | 521 | /* Copy the response back */ |
fceaf24a HJ |
522 | queryComplete = &request->ResponseMessage.Message.QueryComplete; |
523 | ||
0120ee0d | 524 | if (queryComplete->InformationBufferLength > inresultSize) { |
fceaf24a HJ |
525 | ret = -1; |
526 | goto Cleanup; | |
527 | } | |
528 | ||
529 | memcpy(Result, | |
0120ee0d GKH |
530 | (void *)((unsigned long)queryComplete + |
531 | queryComplete->InformationBufferOffset), | |
532 | queryComplete->InformationBufferLength); | |
fceaf24a HJ |
533 | |
534 | *ResultSize = queryComplete->InformationBufferLength; | |
535 | ||
536 | Cleanup: | |
537 | if (request) | |
fceaf24a | 538 | PutRndisRequest(Device, request); |
fceaf24a HJ |
539 | DPRINT_EXIT(NETVSC); |
540 | ||
541 | return ret; | |
542 | } | |
543 | ||
0120ee0d | 544 | static int RndisFilterQueryDeviceMac(struct rndis_device *Device) |
fceaf24a | 545 | { |
9f8bd8ba | 546 | u32 size = ETH_ALEN; |
fceaf24a HJ |
547 | |
548 | return RndisFilterQueryDevice(Device, | |
0120ee0d GKH |
549 | RNDIS_OID_802_3_PERMANENT_ADDRESS, |
550 | Device->HwMacAddr, &size); | |
fceaf24a HJ |
551 | } |
552 | ||
0120ee0d | 553 | static int RndisFilterQueryDeviceLinkStatus(struct rndis_device *Device) |
fceaf24a | 554 | { |
0120ee0d | 555 | u32 size = sizeof(u32); |
fceaf24a HJ |
556 | |
557 | return RndisFilterQueryDevice(Device, | |
0120ee0d GKH |
558 | RNDIS_OID_GEN_MEDIA_CONNECT_STATUS, |
559 | &Device->LinkStatus, &size); | |
fceaf24a HJ |
560 | } |
561 | ||
0120ee0d GKH |
562 | static int RndisFilterSetPacketFilter(struct rndis_device *Device, |
563 | u32 NewFilter) | |
fceaf24a | 564 | { |
e681b954 | 565 | struct rndis_request *request; |
9f33d054 GKH |
566 | struct rndis_set_request *set; |
567 | struct rndis_set_complete *setComplete; | |
4d643114 | 568 | u32 status; |
fceaf24a HJ |
569 | int ret; |
570 | ||
571 | DPRINT_ENTER(NETVSC); | |
572 | ||
45e44314 BP |
573 | /* ASSERT(RNDIS_MESSAGE_SIZE(struct rndis_set_request) + sizeof(u32) <= */ |
574 | /* sizeof(struct rndis_message)); */ | |
fceaf24a | 575 | |
0120ee0d GKH |
576 | request = GetRndisRequest(Device, REMOTE_NDIS_SET_MSG, |
577 | RNDIS_MESSAGE_SIZE(struct rndis_set_request) + | |
578 | sizeof(u32)); | |
579 | if (!request) { | |
fceaf24a HJ |
580 | ret = -1; |
581 | goto Cleanup; | |
582 | } | |
583 | ||
454f18a9 | 584 | /* Setup the rndis set */ |
fceaf24a HJ |
585 | set = &request->RequestMessage.Message.SetRequest; |
586 | set->Oid = RNDIS_OID_GEN_CURRENT_PACKET_FILTER; | |
4d643114 | 587 | set->InformationBufferLength = sizeof(u32); |
9f33d054 | 588 | set->InformationBufferOffset = sizeof(struct rndis_set_request); |
fceaf24a | 589 | |
0120ee0d GKH |
590 | memcpy((void *)(unsigned long)set + sizeof(struct rndis_set_request), |
591 | &NewFilter, sizeof(u32)); | |
fceaf24a HJ |
592 | |
593 | ret = RndisFilterSendRequest(Device, request); | |
594 | if (ret != 0) | |
fceaf24a | 595 | goto Cleanup; |
fceaf24a | 596 | |
bfc30aae | 597 | ret = osd_WaitEventWaitEx(request->WaitEvent, 2000/*2sec*/); |
0120ee0d | 598 | if (!ret) { |
fceaf24a HJ |
599 | ret = -1; |
600 | DPRINT_ERR(NETVSC, "timeout before we got a set response..."); | |
0120ee0d GKH |
601 | /* |
602 | * We cant deallocate the request since we may still receive a | |
603 | * send completion for it. | |
604 | */ | |
fceaf24a | 605 | goto Exit; |
0120ee0d | 606 | } else { |
fceaf24a | 607 | if (ret > 0) |
fceaf24a | 608 | ret = 0; |
fceaf24a HJ |
609 | setComplete = &request->ResponseMessage.Message.SetComplete; |
610 | status = setComplete->Status; | |
611 | } | |
612 | ||
613 | Cleanup: | |
614 | if (request) | |
fceaf24a | 615 | PutRndisRequest(Device, request); |
fceaf24a HJ |
616 | Exit: |
617 | DPRINT_EXIT(NETVSC); | |
618 | ||
619 | return ret; | |
620 | } | |
621 | ||
7e23a6e9 | 622 | int RndisFilterInit(struct netvsc_driver *Driver) |
fceaf24a HJ |
623 | { |
624 | DPRINT_ENTER(NETVSC); | |
625 | ||
0120ee0d GKH |
626 | DPRINT_DBG(NETVSC, "sizeof(struct rndis_filter_packet) == %zd", |
627 | sizeof(struct rndis_filter_packet)); | |
fceaf24a | 628 | |
e681b954 | 629 | Driver->RequestExtSize = sizeof(struct rndis_filter_packet); |
fceaf24a | 630 | |
454f18a9 | 631 | /* Driver->Context = rndisDriver; */ |
fceaf24a | 632 | |
e681b954 | 633 | memset(&gRndisFilter, 0, sizeof(struct rndis_filter_driver_object)); |
fceaf24a HJ |
634 | |
635 | /*rndisDriver->Driver = Driver; | |
636 | ||
637 | ASSERT(Driver->OnLinkStatusChanged); | |
638 | rndisDriver->OnLinkStatusChanged = Driver->OnLinkStatusChanged;*/ | |
639 | ||
454f18a9 | 640 | /* Save the original dispatch handlers before we override it */ |
fceaf24a | 641 | gRndisFilter.InnerDriver.Base.OnDeviceAdd = Driver->Base.OnDeviceAdd; |
0120ee0d GKH |
642 | gRndisFilter.InnerDriver.Base.OnDeviceRemove = |
643 | Driver->Base.OnDeviceRemove; | |
fceaf24a HJ |
644 | gRndisFilter.InnerDriver.Base.OnCleanup = Driver->Base.OnCleanup; |
645 | ||
45e44314 BP |
646 | /* ASSERT(Driver->OnSend); */ |
647 | /* ASSERT(Driver->OnReceiveCallback); */ | |
fceaf24a HJ |
648 | gRndisFilter.InnerDriver.OnSend = Driver->OnSend; |
649 | gRndisFilter.InnerDriver.OnReceiveCallback = Driver->OnReceiveCallback; | |
0120ee0d GKH |
650 | gRndisFilter.InnerDriver.OnLinkStatusChanged = |
651 | Driver->OnLinkStatusChanged; | |
fceaf24a | 652 | |
454f18a9 | 653 | /* Override */ |
fceaf24a HJ |
654 | Driver->Base.OnDeviceAdd = RndisFilterOnDeviceAdd; |
655 | Driver->Base.OnDeviceRemove = RndisFilterOnDeviceRemove; | |
656 | Driver->Base.OnCleanup = RndisFilterOnCleanup; | |
657 | Driver->OnSend = RndisFilterOnSend; | |
454f18a9 | 658 | /* Driver->QueryLinkStatus = RndisFilterQueryDeviceLinkStatus; */ |
fceaf24a HJ |
659 | Driver->OnReceiveCallback = RndisFilterOnReceive; |
660 | ||
661 | DPRINT_EXIT(NETVSC); | |
662 | ||
663 | return 0; | |
664 | } | |
665 | ||
e681b954 | 666 | static int RndisFilterInitDevice(struct rndis_device *Device) |
fceaf24a | 667 | { |
e681b954 | 668 | struct rndis_request *request; |
9f33d054 GKH |
669 | struct rndis_initialize_request *init; |
670 | struct rndis_initialize_complete *initComplete; | |
4d643114 | 671 | u32 status; |
fceaf24a HJ |
672 | int ret; |
673 | ||
674 | DPRINT_ENTER(NETVSC); | |
675 | ||
0120ee0d GKH |
676 | request = GetRndisRequest(Device, REMOTE_NDIS_INITIALIZE_MSG, |
677 | RNDIS_MESSAGE_SIZE(struct rndis_initialize_request)); | |
678 | if (!request) { | |
fceaf24a HJ |
679 | ret = -1; |
680 | goto Cleanup; | |
681 | } | |
682 | ||
454f18a9 | 683 | /* Setup the rndis set */ |
fceaf24a HJ |
684 | init = &request->RequestMessage.Message.InitializeRequest; |
685 | init->MajorVersion = RNDIS_MAJOR_VERSION; | |
686 | init->MinorVersion = RNDIS_MINOR_VERSION; | |
0120ee0d GKH |
687 | /* FIXME: Use 1536 - rounded ethernet frame size */ |
688 | init->MaxTransferSize = 2048; | |
fceaf24a HJ |
689 | |
690 | Device->State = RNDIS_DEV_INITIALIZING; | |
691 | ||
692 | ret = RndisFilterSendRequest(Device, request); | |
0120ee0d | 693 | if (ret != 0) { |
fceaf24a HJ |
694 | Device->State = RNDIS_DEV_UNINITIALIZED; |
695 | goto Cleanup; | |
696 | } | |
697 | ||
bfc30aae | 698 | osd_WaitEventWait(request->WaitEvent); |
fceaf24a HJ |
699 | |
700 | initComplete = &request->ResponseMessage.Message.InitializeComplete; | |
701 | status = initComplete->Status; | |
0120ee0d | 702 | if (status == RNDIS_STATUS_SUCCESS) { |
fceaf24a HJ |
703 | Device->State = RNDIS_DEV_INITIALIZED; |
704 | ret = 0; | |
0120ee0d | 705 | } else { |
fceaf24a HJ |
706 | Device->State = RNDIS_DEV_UNINITIALIZED; |
707 | ret = -1; | |
708 | } | |
709 | ||
710 | Cleanup: | |
711 | if (request) | |
fceaf24a | 712 | PutRndisRequest(Device, request); |
fceaf24a HJ |
713 | DPRINT_EXIT(NETVSC); |
714 | ||
715 | return ret; | |
716 | } | |
717 | ||
e681b954 | 718 | static void RndisFilterHaltDevice(struct rndis_device *Device) |
fceaf24a | 719 | { |
e681b954 | 720 | struct rndis_request *request; |
9f33d054 | 721 | struct rndis_halt_request *halt; |
fceaf24a HJ |
722 | |
723 | DPRINT_ENTER(NETVSC); | |
724 | ||
454f18a9 | 725 | /* Attempt to do a rndis device halt */ |
0120ee0d GKH |
726 | request = GetRndisRequest(Device, REMOTE_NDIS_HALT_MSG, |
727 | RNDIS_MESSAGE_SIZE(struct rndis_halt_request)); | |
fceaf24a | 728 | if (!request) |
fceaf24a | 729 | goto Cleanup; |
fceaf24a | 730 | |
454f18a9 | 731 | /* Setup the rndis set */ |
fceaf24a | 732 | halt = &request->RequestMessage.Message.HaltRequest; |
f4888417 | 733 | halt->RequestId = atomic_inc_return(&Device->NewRequestId); |
fceaf24a | 734 | |
454f18a9 | 735 | /* Ignore return since this msg is optional. */ |
fceaf24a HJ |
736 | RndisFilterSendRequest(Device, request); |
737 | ||
738 | Device->State = RNDIS_DEV_UNINITIALIZED; | |
739 | ||
740 | Cleanup: | |
741 | if (request) | |
fceaf24a | 742 | PutRndisRequest(Device, request); |
fceaf24a HJ |
743 | DPRINT_EXIT(NETVSC); |
744 | return; | |
745 | } | |
746 | ||
e681b954 | 747 | static int RndisFilterOpenDevice(struct rndis_device *Device) |
fceaf24a | 748 | { |
0120ee0d | 749 | int ret; |
fceaf24a HJ |
750 | |
751 | DPRINT_ENTER(NETVSC); | |
752 | ||
753 | if (Device->State != RNDIS_DEV_INITIALIZED) | |
754 | return 0; | |
755 | ||
0120ee0d GKH |
756 | ret = RndisFilterSetPacketFilter(Device, |
757 | NDIS_PACKET_TYPE_BROADCAST | | |
95beae90 | 758 | NDIS_PACKET_TYPE_ALL_MULTICAST | |
0120ee0d | 759 | NDIS_PACKET_TYPE_DIRECTED); |
fceaf24a | 760 | if (ret == 0) |
fceaf24a | 761 | Device->State = RNDIS_DEV_DATAINITIALIZED; |
fceaf24a HJ |
762 | |
763 | DPRINT_EXIT(NETVSC); | |
764 | return ret; | |
765 | } | |
766 | ||
e681b954 | 767 | static int RndisFilterCloseDevice(struct rndis_device *Device) |
fceaf24a HJ |
768 | { |
769 | int ret; | |
770 | ||
771 | DPRINT_ENTER(NETVSC); | |
772 | ||
773 | if (Device->State != RNDIS_DEV_DATAINITIALIZED) | |
774 | return 0; | |
775 | ||
776 | ret = RndisFilterSetPacketFilter(Device, 0); | |
777 | if (ret == 0) | |
fceaf24a | 778 | Device->State = RNDIS_DEV_INITIALIZED; |
fceaf24a HJ |
779 | |
780 | DPRINT_EXIT(NETVSC); | |
781 | ||
782 | return ret; | |
783 | } | |
784 | ||
0120ee0d GKH |
785 | static int RndisFilterOnDeviceAdd(struct hv_device *Device, |
786 | void *AdditionalInfo) | |
fceaf24a HJ |
787 | { |
788 | int ret; | |
ce9ea4cf | 789 | struct netvsc_device *netDevice; |
e681b954 | 790 | struct rndis_device *rndisDevice; |
0120ee0d | 791 | struct netvsc_device_info *deviceInfo = AdditionalInfo; |
fceaf24a HJ |
792 | |
793 | DPRINT_ENTER(NETVSC); | |
794 | ||
fceaf24a | 795 | rndisDevice = GetRndisDevice(); |
0120ee0d | 796 | if (!rndisDevice) { |
fceaf24a HJ |
797 | DPRINT_EXIT(NETVSC); |
798 | return -1; | |
799 | } | |
800 | ||
801 | DPRINT_DBG(NETVSC, "rndis device object allocated - %p", rndisDevice); | |
802 | ||
0120ee0d GKH |
803 | /* |
804 | * Let the inner driver handle this first to create the netvsc channel | |
805 | * NOTE! Once the channel is created, we may get a receive callback | |
806 | * (RndisFilterOnReceive()) before this call is completed | |
807 | */ | |
fceaf24a | 808 | ret = gRndisFilter.InnerDriver.Base.OnDeviceAdd(Device, AdditionalInfo); |
0120ee0d GKH |
809 | if (ret != 0) { |
810 | kfree(rndisDevice); | |
fceaf24a HJ |
811 | DPRINT_EXIT(NETVSC); |
812 | return ret; | |
813 | } | |
814 | ||
454f18a9 BP |
815 | |
816 | /* Initialize the rndis device */ | |
0120ee0d | 817 | netDevice = Device->Extension; |
45e44314 BP |
818 | /* ASSERT(netDevice); */ |
819 | /* ASSERT(netDevice->Device); */ | |
fceaf24a HJ |
820 | |
821 | netDevice->Extension = rndisDevice; | |
822 | rndisDevice->NetDevice = netDevice; | |
823 | ||
454f18a9 | 824 | /* Send the rndis initialization message */ |
fceaf24a | 825 | ret = RndisFilterInitDevice(rndisDevice); |
0120ee0d GKH |
826 | if (ret != 0) { |
827 | /* | |
828 | * TODO: If rndis init failed, we will need to shut down the | |
829 | * channel | |
830 | */ | |
fceaf24a HJ |
831 | } |
832 | ||
454f18a9 | 833 | /* Get the mac address */ |
fceaf24a | 834 | ret = RndisFilterQueryDeviceMac(rndisDevice); |
0120ee0d GKH |
835 | if (ret != 0) { |
836 | /* | |
837 | * TODO: shutdown rndis device and the channel | |
838 | */ | |
fceaf24a HJ |
839 | } |
840 | ||
9f8bd8ba SH |
841 | DPRINT_INFO(NETVSC, "Device 0x%p mac addr %pM", |
842 | rndisDevice, rndisDevice->HwMacAddr); | |
fceaf24a | 843 | |
9f8bd8ba | 844 | memcpy(deviceInfo->MacAddr, rndisDevice->HwMacAddr, ETH_ALEN); |
fceaf24a HJ |
845 | |
846 | RndisFilterQueryDeviceLinkStatus(rndisDevice); | |
847 | ||
848 | deviceInfo->LinkState = rndisDevice->LinkStatus; | |
0120ee0d GKH |
849 | DPRINT_INFO(NETVSC, "Device 0x%p link state %s", rndisDevice, |
850 | ((deviceInfo->LinkState) ? ("down") : ("up"))); | |
fceaf24a HJ |
851 | |
852 | DPRINT_EXIT(NETVSC); | |
853 | ||
854 | return ret; | |
855 | } | |
856 | ||
0120ee0d | 857 | static int RndisFilterOnDeviceRemove(struct hv_device *Device) |
fceaf24a | 858 | { |
ce9ea4cf | 859 | struct netvsc_device *netDevice = Device->Extension; |
0120ee0d | 860 | struct rndis_device *rndisDevice = netDevice->Extension; |
fceaf24a HJ |
861 | |
862 | DPRINT_ENTER(NETVSC); | |
863 | ||
454f18a9 | 864 | /* Halt and release the rndis device */ |
fceaf24a HJ |
865 | RndisFilterHaltDevice(rndisDevice); |
866 | ||
0120ee0d | 867 | kfree(rndisDevice); |
fceaf24a HJ |
868 | netDevice->Extension = NULL; |
869 | ||
454f18a9 | 870 | /* Pass control to inner driver to remove the device */ |
fceaf24a HJ |
871 | gRndisFilter.InnerDriver.Base.OnDeviceRemove(Device); |
872 | ||
873 | DPRINT_EXIT(NETVSC); | |
874 | ||
875 | return 0; | |
876 | } | |
877 | ||
0120ee0d | 878 | static void RndisFilterOnCleanup(struct hv_driver *Driver) |
fceaf24a HJ |
879 | { |
880 | DPRINT_ENTER(NETVSC); | |
881 | ||
882 | DPRINT_EXIT(NETVSC); | |
883 | } | |
884 | ||
2d075346 | 885 | int RndisFilterOnOpen(struct hv_device *Device) |
fceaf24a HJ |
886 | { |
887 | int ret; | |
ce9ea4cf | 888 | struct netvsc_device *netDevice = Device->Extension; |
fceaf24a HJ |
889 | |
890 | DPRINT_ENTER(NETVSC); | |
891 | ||
8a62d716 BP |
892 | if (!netDevice) |
893 | return -EINVAL; | |
894 | ||
0120ee0d | 895 | ret = RndisFilterOpenDevice(netDevice->Extension); |
fceaf24a HJ |
896 | |
897 | DPRINT_EXIT(NETVSC); | |
898 | ||
899 | return ret; | |
900 | } | |
901 | ||
4f28900b | 902 | int RndisFilterOnClose(struct hv_device *Device) |
fceaf24a HJ |
903 | { |
904 | int ret; | |
ce9ea4cf | 905 | struct netvsc_device *netDevice = Device->Extension; |
fceaf24a HJ |
906 | |
907 | DPRINT_ENTER(NETVSC); | |
908 | ||
8a62d716 BP |
909 | if (!netDevice) |
910 | return -EINVAL; | |
911 | ||
0120ee0d | 912 | ret = RndisFilterCloseDevice(netDevice->Extension); |
fceaf24a HJ |
913 | |
914 | DPRINT_EXIT(NETVSC); | |
915 | ||
916 | return ret; | |
917 | } | |
918 | ||
0120ee0d GKH |
919 | static int RndisFilterOnSend(struct hv_device *Device, |
920 | struct hv_netvsc_packet *Packet) | |
fceaf24a | 921 | { |
0120ee0d | 922 | int ret; |
e681b954 | 923 | struct rndis_filter_packet *filterPacket; |
9f33d054 GKH |
924 | struct rndis_message *rndisMessage; |
925 | struct rndis_packet *rndisPacket; | |
4d643114 | 926 | u32 rndisMessageSize; |
fceaf24a HJ |
927 | |
928 | DPRINT_ENTER(NETVSC); | |
929 | ||
454f18a9 | 930 | /* Add the rndis header */ |
e681b954 | 931 | filterPacket = (struct rndis_filter_packet *)Packet->Extension; |
45e44314 | 932 | /* ASSERT(filterPacket); */ |
fceaf24a | 933 | |
e681b954 | 934 | memset(filterPacket, 0, sizeof(struct rndis_filter_packet)); |
fceaf24a HJ |
935 | |
936 | rndisMessage = &filterPacket->Message; | |
9f33d054 | 937 | rndisMessageSize = RNDIS_MESSAGE_SIZE(struct rndis_packet); |
fceaf24a HJ |
938 | |
939 | rndisMessage->NdisMessageType = REMOTE_NDIS_PACKET_MSG; | |
0120ee0d GKH |
940 | rndisMessage->MessageLength = Packet->TotalDataBufferLength + |
941 | rndisMessageSize; | |
fceaf24a HJ |
942 | |
943 | rndisPacket = &rndisMessage->Message.Packet; | |
9f33d054 | 944 | rndisPacket->DataOffset = sizeof(struct rndis_packet); |
fceaf24a HJ |
945 | rndisPacket->DataLength = Packet->TotalDataBufferLength; |
946 | ||
0e727613 | 947 | Packet->IsDataPacket = true; |
0120ee0d GKH |
948 | Packet->PageBuffers[0].Pfn = virt_to_phys(rndisMessage) >> PAGE_SHIFT; |
949 | Packet->PageBuffers[0].Offset = | |
950 | (unsigned long)rndisMessage & (PAGE_SIZE-1); | |
951 | Packet->PageBuffers[0].Length = rndisMessageSize; | |
fceaf24a | 952 | |
454f18a9 | 953 | /* Save the packet send completion and context */ |
fceaf24a | 954 | filterPacket->OnCompletion = Packet->Completion.Send.OnSendCompletion; |
0120ee0d GKH |
955 | filterPacket->CompletionContext = |
956 | Packet->Completion.Send.SendCompletionContext; | |
fceaf24a | 957 | |
454f18a9 | 958 | /* Use ours */ |
fceaf24a HJ |
959 | Packet->Completion.Send.OnSendCompletion = RndisFilterOnSendCompletion; |
960 | Packet->Completion.Send.SendCompletionContext = filterPacket; | |
961 | ||
962 | ret = gRndisFilter.InnerDriver.OnSend(Device, Packet); | |
0120ee0d GKH |
963 | if (ret != 0) { |
964 | /* | |
965 | * Reset the completion to originals to allow retries from | |
966 | * above | |
967 | */ | |
968 | Packet->Completion.Send.OnSendCompletion = | |
969 | filterPacket->OnCompletion; | |
970 | Packet->Completion.Send.SendCompletionContext = | |
971 | filterPacket->CompletionContext; | |
fceaf24a HJ |
972 | } |
973 | ||
974 | DPRINT_EXIT(NETVSC); | |
975 | ||
976 | return ret; | |
977 | } | |
978 | ||
0120ee0d | 979 | static void RndisFilterOnSendCompletion(void *Context) |
fceaf24a | 980 | { |
0120ee0d | 981 | struct rndis_filter_packet *filterPacket = Context; |
fceaf24a HJ |
982 | |
983 | DPRINT_ENTER(NETVSC); | |
984 | ||
454f18a9 | 985 | /* Pass it back to the original handler */ |
fceaf24a HJ |
986 | filterPacket->OnCompletion(filterPacket->CompletionContext); |
987 | ||
988 | DPRINT_EXIT(NETVSC); | |
989 | } | |
990 | ||
991 | ||
0120ee0d | 992 | static void RndisFilterOnSendRequestCompletion(void *Context) |
fceaf24a HJ |
993 | { |
994 | DPRINT_ENTER(NETVSC); | |
995 | ||
454f18a9 | 996 | /* Noop */ |
fceaf24a HJ |
997 | DPRINT_EXIT(NETVSC); |
998 | } |