Merge branch 'x86-mce-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git...
[deliverable/linux.git] / drivers / staging / hv / storvsc.c
1 /*
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>
20 */
21 #include <linux/kernel.h>
22 #include <linux/string.h>
23 #include <linux/slab.h>
24 #include <linux/mm.h>
25 #include <linux/delay.h>
26 #include "osd.h"
27 #include "logging.h"
28 #include "storvsc_api.h"
29 #include "vmbus_packet_format.h"
30 #include "vstorage.h"
31
32
33 struct storvsc_request_extension {
34 /* LIST_ENTRY ListEntry; */
35
36 struct hv_storvsc_request *Request;
37 struct hv_device *Device;
38
39 /* Synchronize the request/response if needed */
40 struct osd_waitevent *WaitEvent;
41
42 struct vstor_packet VStorPacket;
43 };
44
45 /* A storvsc device is a device object that contains a vmbus channel */
46 struct storvsc_device {
47 struct hv_device *Device;
48
49 /* 0 indicates the device is being destroyed */
50 atomic_t RefCount;
51
52 atomic_t NumOutstandingRequests;
53
54 /*
55 * Each unique Port/Path/Target represents 1 channel ie scsi
56 * controller. In reality, the pathid, targetid is always 0
57 * and the port is set by us
58 */
59 unsigned int PortNumber;
60 unsigned char PathId;
61 unsigned char TargetId;
62
63 /* LIST_ENTRY OutstandingRequestList; */
64 /* HANDLE OutstandingRequestLock; */
65
66 /* Used for vsc/vsp channel reset process */
67 struct storvsc_request_extension InitRequest;
68 struct storvsc_request_extension ResetRequest;
69 };
70
71
72 static const char *gDriverName = "storvsc";
73
74 /* {ba6163d9-04a1-4d29-b605-72e2ffb1dc7f} */
75 static const struct hv_guid gStorVscDeviceType = {
76 .data = {
77 0xd9, 0x63, 0x61, 0xba, 0xa1, 0x04, 0x29, 0x4d,
78 0xb6, 0x05, 0x72, 0xe2, 0xff, 0xb1, 0xdc, 0x7f
79 }
80 };
81
82
83 static inline struct storvsc_device *AllocStorDevice(struct hv_device *Device)
84 {
85 struct storvsc_device *storDevice;
86
87 storDevice = kzalloc(sizeof(struct storvsc_device), GFP_KERNEL);
88 if (!storDevice)
89 return NULL;
90
91 /* Set to 2 to allow both inbound and outbound traffics */
92 /* (ie GetStorDevice() and MustGetStorDevice()) to proceed. */
93 atomic_cmpxchg(&storDevice->RefCount, 0, 2);
94
95 storDevice->Device = Device;
96 Device->Extension = storDevice;
97
98 return storDevice;
99 }
100
101 static inline void FreeStorDevice(struct storvsc_device *Device)
102 {
103 /* ASSERT(atomic_read(&Device->RefCount) == 0); */
104 kfree(Device);
105 }
106
107 /* Get the stordevice object iff exists and its refcount > 1 */
108 static inline struct storvsc_device *GetStorDevice(struct hv_device *Device)
109 {
110 struct storvsc_device *storDevice;
111
112 storDevice = (struct storvsc_device *)Device->Extension;
113 if (storDevice && atomic_read(&storDevice->RefCount) > 1)
114 atomic_inc(&storDevice->RefCount);
115 else
116 storDevice = NULL;
117
118 return storDevice;
119 }
120
121 /* Get the stordevice object iff exists and its refcount > 0 */
122 static inline struct storvsc_device *MustGetStorDevice(struct hv_device *Device)
123 {
124 struct storvsc_device *storDevice;
125
126 storDevice = (struct storvsc_device *)Device->Extension;
127 if (storDevice && atomic_read(&storDevice->RefCount))
128 atomic_inc(&storDevice->RefCount);
129 else
130 storDevice = NULL;
131
132 return storDevice;
133 }
134
135 static inline void PutStorDevice(struct hv_device *Device)
136 {
137 struct storvsc_device *storDevice;
138
139 storDevice = (struct storvsc_device *)Device->Extension;
140 /* ASSERT(storDevice); */
141
142 atomic_dec(&storDevice->RefCount);
143 /* ASSERT(atomic_read(&storDevice->RefCount)); */
144 }
145
146 /* Drop ref count to 1 to effectively disable GetStorDevice() */
147 static inline struct storvsc_device *ReleaseStorDevice(struct hv_device *Device)
148 {
149 struct storvsc_device *storDevice;
150
151 storDevice = (struct storvsc_device *)Device->Extension;
152 /* ASSERT(storDevice); */
153
154 /* Busy wait until the ref drop to 2, then set it to 1 */
155 while (atomic_cmpxchg(&storDevice->RefCount, 2, 1) != 2)
156 udelay(100);
157
158 return storDevice;
159 }
160
161 /* Drop ref count to 0. No one can use StorDevice object. */
162 static inline struct storvsc_device *FinalReleaseStorDevice(
163 struct hv_device *Device)
164 {
165 struct storvsc_device *storDevice;
166
167 storDevice = (struct storvsc_device *)Device->Extension;
168 /* ASSERT(storDevice); */
169
170 /* Busy wait until the ref drop to 1, then set it to 0 */
171 while (atomic_cmpxchg(&storDevice->RefCount, 1, 0) != 1)
172 udelay(100);
173
174 Device->Extension = NULL;
175 return storDevice;
176 }
177
178 static int StorVscChannelInit(struct hv_device *Device)
179 {
180 struct storvsc_device *storDevice;
181 struct storvsc_request_extension *request;
182 struct vstor_packet *vstorPacket;
183 int ret;
184
185 storDevice = GetStorDevice(Device);
186 if (!storDevice) {
187 DPRINT_ERR(STORVSC, "unable to get stor device..."
188 "device being destroyed?");
189 return -1;
190 }
191
192 request = &storDevice->InitRequest;
193 vstorPacket = &request->VStorPacket;
194
195 /*
196 * Now, initiate the vsc/vsp initialization protocol on the open
197 * channel
198 */
199 memset(request, 0, sizeof(struct storvsc_request_extension));
200 request->WaitEvent = osd_WaitEventCreate();
201 if (!request->WaitEvent) {
202 ret = -ENOMEM;
203 goto nomem;
204 }
205
206 vstorPacket->Operation = VStorOperationBeginInitialization;
207 vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
208
209 /*SpinlockAcquire(gDriverExt.packetListLock);
210 INSERT_TAIL_LIST(&gDriverExt.packetList, &packet->listEntry.entry);
211 SpinlockRelease(gDriverExt.packetListLock);*/
212
213 DPRINT_INFO(STORVSC, "BEGIN_INITIALIZATION_OPERATION...");
214
215 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
216 vstorPacket,
217 sizeof(struct vstor_packet),
218 (unsigned long)request,
219 VmbusPacketTypeDataInBand,
220 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
221 if (ret != 0) {
222 DPRINT_ERR(STORVSC,
223 "unable to send BEGIN_INITIALIZATION_OPERATION");
224 goto Cleanup;
225 }
226
227 osd_WaitEventWait(request->WaitEvent);
228
229 if (vstorPacket->Operation != VStorOperationCompleteIo ||
230 vstorPacket->Status != 0) {
231 DPRINT_ERR(STORVSC, "BEGIN_INITIALIZATION_OPERATION failed "
232 "(op %d status 0x%x)",
233 vstorPacket->Operation, vstorPacket->Status);
234 goto Cleanup;
235 }
236
237 DPRINT_INFO(STORVSC, "QUERY_PROTOCOL_VERSION_OPERATION...");
238
239 /* reuse the packet for version range supported */
240 memset(vstorPacket, 0, sizeof(struct vstor_packet));
241 vstorPacket->Operation = VStorOperationQueryProtocolVersion;
242 vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
243
244 vstorPacket->Version.MajorMinor = VMSTOR_PROTOCOL_VERSION_CURRENT;
245 FILL_VMSTOR_REVISION(vstorPacket->Version.Revision);
246
247 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
248 vstorPacket,
249 sizeof(struct vstor_packet),
250 (unsigned long)request,
251 VmbusPacketTypeDataInBand,
252 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
253 if (ret != 0) {
254 DPRINT_ERR(STORVSC,
255 "unable to send BEGIN_INITIALIZATION_OPERATION");
256 goto Cleanup;
257 }
258
259 osd_WaitEventWait(request->WaitEvent);
260
261 /* TODO: Check returned version */
262 if (vstorPacket->Operation != VStorOperationCompleteIo ||
263 vstorPacket->Status != 0) {
264 DPRINT_ERR(STORVSC, "QUERY_PROTOCOL_VERSION_OPERATION failed "
265 "(op %d status 0x%x)",
266 vstorPacket->Operation, vstorPacket->Status);
267 goto Cleanup;
268 }
269
270 /* Query channel properties */
271 DPRINT_INFO(STORVSC, "QUERY_PROPERTIES_OPERATION...");
272
273 memset(vstorPacket, 0, sizeof(struct vstor_packet));
274 vstorPacket->Operation = VStorOperationQueryProperties;
275 vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
276 vstorPacket->StorageChannelProperties.PortNumber =
277 storDevice->PortNumber;
278
279 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
280 vstorPacket,
281 sizeof(struct vstor_packet),
282 (unsigned long)request,
283 VmbusPacketTypeDataInBand,
284 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
285
286 if (ret != 0) {
287 DPRINT_ERR(STORVSC,
288 "unable to send QUERY_PROPERTIES_OPERATION");
289 goto Cleanup;
290 }
291
292 osd_WaitEventWait(request->WaitEvent);
293
294 /* TODO: Check returned version */
295 if (vstorPacket->Operation != VStorOperationCompleteIo ||
296 vstorPacket->Status != 0) {
297 DPRINT_ERR(STORVSC, "QUERY_PROPERTIES_OPERATION failed "
298 "(op %d status 0x%x)",
299 vstorPacket->Operation, vstorPacket->Status);
300 goto Cleanup;
301 }
302
303 storDevice->PathId = vstorPacket->StorageChannelProperties.PathId;
304 storDevice->TargetId = vstorPacket->StorageChannelProperties.TargetId;
305
306 DPRINT_DBG(STORVSC, "channel flag 0x%x, max xfer len 0x%x",
307 vstorPacket->StorageChannelProperties.Flags,
308 vstorPacket->StorageChannelProperties.MaxTransferBytes);
309
310 DPRINT_INFO(STORVSC, "END_INITIALIZATION_OPERATION...");
311
312 memset(vstorPacket, 0, sizeof(struct vstor_packet));
313 vstorPacket->Operation = VStorOperationEndInitialization;
314 vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
315
316 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
317 vstorPacket,
318 sizeof(struct vstor_packet),
319 (unsigned long)request,
320 VmbusPacketTypeDataInBand,
321 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
322
323 if (ret != 0) {
324 DPRINT_ERR(STORVSC,
325 "unable to send END_INITIALIZATION_OPERATION");
326 goto Cleanup;
327 }
328
329 osd_WaitEventWait(request->WaitEvent);
330
331 if (vstorPacket->Operation != VStorOperationCompleteIo ||
332 vstorPacket->Status != 0) {
333 DPRINT_ERR(STORVSC, "END_INITIALIZATION_OPERATION failed "
334 "(op %d status 0x%x)",
335 vstorPacket->Operation, vstorPacket->Status);
336 goto Cleanup;
337 }
338
339 DPRINT_INFO(STORVSC, "**** storage channel up and running!! ****");
340
341 Cleanup:
342 kfree(request->WaitEvent);
343 request->WaitEvent = NULL;
344 nomem:
345 PutStorDevice(Device);
346 return ret;
347 }
348
349 static void StorVscOnIOCompletion(struct hv_device *Device,
350 struct vstor_packet *VStorPacket,
351 struct storvsc_request_extension *RequestExt)
352 {
353 struct hv_storvsc_request *request;
354 struct storvsc_device *storDevice;
355
356 storDevice = MustGetStorDevice(Device);
357 if (!storDevice) {
358 DPRINT_ERR(STORVSC, "unable to get stor device..."
359 "device being destroyed?");
360 return;
361 }
362
363 DPRINT_DBG(STORVSC, "IO_COMPLETE_OPERATION - request extension %p "
364 "completed bytes xfer %u", RequestExt,
365 VStorPacket->VmSrb.DataTransferLength);
366
367 /* ASSERT(RequestExt != NULL); */
368 /* ASSERT(RequestExt->Request != NULL); */
369
370 request = RequestExt->Request;
371
372 /* ASSERT(request->OnIOCompletion != NULL); */
373
374 /* Copy over the status...etc */
375 request->Status = VStorPacket->VmSrb.ScsiStatus;
376
377 if (request->Status != 0 || VStorPacket->VmSrb.SrbStatus != 1) {
378 DPRINT_WARN(STORVSC,
379 "cmd 0x%x scsi status 0x%x srb status 0x%x\n",
380 request->Cdb[0], VStorPacket->VmSrb.ScsiStatus,
381 VStorPacket->VmSrb.SrbStatus);
382 }
383
384 if ((request->Status & 0xFF) == 0x02) {
385 /* CHECK_CONDITION */
386 if (VStorPacket->VmSrb.SrbStatus & 0x80) {
387 /* autosense data available */
388 DPRINT_WARN(STORVSC, "storvsc pkt %p autosense data "
389 "valid - len %d\n", RequestExt,
390 VStorPacket->VmSrb.SenseInfoLength);
391
392 /* ASSERT(VStorPacket->VmSrb.SenseInfoLength <= */
393 /* request->SenseBufferSize); */
394 memcpy(request->SenseBuffer,
395 VStorPacket->VmSrb.SenseData,
396 VStorPacket->VmSrb.SenseInfoLength);
397
398 request->SenseBufferSize =
399 VStorPacket->VmSrb.SenseInfoLength;
400 }
401 }
402
403 /* TODO: */
404 request->BytesXfer = VStorPacket->VmSrb.DataTransferLength;
405
406 request->OnIOCompletion(request);
407
408 atomic_dec(&storDevice->NumOutstandingRequests);
409
410 PutStorDevice(Device);
411 }
412
413 static void StorVscOnReceive(struct hv_device *Device,
414 struct vstor_packet *VStorPacket,
415 struct storvsc_request_extension *RequestExt)
416 {
417 switch (VStorPacket->Operation) {
418 case VStorOperationCompleteIo:
419 DPRINT_DBG(STORVSC, "IO_COMPLETE_OPERATION");
420 StorVscOnIOCompletion(Device, VStorPacket, RequestExt);
421 break;
422 case VStorOperationRemoveDevice:
423 DPRINT_INFO(STORVSC, "REMOVE_DEVICE_OPERATION");
424 /* TODO: */
425 break;
426
427 default:
428 DPRINT_INFO(STORVSC, "Unknown operation received - %d",
429 VStorPacket->Operation);
430 break;
431 }
432 }
433
434 static void StorVscOnChannelCallback(void *context)
435 {
436 struct hv_device *device = (struct hv_device *)context;
437 struct storvsc_device *storDevice;
438 u32 bytesRecvd;
439 u64 requestId;
440 unsigned char packet[ALIGN_UP(sizeof(struct vstor_packet), 8)];
441 struct storvsc_request_extension *request;
442 int ret;
443
444 /* ASSERT(device); */
445
446 storDevice = MustGetStorDevice(device);
447 if (!storDevice) {
448 DPRINT_ERR(STORVSC, "unable to get stor device..."
449 "device being destroyed?");
450 return;
451 }
452
453 do {
454 ret = device->Driver->VmbusChannelInterface.RecvPacket(device,
455 packet,
456 ALIGN_UP(sizeof(struct vstor_packet), 8),
457 &bytesRecvd, &requestId);
458 if (ret == 0 && bytesRecvd > 0) {
459 DPRINT_DBG(STORVSC, "receive %d bytes - tid %llx",
460 bytesRecvd, requestId);
461
462 /* ASSERT(bytesRecvd == sizeof(struct vstor_packet)); */
463
464 request = (struct storvsc_request_extension *)
465 (unsigned long)requestId;
466 /* ASSERT(request);c */
467
468 /* if (vstorPacket.Flags & SYNTHETIC_FLAG) */
469 if ((request == &storDevice->InitRequest) ||
470 (request == &storDevice->ResetRequest)) {
471 /* DPRINT_INFO(STORVSC,
472 * "reset completion - operation "
473 * "%u status %u",
474 * vstorPacket.Operation,
475 * vstorPacket.Status); */
476
477 memcpy(&request->VStorPacket, packet,
478 sizeof(struct vstor_packet));
479
480 osd_WaitEventSet(request->WaitEvent);
481 } else {
482 StorVscOnReceive(device,
483 (struct vstor_packet *)packet,
484 request);
485 }
486 } else {
487 /* DPRINT_DBG(STORVSC, "nothing else to read..."); */
488 break;
489 }
490 } while (1);
491
492 PutStorDevice(device);
493 return;
494 }
495
496 static int StorVscConnectToVsp(struct hv_device *Device)
497 {
498 struct vmstorage_channel_properties props;
499 struct storvsc_driver_object *storDriver;
500 int ret;
501
502 storDriver = (struct storvsc_driver_object *)Device->Driver;
503 memset(&props, 0, sizeof(struct vmstorage_channel_properties));
504
505 /* Open the channel */
506 ret = Device->Driver->VmbusChannelInterface.Open(Device,
507 storDriver->RingBufferSize,
508 storDriver->RingBufferSize,
509 (void *)&props,
510 sizeof(struct vmstorage_channel_properties),
511 StorVscOnChannelCallback,
512 Device);
513
514 DPRINT_DBG(STORVSC, "storage props: path id %d, tgt id %d, max xfer %d",
515 props.PathId, props.TargetId, props.MaxTransferBytes);
516
517 if (ret != 0) {
518 DPRINT_ERR(STORVSC, "unable to open channel: %d", ret);
519 return -1;
520 }
521
522 ret = StorVscChannelInit(Device);
523
524 return ret;
525 }
526
527 /*
528 * StorVscOnDeviceAdd - Callback when the device belonging to this driver is added
529 */
530 static int StorVscOnDeviceAdd(struct hv_device *Device, void *AdditionalInfo)
531 {
532 struct storvsc_device *storDevice;
533 /* struct vmstorage_channel_properties *props; */
534 struct storvsc_device_info *deviceInfo;
535 int ret = 0;
536
537 deviceInfo = (struct storvsc_device_info *)AdditionalInfo;
538 storDevice = AllocStorDevice(Device);
539 if (!storDevice) {
540 ret = -1;
541 goto Cleanup;
542 }
543
544 /* Save the channel properties to our storvsc channel */
545 /* props = (struct vmstorage_channel_properties *)
546 * channel->offerMsg.Offer.u.Standard.UserDefined; */
547
548 /* FIXME: */
549 /*
550 * If we support more than 1 scsi channel, we need to set the
551 * port number here to the scsi channel but how do we get the
552 * scsi channel prior to the bus scan
553 */
554
555 /* storChannel->PortNumber = 0;
556 storChannel->PathId = props->PathId;
557 storChannel->TargetId = props->TargetId; */
558
559 storDevice->PortNumber = deviceInfo->PortNumber;
560 /* Send it back up */
561 ret = StorVscConnectToVsp(Device);
562
563 /* deviceInfo->PortNumber = storDevice->PortNumber; */
564 deviceInfo->PathId = storDevice->PathId;
565 deviceInfo->TargetId = storDevice->TargetId;
566
567 DPRINT_DBG(STORVSC, "assigned port %u, path %u target %u\n",
568 storDevice->PortNumber, storDevice->PathId,
569 storDevice->TargetId);
570
571 Cleanup:
572 return ret;
573 }
574
575 /*
576 * StorVscOnDeviceRemove - Callback when the our device is being removed
577 */
578 static int StorVscOnDeviceRemove(struct hv_device *Device)
579 {
580 struct storvsc_device *storDevice;
581
582 DPRINT_INFO(STORVSC, "disabling storage device (%p)...",
583 Device->Extension);
584
585 storDevice = ReleaseStorDevice(Device);
586
587 /*
588 * At this point, all outbound traffic should be disable. We
589 * only allow inbound traffic (responses) to proceed so that
590 * outstanding requests can be completed.
591 */
592 while (atomic_read(&storDevice->NumOutstandingRequests)) {
593 DPRINT_INFO(STORVSC, "waiting for %d requests to complete...",
594 atomic_read(&storDevice->NumOutstandingRequests));
595 udelay(100);
596 }
597
598 DPRINT_INFO(STORVSC, "removing storage device (%p)...",
599 Device->Extension);
600
601 storDevice = FinalReleaseStorDevice(Device);
602
603 DPRINT_INFO(STORVSC, "storage device (%p) safe to remove", storDevice);
604
605 /* Close the channel */
606 Device->Driver->VmbusChannelInterface.Close(Device);
607
608 FreeStorDevice(storDevice);
609 return 0;
610 }
611
612 int StorVscOnHostReset(struct hv_device *Device)
613 {
614 struct storvsc_device *storDevice;
615 struct storvsc_request_extension *request;
616 struct vstor_packet *vstorPacket;
617 int ret;
618
619 DPRINT_INFO(STORVSC, "resetting host adapter...");
620
621 storDevice = GetStorDevice(Device);
622 if (!storDevice) {
623 DPRINT_ERR(STORVSC, "unable to get stor device..."
624 "device being destroyed?");
625 return -1;
626 }
627
628 request = &storDevice->ResetRequest;
629 vstorPacket = &request->VStorPacket;
630
631 request->WaitEvent = osd_WaitEventCreate();
632 if (!request->WaitEvent) {
633 ret = -ENOMEM;
634 goto Cleanup;
635 }
636
637 vstorPacket->Operation = VStorOperationResetBus;
638 vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
639 vstorPacket->VmSrb.PathId = storDevice->PathId;
640
641 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
642 vstorPacket,
643 sizeof(struct vstor_packet),
644 (unsigned long)&storDevice->ResetRequest,
645 VmbusPacketTypeDataInBand,
646 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
647 if (ret != 0) {
648 DPRINT_ERR(STORVSC, "Unable to send reset packet %p ret %d",
649 vstorPacket, ret);
650 goto Cleanup;
651 }
652
653 /* FIXME: Add a timeout */
654 osd_WaitEventWait(request->WaitEvent);
655
656 kfree(request->WaitEvent);
657 DPRINT_INFO(STORVSC, "host adapter reset completed");
658
659 /*
660 * At this point, all outstanding requests in the adapter
661 * should have been flushed out and return to us
662 */
663
664 Cleanup:
665 PutStorDevice(Device);
666 return ret;
667 }
668
669 /*
670 * StorVscOnIORequest - Callback to initiate an I/O request
671 */
672 static int StorVscOnIORequest(struct hv_device *Device,
673 struct hv_storvsc_request *Request)
674 {
675 struct storvsc_device *storDevice;
676 struct storvsc_request_extension *requestExtension;
677 struct vstor_packet *vstorPacket;
678 int ret = 0;
679
680 requestExtension =
681 (struct storvsc_request_extension *)Request->Extension;
682 vstorPacket = &requestExtension->VStorPacket;
683 storDevice = GetStorDevice(Device);
684
685 DPRINT_DBG(STORVSC, "enter - Device %p, DeviceExt %p, Request %p, "
686 "Extension %p", Device, storDevice, Request,
687 requestExtension);
688
689 DPRINT_DBG(STORVSC, "req %p len %d bus %d, target %d, lun %d cdblen %d",
690 Request, Request->DataBuffer.Length, Request->Bus,
691 Request->TargetId, Request->LunId, Request->CdbLen);
692
693 if (!storDevice) {
694 DPRINT_ERR(STORVSC, "unable to get stor device..."
695 "device being destroyed?");
696 return -2;
697 }
698
699 /* print_hex_dump_bytes("", DUMP_PREFIX_NONE, Request->Cdb,
700 * Request->CdbLen); */
701
702 requestExtension->Request = Request;
703 requestExtension->Device = Device;
704
705 memset(vstorPacket, 0 , sizeof(struct vstor_packet));
706
707 vstorPacket->Flags |= REQUEST_COMPLETION_FLAG;
708
709 vstorPacket->VmSrb.Length = sizeof(struct vmscsi_request);
710
711 vstorPacket->VmSrb.PortNumber = Request->Host;
712 vstorPacket->VmSrb.PathId = Request->Bus;
713 vstorPacket->VmSrb.TargetId = Request->TargetId;
714 vstorPacket->VmSrb.Lun = Request->LunId;
715
716 vstorPacket->VmSrb.SenseInfoLength = SENSE_BUFFER_SIZE;
717
718 /* Copy over the scsi command descriptor block */
719 vstorPacket->VmSrb.CdbLength = Request->CdbLen;
720 memcpy(&vstorPacket->VmSrb.Cdb, Request->Cdb, Request->CdbLen);
721
722 vstorPacket->VmSrb.DataIn = Request->Type;
723 vstorPacket->VmSrb.DataTransferLength = Request->DataBuffer.Length;
724
725 vstorPacket->Operation = VStorOperationExecuteSRB;
726
727 DPRINT_DBG(STORVSC, "srb - len %d port %d, path %d, target %d, "
728 "lun %d senselen %d cdblen %d",
729 vstorPacket->VmSrb.Length,
730 vstorPacket->VmSrb.PortNumber,
731 vstorPacket->VmSrb.PathId,
732 vstorPacket->VmSrb.TargetId,
733 vstorPacket->VmSrb.Lun,
734 vstorPacket->VmSrb.SenseInfoLength,
735 vstorPacket->VmSrb.CdbLength);
736
737 if (requestExtension->Request->DataBuffer.Length) {
738 ret = Device->Driver->VmbusChannelInterface.
739 SendPacketMultiPageBuffer(Device,
740 &requestExtension->Request->DataBuffer,
741 vstorPacket,
742 sizeof(struct vstor_packet),
743 (unsigned long)requestExtension);
744 } else {
745 ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
746 vstorPacket,
747 sizeof(struct vstor_packet),
748 (unsigned long)requestExtension,
749 VmbusPacketTypeDataInBand,
750 VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
751 }
752
753 if (ret != 0) {
754 DPRINT_DBG(STORVSC, "Unable to send packet %p ret %d",
755 vstorPacket, ret);
756 }
757
758 atomic_inc(&storDevice->NumOutstandingRequests);
759
760 PutStorDevice(Device);
761 return ret;
762 }
763
764 /*
765 * StorVscOnCleanup - Perform any cleanup when the driver is removed
766 */
767 static void StorVscOnCleanup(struct hv_driver *Driver)
768 {
769 }
770
771 /*
772 * StorVscInitialize - Main entry point
773 */
774 int StorVscInitialize(struct hv_driver *Driver)
775 {
776 struct storvsc_driver_object *storDriver;
777
778 storDriver = (struct storvsc_driver_object *)Driver;
779
780 DPRINT_DBG(STORVSC, "sizeof(STORVSC_REQUEST)=%zd "
781 "sizeof(struct storvsc_request_extension)=%zd "
782 "sizeof(struct vstor_packet)=%zd, "
783 "sizeof(struct vmscsi_request)=%zd",
784 sizeof(struct hv_storvsc_request),
785 sizeof(struct storvsc_request_extension),
786 sizeof(struct vstor_packet),
787 sizeof(struct vmscsi_request));
788
789 /* Make sure we are at least 2 pages since 1 page is used for control */
790 /* ASSERT(storDriver->RingBufferSize >= (PAGE_SIZE << 1)); */
791
792 Driver->name = gDriverName;
793 memcpy(&Driver->deviceType, &gStorVscDeviceType,
794 sizeof(struct hv_guid));
795
796 storDriver->RequestExtSize = sizeof(struct storvsc_request_extension);
797
798 /*
799 * Divide the ring buffer data size (which is 1 page less
800 * than the ring buffer size since that page is reserved for
801 * the ring buffer indices) by the max request size (which is
802 * VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER + struct vstor_packet + u64)
803 */
804 storDriver->MaxOutstandingRequestsPerChannel =
805 ((storDriver->RingBufferSize - PAGE_SIZE) /
806 ALIGN_UP(MAX_MULTIPAGE_BUFFER_PACKET +
807 sizeof(struct vstor_packet) + sizeof(u64),
808 sizeof(u64)));
809
810 DPRINT_INFO(STORVSC, "max io %u, currently %u\n",
811 storDriver->MaxOutstandingRequestsPerChannel,
812 STORVSC_MAX_IO_REQUESTS);
813
814 /* Setup the dispatch table */
815 storDriver->Base.OnDeviceAdd = StorVscOnDeviceAdd;
816 storDriver->Base.OnDeviceRemove = StorVscOnDeviceRemove;
817 storDriver->Base.OnCleanup = StorVscOnCleanup;
818
819 storDriver->OnIORequest = StorVscOnIORequest;
820
821 return 0;
822 }
This page took 0.057059 seconds and 6 git commands to generate.