]>
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" |
cc211812 | 29 | #include "NetVscApi.h" |
fceaf24a HJ |
30 | #include "RndisFilter.h" |
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 | ||
394 | ASSERT(netDevice); | |
454f18a9 | 395 | /* Make sure the rndis device state is initialized */ |
0120ee0d GKH |
396 | if (!netDevice->Extension) { |
397 | DPRINT_ERR(NETVSC, "got rndis message but no rndis device..." | |
398 | "dropping this message!"); | |
fceaf24a HJ |
399 | DPRINT_EXIT(NETVSC); |
400 | return -1; | |
401 | } | |
402 | ||
0120ee0d GKH |
403 | rndisDevice = (struct rndis_device *)netDevice->Extension; |
404 | if (rndisDevice->State == RNDIS_DEV_UNINITIALIZED) { | |
405 | DPRINT_ERR(NETVSC, "got rndis message but rndis device " | |
406 | "uninitialized...dropping this message!"); | |
fceaf24a HJ |
407 | DPRINT_EXIT(NETVSC); |
408 | return -1; | |
409 | } | |
410 | ||
0120ee0d GKH |
411 | rndisHeader = (struct rndis_message *)kmap_atomic( |
412 | pfn_to_page(Packet->PageBuffers[0].Pfn), KM_IRQ0); | |
fceaf24a | 413 | |
0120ee0d GKH |
414 | rndisHeader = (void *)((unsigned long)rndisHeader + |
415 | Packet->PageBuffers[0].Offset); | |
fceaf24a | 416 | |
454f18a9 | 417 | /* Make sure we got a valid rndis message */ |
0120ee0d GKH |
418 | /* |
419 | * FIXME: There seems to be a bug in set completion msg where its | |
420 | * MessageLength is 16 bytes but the ByteCount field in the xfer page | |
421 | * range shows 52 bytes | |
422 | * */ | |
fceaf24a | 423 | #if 0 |
0120ee0d GKH |
424 | if (Packet->TotalDataBufferLength != rndisHeader->MessageLength) { |
425 | kunmap_atomic(rndisHeader - Packet->PageBuffers[0].Offset, | |
426 | KM_IRQ0); | |
427 | ||
428 | DPRINT_ERR(NETVSC, "invalid rndis message? (expected %u " | |
429 | "bytes got %u)...dropping this message!", | |
430 | rndisHeader->MessageLength, | |
431 | Packet->TotalDataBufferLength); | |
fceaf24a HJ |
432 | DPRINT_EXIT(NETVSC); |
433 | return -1; | |
434 | } | |
435 | #endif | |
436 | ||
0120ee0d GKH |
437 | if ((rndisHeader->NdisMessageType != REMOTE_NDIS_PACKET_MSG) && |
438 | (rndisHeader->MessageLength > sizeof(struct rndis_message))) { | |
439 | DPRINT_ERR(NETVSC, "incoming rndis message buffer overflow " | |
440 | "detected (got %u, max %zu)...marking it an error!", | |
441 | rndisHeader->MessageLength, | |
442 | sizeof(struct rndis_message)); | |
fceaf24a HJ |
443 | } |
444 | ||
0120ee0d GKH |
445 | memcpy(&rndisMessage, rndisHeader, |
446 | (rndisHeader->MessageLength > sizeof(struct rndis_message)) ? | |
447 | sizeof(struct rndis_message) : | |
448 | rndisHeader->MessageLength); | |
fceaf24a | 449 | |
45da89e5 | 450 | kunmap_atomic(rndisHeader - Packet->PageBuffers[0].Offset, KM_IRQ0); |
fceaf24a HJ |
451 | |
452 | DumpRndisMessage(&rndisMessage); | |
453 | ||
0120ee0d | 454 | switch (rndisMessage.NdisMessageType) { |
fceaf24a | 455 | case REMOTE_NDIS_PACKET_MSG: |
0120ee0d | 456 | /* data msg */ |
fceaf24a HJ |
457 | RndisFilterReceiveData(rndisDevice, &rndisMessage, Packet); |
458 | break; | |
459 | ||
fceaf24a HJ |
460 | case REMOTE_NDIS_INITIALIZE_CMPLT: |
461 | case REMOTE_NDIS_QUERY_CMPLT: | |
462 | case REMOTE_NDIS_SET_CMPLT: | |
454f18a9 BP |
463 | /* case REMOTE_NDIS_RESET_CMPLT: */ |
464 | /* case REMOTE_NDIS_KEEPALIVE_CMPLT: */ | |
0120ee0d | 465 | /* completion msgs */ |
fceaf24a HJ |
466 | RndisFilterReceiveResponse(rndisDevice, &rndisMessage); |
467 | break; | |
468 | ||
fceaf24a | 469 | case REMOTE_NDIS_INDICATE_STATUS_MSG: |
0120ee0d | 470 | /* notification msgs */ |
fceaf24a HJ |
471 | RndisFilterReceiveIndicateStatus(rndisDevice, &rndisMessage); |
472 | break; | |
473 | default: | |
0120ee0d GKH |
474 | DPRINT_ERR(NETVSC, "unhandled rndis message (type %u len %u)", |
475 | rndisMessage.NdisMessageType, | |
476 | rndisMessage.MessageLength); | |
fceaf24a HJ |
477 | break; |
478 | } | |
479 | ||
480 | DPRINT_EXIT(NETVSC); | |
481 | return 0; | |
482 | } | |
483 | ||
0120ee0d GKH |
484 | static int RndisFilterQueryDevice(struct rndis_device *Device, u32 Oid, |
485 | void *Result, u32 *ResultSize) | |
fceaf24a | 486 | { |
e681b954 | 487 | struct rndis_request *request; |
4d643114 | 488 | u32 inresultSize = *ResultSize; |
9f33d054 GKH |
489 | struct rndis_query_request *query; |
490 | struct rndis_query_complete *queryComplete; | |
0120ee0d | 491 | int ret = 0; |
fceaf24a HJ |
492 | |
493 | DPRINT_ENTER(NETVSC); | |
494 | ||
495 | ASSERT(Result); | |
496 | ||
497 | *ResultSize = 0; | |
0120ee0d GKH |
498 | request = GetRndisRequest(Device, REMOTE_NDIS_QUERY_MSG, |
499 | RNDIS_MESSAGE_SIZE(struct rndis_query_request)); | |
500 | if (!request) { | |
fceaf24a HJ |
501 | ret = -1; |
502 | goto Cleanup; | |
503 | } | |
504 | ||
454f18a9 | 505 | /* Setup the rndis query */ |
fceaf24a HJ |
506 | query = &request->RequestMessage.Message.QueryRequest; |
507 | query->Oid = Oid; | |
9f33d054 | 508 | query->InformationBufferOffset = sizeof(struct rndis_query_request); |
fceaf24a HJ |
509 | query->InformationBufferLength = 0; |
510 | query->DeviceVcHandle = 0; | |
511 | ||
512 | ret = RndisFilterSendRequest(Device, request); | |
513 | if (ret != 0) | |
fceaf24a | 514 | goto Cleanup; |
fceaf24a | 515 | |
bfc30aae | 516 | osd_WaitEventWait(request->WaitEvent); |
fceaf24a | 517 | |
454f18a9 | 518 | /* Copy the response back */ |
fceaf24a HJ |
519 | queryComplete = &request->ResponseMessage.Message.QueryComplete; |
520 | ||
0120ee0d | 521 | if (queryComplete->InformationBufferLength > inresultSize) { |
fceaf24a HJ |
522 | ret = -1; |
523 | goto Cleanup; | |
524 | } | |
525 | ||
526 | memcpy(Result, | |
0120ee0d GKH |
527 | (void *)((unsigned long)queryComplete + |
528 | queryComplete->InformationBufferOffset), | |
529 | queryComplete->InformationBufferLength); | |
fceaf24a HJ |
530 | |
531 | *ResultSize = queryComplete->InformationBufferLength; | |
532 | ||
533 | Cleanup: | |
534 | if (request) | |
fceaf24a | 535 | PutRndisRequest(Device, request); |
fceaf24a HJ |
536 | DPRINT_EXIT(NETVSC); |
537 | ||
538 | return ret; | |
539 | } | |
540 | ||
0120ee0d | 541 | static int RndisFilterQueryDeviceMac(struct rndis_device *Device) |
fceaf24a | 542 | { |
9f8bd8ba | 543 | u32 size = ETH_ALEN; |
fceaf24a HJ |
544 | |
545 | return RndisFilterQueryDevice(Device, | |
0120ee0d GKH |
546 | RNDIS_OID_802_3_PERMANENT_ADDRESS, |
547 | Device->HwMacAddr, &size); | |
fceaf24a HJ |
548 | } |
549 | ||
0120ee0d | 550 | static int RndisFilterQueryDeviceLinkStatus(struct rndis_device *Device) |
fceaf24a | 551 | { |
0120ee0d | 552 | u32 size = sizeof(u32); |
fceaf24a HJ |
553 | |
554 | return RndisFilterQueryDevice(Device, | |
0120ee0d GKH |
555 | RNDIS_OID_GEN_MEDIA_CONNECT_STATUS, |
556 | &Device->LinkStatus, &size); | |
fceaf24a HJ |
557 | } |
558 | ||
0120ee0d GKH |
559 | static int RndisFilterSetPacketFilter(struct rndis_device *Device, |
560 | u32 NewFilter) | |
fceaf24a | 561 | { |
e681b954 | 562 | struct rndis_request *request; |
9f33d054 GKH |
563 | struct rndis_set_request *set; |
564 | struct rndis_set_complete *setComplete; | |
4d643114 | 565 | u32 status; |
fceaf24a HJ |
566 | int ret; |
567 | ||
568 | DPRINT_ENTER(NETVSC); | |
569 | ||
45e44314 BP |
570 | /* ASSERT(RNDIS_MESSAGE_SIZE(struct rndis_set_request) + sizeof(u32) <= */ |
571 | /* sizeof(struct rndis_message)); */ | |
fceaf24a | 572 | |
0120ee0d GKH |
573 | request = GetRndisRequest(Device, REMOTE_NDIS_SET_MSG, |
574 | RNDIS_MESSAGE_SIZE(struct rndis_set_request) + | |
575 | sizeof(u32)); | |
576 | if (!request) { | |
fceaf24a HJ |
577 | ret = -1; |
578 | goto Cleanup; | |
579 | } | |
580 | ||
454f18a9 | 581 | /* Setup the rndis set */ |
fceaf24a HJ |
582 | set = &request->RequestMessage.Message.SetRequest; |
583 | set->Oid = RNDIS_OID_GEN_CURRENT_PACKET_FILTER; | |
4d643114 | 584 | set->InformationBufferLength = sizeof(u32); |
9f33d054 | 585 | set->InformationBufferOffset = sizeof(struct rndis_set_request); |
fceaf24a | 586 | |
0120ee0d GKH |
587 | memcpy((void *)(unsigned long)set + sizeof(struct rndis_set_request), |
588 | &NewFilter, sizeof(u32)); | |
fceaf24a HJ |
589 | |
590 | ret = RndisFilterSendRequest(Device, request); | |
591 | if (ret != 0) | |
fceaf24a | 592 | goto Cleanup; |
fceaf24a | 593 | |
bfc30aae | 594 | ret = osd_WaitEventWaitEx(request->WaitEvent, 2000/*2sec*/); |
0120ee0d | 595 | if (!ret) { |
fceaf24a HJ |
596 | ret = -1; |
597 | DPRINT_ERR(NETVSC, "timeout before we got a set response..."); | |
0120ee0d GKH |
598 | /* |
599 | * We cant deallocate the request since we may still receive a | |
600 | * send completion for it. | |
601 | */ | |
fceaf24a | 602 | goto Exit; |
0120ee0d | 603 | } else { |
fceaf24a | 604 | if (ret > 0) |
fceaf24a | 605 | ret = 0; |
fceaf24a HJ |
606 | setComplete = &request->ResponseMessage.Message.SetComplete; |
607 | status = setComplete->Status; | |
608 | } | |
609 | ||
610 | Cleanup: | |
611 | if (request) | |
fceaf24a | 612 | PutRndisRequest(Device, request); |
fceaf24a HJ |
613 | Exit: |
614 | DPRINT_EXIT(NETVSC); | |
615 | ||
616 | return ret; | |
617 | } | |
618 | ||
7e23a6e9 | 619 | int RndisFilterInit(struct netvsc_driver *Driver) |
fceaf24a HJ |
620 | { |
621 | DPRINT_ENTER(NETVSC); | |
622 | ||
0120ee0d GKH |
623 | DPRINT_DBG(NETVSC, "sizeof(struct rndis_filter_packet) == %zd", |
624 | sizeof(struct rndis_filter_packet)); | |
fceaf24a | 625 | |
e681b954 | 626 | Driver->RequestExtSize = sizeof(struct rndis_filter_packet); |
fceaf24a | 627 | |
454f18a9 | 628 | /* Driver->Context = rndisDriver; */ |
fceaf24a | 629 | |
e681b954 | 630 | memset(&gRndisFilter, 0, sizeof(struct rndis_filter_driver_object)); |
fceaf24a HJ |
631 | |
632 | /*rndisDriver->Driver = Driver; | |
633 | ||
634 | ASSERT(Driver->OnLinkStatusChanged); | |
635 | rndisDriver->OnLinkStatusChanged = Driver->OnLinkStatusChanged;*/ | |
636 | ||
454f18a9 | 637 | /* Save the original dispatch handlers before we override it */ |
fceaf24a | 638 | gRndisFilter.InnerDriver.Base.OnDeviceAdd = Driver->Base.OnDeviceAdd; |
0120ee0d GKH |
639 | gRndisFilter.InnerDriver.Base.OnDeviceRemove = |
640 | Driver->Base.OnDeviceRemove; | |
fceaf24a HJ |
641 | gRndisFilter.InnerDriver.Base.OnCleanup = Driver->Base.OnCleanup; |
642 | ||
45e44314 BP |
643 | /* ASSERT(Driver->OnSend); */ |
644 | /* ASSERT(Driver->OnReceiveCallback); */ | |
fceaf24a HJ |
645 | gRndisFilter.InnerDriver.OnSend = Driver->OnSend; |
646 | gRndisFilter.InnerDriver.OnReceiveCallback = Driver->OnReceiveCallback; | |
0120ee0d GKH |
647 | gRndisFilter.InnerDriver.OnLinkStatusChanged = |
648 | Driver->OnLinkStatusChanged; | |
fceaf24a | 649 | |
454f18a9 | 650 | /* Override */ |
fceaf24a HJ |
651 | Driver->Base.OnDeviceAdd = RndisFilterOnDeviceAdd; |
652 | Driver->Base.OnDeviceRemove = RndisFilterOnDeviceRemove; | |
653 | Driver->Base.OnCleanup = RndisFilterOnCleanup; | |
654 | Driver->OnSend = RndisFilterOnSend; | |
454f18a9 | 655 | /* Driver->QueryLinkStatus = RndisFilterQueryDeviceLinkStatus; */ |
fceaf24a HJ |
656 | Driver->OnReceiveCallback = RndisFilterOnReceive; |
657 | ||
658 | DPRINT_EXIT(NETVSC); | |
659 | ||
660 | return 0; | |
661 | } | |
662 | ||
e681b954 | 663 | static int RndisFilterInitDevice(struct rndis_device *Device) |
fceaf24a | 664 | { |
e681b954 | 665 | struct rndis_request *request; |
9f33d054 GKH |
666 | struct rndis_initialize_request *init; |
667 | struct rndis_initialize_complete *initComplete; | |
4d643114 | 668 | u32 status; |
fceaf24a HJ |
669 | int ret; |
670 | ||
671 | DPRINT_ENTER(NETVSC); | |
672 | ||
0120ee0d GKH |
673 | request = GetRndisRequest(Device, REMOTE_NDIS_INITIALIZE_MSG, |
674 | RNDIS_MESSAGE_SIZE(struct rndis_initialize_request)); | |
675 | if (!request) { | |
fceaf24a HJ |
676 | ret = -1; |
677 | goto Cleanup; | |
678 | } | |
679 | ||
454f18a9 | 680 | /* Setup the rndis set */ |
fceaf24a HJ |
681 | init = &request->RequestMessage.Message.InitializeRequest; |
682 | init->MajorVersion = RNDIS_MAJOR_VERSION; | |
683 | init->MinorVersion = RNDIS_MINOR_VERSION; | |
0120ee0d GKH |
684 | /* FIXME: Use 1536 - rounded ethernet frame size */ |
685 | init->MaxTransferSize = 2048; | |
fceaf24a HJ |
686 | |
687 | Device->State = RNDIS_DEV_INITIALIZING; | |
688 | ||
689 | ret = RndisFilterSendRequest(Device, request); | |
0120ee0d | 690 | if (ret != 0) { |
fceaf24a HJ |
691 | Device->State = RNDIS_DEV_UNINITIALIZED; |
692 | goto Cleanup; | |
693 | } | |
694 | ||
bfc30aae | 695 | osd_WaitEventWait(request->WaitEvent); |
fceaf24a HJ |
696 | |
697 | initComplete = &request->ResponseMessage.Message.InitializeComplete; | |
698 | status = initComplete->Status; | |
0120ee0d | 699 | if (status == RNDIS_STATUS_SUCCESS) { |
fceaf24a HJ |
700 | Device->State = RNDIS_DEV_INITIALIZED; |
701 | ret = 0; | |
0120ee0d | 702 | } else { |
fceaf24a HJ |
703 | Device->State = RNDIS_DEV_UNINITIALIZED; |
704 | ret = -1; | |
705 | } | |
706 | ||
707 | Cleanup: | |
708 | if (request) | |
fceaf24a | 709 | PutRndisRequest(Device, request); |
fceaf24a HJ |
710 | DPRINT_EXIT(NETVSC); |
711 | ||
712 | return ret; | |
713 | } | |
714 | ||
e681b954 | 715 | static void RndisFilterHaltDevice(struct rndis_device *Device) |
fceaf24a | 716 | { |
e681b954 | 717 | struct rndis_request *request; |
9f33d054 | 718 | struct rndis_halt_request *halt; |
fceaf24a HJ |
719 | |
720 | DPRINT_ENTER(NETVSC); | |
721 | ||
454f18a9 | 722 | /* Attempt to do a rndis device halt */ |
0120ee0d GKH |
723 | request = GetRndisRequest(Device, REMOTE_NDIS_HALT_MSG, |
724 | RNDIS_MESSAGE_SIZE(struct rndis_halt_request)); | |
fceaf24a | 725 | if (!request) |
fceaf24a | 726 | goto Cleanup; |
fceaf24a | 727 | |
454f18a9 | 728 | /* Setup the rndis set */ |
fceaf24a | 729 | halt = &request->RequestMessage.Message.HaltRequest; |
f4888417 | 730 | halt->RequestId = atomic_inc_return(&Device->NewRequestId); |
fceaf24a | 731 | |
454f18a9 | 732 | /* Ignore return since this msg is optional. */ |
fceaf24a HJ |
733 | RndisFilterSendRequest(Device, request); |
734 | ||
735 | Device->State = RNDIS_DEV_UNINITIALIZED; | |
736 | ||
737 | Cleanup: | |
738 | if (request) | |
fceaf24a | 739 | PutRndisRequest(Device, request); |
fceaf24a HJ |
740 | DPRINT_EXIT(NETVSC); |
741 | return; | |
742 | } | |
743 | ||
e681b954 | 744 | static int RndisFilterOpenDevice(struct rndis_device *Device) |
fceaf24a | 745 | { |
0120ee0d | 746 | int ret; |
fceaf24a HJ |
747 | |
748 | DPRINT_ENTER(NETVSC); | |
749 | ||
750 | if (Device->State != RNDIS_DEV_INITIALIZED) | |
751 | return 0; | |
752 | ||
0120ee0d GKH |
753 | ret = RndisFilterSetPacketFilter(Device, |
754 | NDIS_PACKET_TYPE_BROADCAST | | |
755 | NDIS_PACKET_TYPE_DIRECTED); | |
fceaf24a | 756 | if (ret == 0) |
fceaf24a | 757 | Device->State = RNDIS_DEV_DATAINITIALIZED; |
fceaf24a HJ |
758 | |
759 | DPRINT_EXIT(NETVSC); | |
760 | return ret; | |
761 | } | |
762 | ||
e681b954 | 763 | static int RndisFilterCloseDevice(struct rndis_device *Device) |
fceaf24a HJ |
764 | { |
765 | int ret; | |
766 | ||
767 | DPRINT_ENTER(NETVSC); | |
768 | ||
769 | if (Device->State != RNDIS_DEV_DATAINITIALIZED) | |
770 | return 0; | |
771 | ||
772 | ret = RndisFilterSetPacketFilter(Device, 0); | |
773 | if (ret == 0) | |
fceaf24a | 774 | Device->State = RNDIS_DEV_INITIALIZED; |
fceaf24a HJ |
775 | |
776 | DPRINT_EXIT(NETVSC); | |
777 | ||
778 | return ret; | |
779 | } | |
780 | ||
0120ee0d GKH |
781 | static int RndisFilterOnDeviceAdd(struct hv_device *Device, |
782 | void *AdditionalInfo) | |
fceaf24a HJ |
783 | { |
784 | int ret; | |
ce9ea4cf | 785 | struct netvsc_device *netDevice; |
e681b954 | 786 | struct rndis_device *rndisDevice; |
0120ee0d | 787 | struct netvsc_device_info *deviceInfo = AdditionalInfo; |
fceaf24a HJ |
788 | |
789 | DPRINT_ENTER(NETVSC); | |
790 | ||
fceaf24a | 791 | rndisDevice = GetRndisDevice(); |
0120ee0d | 792 | if (!rndisDevice) { |
fceaf24a HJ |
793 | DPRINT_EXIT(NETVSC); |
794 | return -1; | |
795 | } | |
796 | ||
797 | DPRINT_DBG(NETVSC, "rndis device object allocated - %p", rndisDevice); | |
798 | ||
0120ee0d GKH |
799 | /* |
800 | * Let the inner driver handle this first to create the netvsc channel | |
801 | * NOTE! Once the channel is created, we may get a receive callback | |
802 | * (RndisFilterOnReceive()) before this call is completed | |
803 | */ | |
fceaf24a | 804 | ret = gRndisFilter.InnerDriver.Base.OnDeviceAdd(Device, AdditionalInfo); |
0120ee0d GKH |
805 | if (ret != 0) { |
806 | kfree(rndisDevice); | |
fceaf24a HJ |
807 | DPRINT_EXIT(NETVSC); |
808 | return ret; | |
809 | } | |
810 | ||
454f18a9 BP |
811 | |
812 | /* Initialize the rndis device */ | |
0120ee0d | 813 | netDevice = Device->Extension; |
45e44314 BP |
814 | /* ASSERT(netDevice); */ |
815 | /* ASSERT(netDevice->Device); */ | |
fceaf24a HJ |
816 | |
817 | netDevice->Extension = rndisDevice; | |
818 | rndisDevice->NetDevice = netDevice; | |
819 | ||
454f18a9 | 820 | /* Send the rndis initialization message */ |
fceaf24a | 821 | ret = RndisFilterInitDevice(rndisDevice); |
0120ee0d GKH |
822 | if (ret != 0) { |
823 | /* | |
824 | * TODO: If rndis init failed, we will need to shut down the | |
825 | * channel | |
826 | */ | |
fceaf24a HJ |
827 | } |
828 | ||
454f18a9 | 829 | /* Get the mac address */ |
fceaf24a | 830 | ret = RndisFilterQueryDeviceMac(rndisDevice); |
0120ee0d GKH |
831 | if (ret != 0) { |
832 | /* | |
833 | * TODO: shutdown rndis device and the channel | |
834 | */ | |
fceaf24a HJ |
835 | } |
836 | ||
9f8bd8ba SH |
837 | DPRINT_INFO(NETVSC, "Device 0x%p mac addr %pM", |
838 | rndisDevice, rndisDevice->HwMacAddr); | |
fceaf24a | 839 | |
9f8bd8ba | 840 | memcpy(deviceInfo->MacAddr, rndisDevice->HwMacAddr, ETH_ALEN); |
fceaf24a HJ |
841 | |
842 | RndisFilterQueryDeviceLinkStatus(rndisDevice); | |
843 | ||
844 | deviceInfo->LinkState = rndisDevice->LinkStatus; | |
0120ee0d GKH |
845 | DPRINT_INFO(NETVSC, "Device 0x%p link state %s", rndisDevice, |
846 | ((deviceInfo->LinkState) ? ("down") : ("up"))); | |
fceaf24a HJ |
847 | |
848 | DPRINT_EXIT(NETVSC); | |
849 | ||
850 | return ret; | |
851 | } | |
852 | ||
0120ee0d | 853 | static int RndisFilterOnDeviceRemove(struct hv_device *Device) |
fceaf24a | 854 | { |
ce9ea4cf | 855 | struct netvsc_device *netDevice = Device->Extension; |
0120ee0d | 856 | struct rndis_device *rndisDevice = netDevice->Extension; |
fceaf24a HJ |
857 | |
858 | DPRINT_ENTER(NETVSC); | |
859 | ||
454f18a9 | 860 | /* Halt and release the rndis device */ |
fceaf24a HJ |
861 | RndisFilterHaltDevice(rndisDevice); |
862 | ||
0120ee0d | 863 | kfree(rndisDevice); |
fceaf24a HJ |
864 | netDevice->Extension = NULL; |
865 | ||
454f18a9 | 866 | /* Pass control to inner driver to remove the device */ |
fceaf24a HJ |
867 | gRndisFilter.InnerDriver.Base.OnDeviceRemove(Device); |
868 | ||
869 | DPRINT_EXIT(NETVSC); | |
870 | ||
871 | return 0; | |
872 | } | |
873 | ||
0120ee0d | 874 | static void RndisFilterOnCleanup(struct hv_driver *Driver) |
fceaf24a HJ |
875 | { |
876 | DPRINT_ENTER(NETVSC); | |
877 | ||
878 | DPRINT_EXIT(NETVSC); | |
879 | } | |
880 | ||
2d075346 | 881 | int RndisFilterOnOpen(struct hv_device *Device) |
fceaf24a HJ |
882 | { |
883 | int ret; | |
ce9ea4cf | 884 | struct netvsc_device *netDevice = Device->Extension; |
fceaf24a HJ |
885 | |
886 | DPRINT_ENTER(NETVSC); | |
887 | ||
888 | ASSERT(netDevice); | |
0120ee0d | 889 | ret = RndisFilterOpenDevice(netDevice->Extension); |
fceaf24a HJ |
890 | |
891 | DPRINT_EXIT(NETVSC); | |
892 | ||
893 | return ret; | |
894 | } | |
895 | ||
4f28900b | 896 | int RndisFilterOnClose(struct hv_device *Device) |
fceaf24a HJ |
897 | { |
898 | int ret; | |
ce9ea4cf | 899 | struct netvsc_device *netDevice = Device->Extension; |
fceaf24a HJ |
900 | |
901 | DPRINT_ENTER(NETVSC); | |
902 | ||
903 | ASSERT(netDevice); | |
0120ee0d | 904 | ret = RndisFilterCloseDevice(netDevice->Extension); |
fceaf24a HJ |
905 | |
906 | DPRINT_EXIT(NETVSC); | |
907 | ||
908 | return ret; | |
909 | } | |
910 | ||
0120ee0d GKH |
911 | static int RndisFilterOnSend(struct hv_device *Device, |
912 | struct hv_netvsc_packet *Packet) | |
fceaf24a | 913 | { |
0120ee0d | 914 | int ret; |
e681b954 | 915 | struct rndis_filter_packet *filterPacket; |
9f33d054 GKH |
916 | struct rndis_message *rndisMessage; |
917 | struct rndis_packet *rndisPacket; | |
4d643114 | 918 | u32 rndisMessageSize; |
fceaf24a HJ |
919 | |
920 | DPRINT_ENTER(NETVSC); | |
921 | ||
454f18a9 | 922 | /* Add the rndis header */ |
e681b954 | 923 | filterPacket = (struct rndis_filter_packet *)Packet->Extension; |
45e44314 | 924 | /* ASSERT(filterPacket); */ |
fceaf24a | 925 | |
e681b954 | 926 | memset(filterPacket, 0, sizeof(struct rndis_filter_packet)); |
fceaf24a HJ |
927 | |
928 | rndisMessage = &filterPacket->Message; | |
9f33d054 | 929 | rndisMessageSize = RNDIS_MESSAGE_SIZE(struct rndis_packet); |
fceaf24a HJ |
930 | |
931 | rndisMessage->NdisMessageType = REMOTE_NDIS_PACKET_MSG; | |
0120ee0d GKH |
932 | rndisMessage->MessageLength = Packet->TotalDataBufferLength + |
933 | rndisMessageSize; | |
fceaf24a HJ |
934 | |
935 | rndisPacket = &rndisMessage->Message.Packet; | |
9f33d054 | 936 | rndisPacket->DataOffset = sizeof(struct rndis_packet); |
fceaf24a HJ |
937 | rndisPacket->DataLength = Packet->TotalDataBufferLength; |
938 | ||
0e727613 | 939 | Packet->IsDataPacket = true; |
0120ee0d GKH |
940 | Packet->PageBuffers[0].Pfn = virt_to_phys(rndisMessage) >> PAGE_SHIFT; |
941 | Packet->PageBuffers[0].Offset = | |
942 | (unsigned long)rndisMessage & (PAGE_SIZE-1); | |
943 | Packet->PageBuffers[0].Length = rndisMessageSize; | |
fceaf24a | 944 | |
454f18a9 | 945 | /* Save the packet send completion and context */ |
fceaf24a | 946 | filterPacket->OnCompletion = Packet->Completion.Send.OnSendCompletion; |
0120ee0d GKH |
947 | filterPacket->CompletionContext = |
948 | Packet->Completion.Send.SendCompletionContext; | |
fceaf24a | 949 | |
454f18a9 | 950 | /* Use ours */ |
fceaf24a HJ |
951 | Packet->Completion.Send.OnSendCompletion = RndisFilterOnSendCompletion; |
952 | Packet->Completion.Send.SendCompletionContext = filterPacket; | |
953 | ||
954 | ret = gRndisFilter.InnerDriver.OnSend(Device, Packet); | |
0120ee0d GKH |
955 | if (ret != 0) { |
956 | /* | |
957 | * Reset the completion to originals to allow retries from | |
958 | * above | |
959 | */ | |
960 | Packet->Completion.Send.OnSendCompletion = | |
961 | filterPacket->OnCompletion; | |
962 | Packet->Completion.Send.SendCompletionContext = | |
963 | filterPacket->CompletionContext; | |
fceaf24a HJ |
964 | } |
965 | ||
966 | DPRINT_EXIT(NETVSC); | |
967 | ||
968 | return ret; | |
969 | } | |
970 | ||
0120ee0d | 971 | static void RndisFilterOnSendCompletion(void *Context) |
fceaf24a | 972 | { |
0120ee0d | 973 | struct rndis_filter_packet *filterPacket = Context; |
fceaf24a HJ |
974 | |
975 | DPRINT_ENTER(NETVSC); | |
976 | ||
454f18a9 | 977 | /* Pass it back to the original handler */ |
fceaf24a HJ |
978 | filterPacket->OnCompletion(filterPacket->CompletionContext); |
979 | ||
980 | DPRINT_EXIT(NETVSC); | |
981 | } | |
982 | ||
983 | ||
0120ee0d | 984 | static void RndisFilterOnSendRequestCompletion(void *Context) |
fceaf24a HJ |
985 | { |
986 | DPRINT_ENTER(NETVSC); | |
987 | ||
454f18a9 | 988 | /* Noop */ |
fceaf24a HJ |
989 | DPRINT_EXIT(NETVSC); |
990 | } |