]> git.proxmox.com Git - mirror_edk2.git/blob - MdeModulePkg/Bus/Usb/UsbMassStorageDxe/UsbMassBoot.c
projects / mirror_edk2.git / blob
? search:


80fdf470558d3626fb6e64ee5f5a4fbd8167c8d7
[mirror_edk2.git] / MdeModulePkg / Bus / Usb / UsbMassStorageDxe / UsbMassBoot.c
1 /** @file
2
3 Copyright (c) 2007, Intel Corporation
4 All rights reserved. This program and the accompanying materials
5 are licensed and made available under the terms and conditions of the BSD License
6 which accompanies this distribution. The full text of the license may be found at
7 http://opensource.org/licenses/bsd-license.php
8
9 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
10 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
11
12 Module Name:
13
14 UsbMassBoot.c
15
16 Abstract:
17
18 This file implement the command set of "USB Mass Storage Specification
19 for Bootability".
20
21 Revision History
22
23
24 **/
25
26 #include "UsbMassImpl.h"
27
28
29 /**
30 Read an UINT32 from the buffer to avoid byte alignment problems, then
31 convert that to the little endia. The USB mass storage bootability spec
32 use big endia
33
34 @param Buf The buffer contains the first byte of the UINT32
35 in big endia.
36
37 @return The UINT32 value read from the buffer in little endia.
38
39 **/
40 STATIC
41 UINT32
42 UsbBootGetUint32 (
43 IN UINT8 *Buf
44 )
45 {
46 UINT32 Value;
47
48 CopyMem (&Value, Buf, sizeof (UINT32));
49 return USB_BOOT_SWAP32 (Value);
50 }
51
52
53 /**
54 Put an UINT32 in little endia to the buffer. The data is converted to
55 big endia before writing.
56
57 @param Buf The buffer to write data to
58 @param Data32 The data to write.
59
60 @return None
61
62 **/
63 STATIC
64 VOID
65 UsbBootPutUint32 (
66 IN UINT8 *Buf,
67 IN UINT32 Data32
68 )
69 {
70 Data32 = USB_BOOT_SWAP32 (Data32);
71 CopyMem (Buf, &Data32, sizeof (UINT32));
72 }
73
74
75 /**
76 Put an UINT16 in little endia to the buffer. The data is converted to
77 big endia before writing.
78
79 @param Buf The buffer to write data to
80 @param Data16 The data to write
81
82 @return None
83
84 **/
85 STATIC
86 VOID
87 UsbBootPutUint16 (
88 IN UINT8 *Buf,
89 IN UINT16 Data16
90 )
91 {
92 Data16 = USB_BOOT_SWAP16 (Data16);
93 CopyMem (Buf, &Data16, sizeof (UINT16));
94 }
95
96
97 /**
98 Request sense information via sending Request Sense
99 Packet Command.
100
101 @param UsbMass The device to be requested sense data
102
103 @retval EFI_DEVICE_ERROR Hardware error
104 @retval EFI_SUCCESS Success
105
106 **/
107 EFI_STATUS
108 UsbBootRequestSense (
109 IN USB_MASS_DEVICE *UsbMass
110 )
111 {
112 USB_BOOT_REQUEST_SENSE_CMD SenseCmd;
113 USB_BOOT_REQUEST_SENSE_DATA SenseData;
114 EFI_BLOCK_IO_MEDIA *Media;
115 USB_MASS_TRANSPORT *Transport;
116 EFI_STATUS Status;
117 UINT32 CmdResult;
118
119 Transport = UsbMass->Transport;
120
121 //
122 // Request the sense data from the device if command failed
123 //
124 ZeroMem (&SenseCmd, sizeof (USB_BOOT_REQUEST_SENSE_CMD));
125 ZeroMem (&SenseData, sizeof (USB_BOOT_REQUEST_SENSE_DATA));
126
127 SenseCmd.OpCode = USB_BOOT_REQUEST_SENSE_OPCODE;
128 SenseCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
129 SenseCmd.AllocLen = sizeof (USB_BOOT_REQUEST_SENSE_DATA);
130
131 Status = Transport->ExecCommand (
132 UsbMass->Context,
133 &SenseCmd,
134 sizeof (USB_BOOT_REQUEST_SENSE_CMD),
135 EfiUsbDataIn,
136 &SenseData,
137 sizeof (USB_BOOT_REQUEST_SENSE_DATA),
138 USB_BOOT_GENERAL_CMD_TIMEOUT,
139 &CmdResult
140 );
141 if (EFI_ERROR (Status) || CmdResult != USB_MASS_CMD_SUCCESS) {
142 DEBUG ((mUsbMscError, "UsbBootRequestSense: (%r) CmdResult=0x%x\n", Status, CmdResult));
143 return EFI_DEVICE_ERROR;
144 }
145
146 //
147 // Interpret the sense data and update the media status if necessary.
148 //
149 Media = &UsbMass->BlockIoMedia;
150
151 switch (USB_BOOT_SENSE_KEY (SenseData.SenseKey)) {
152
153 case USB_BOOT_SENSE_NO_SENSE:
154 case USB_BOOT_SENSE_RECOVERED:
155 //
156 // Suppose hardware can handle this case, and recover later by itself
157 //
158 Status = EFI_NOT_READY;
159 break;
160
161 case USB_BOOT_SENSE_NOT_READY:
162 switch (SenseData.ASC) {
163 case USB_BOOT_ASC_NO_MEDIA:
164 Status = EFI_NO_MEDIA;
165 Media->MediaPresent = FALSE;
166 break;
167
168 case USB_BOOT_ASC_MEDIA_UPSIDE_DOWN:
169 Status = EFI_DEVICE_ERROR;
170 Media->MediaPresent = FALSE;
171 break;
172
173 case USB_BOOT_ASC_NOT_READY:
174 if (SenseData.ASCQ == USB_BOOT_ASCQ_IN_PROGRESS ||
175 SenseData.ASCQ == USB_BOOT_ASCQ_DEVICE_BUSY) {
176 //
177 // Regular timeout, and need retry once more
178 //
179 DEBUG ((mUsbMscInfo, "UsbBootRequestSense: Not ready and need retry once more\n"));
180 Status = EFI_NOT_READY;
181 }
182 }
183 break;
184
185 case USB_BOOT_SENSE_ILLEGAL_REQUEST:
186 Status = EFI_INVALID_PARAMETER;
187 break;
188
189 case USB_BOOT_SENSE_UNIT_ATTENTION:
190 Status = EFI_DEVICE_ERROR;
191 if (SenseData.ASC == USB_BOOT_ASC_MEDIA_CHANGE) {
192 Status = EFI_MEDIA_CHANGED;
193 UsbMass->BlockIoMedia.MediaId++;
194 }
195 break;
196
197 case USB_BOOT_SNESE_DATA_PROTECT:
198 Status = EFI_WRITE_PROTECTED;
199 UsbMass->BlockIoMedia.ReadOnly = TRUE;
200 break;
201
202 default:
203 Status = EFI_DEVICE_ERROR;
204 break;
205 }
206
207 DEBUG ((mUsbMscInfo, "UsbBootRequestSense: (%r) with sense key %x/%x/%x\n",
208 Status,
209 USB_BOOT_SENSE_KEY (SenseData.SenseKey),
210 SenseData.ASC,
211 SenseData.ASCQ
212 ));
213
214 return Status;
215 }
216
217
218 /**
219 Execute the USB mass storage bootability commands. If execution
220 failed, retrieve the error by REQUEST_SENSE then update the device's
221 status, such as ReadyOnly.
222
223 @param UsbMass The device to issue commands to
224 @param Cmd The command to execute
225 @param CmdLen The length of the command
226 @param DataDir The direction of data transfer
227 @param Data The buffer to hold the data
228 @param DataLen The length of expected data
229 @param Timeout The timeout used to transfer
230
231 @retval EFI_SUCCESS The command is excuted OK
232 @retval EFI_DEVICE_ERROR Failed to request sense
233 @retval EFI_INVALID_PARAMETER The command has some invalid parameters
234 @retval EFI_WRITE_PROTECTED The device is write protected
235 @retval EFI_MEDIA_CHANGED The device media has been changed
236
237 **/
238 STATIC
239 EFI_STATUS
240 UsbBootExecCmd (
241 IN USB_MASS_DEVICE *UsbMass,
242 IN VOID *Cmd,
243 IN UINT8 CmdLen,
244 IN EFI_USB_DATA_DIRECTION DataDir,
245 IN VOID *Data,
246 IN UINT32 DataLen,
247 IN UINT32 Timeout
248 )
249 {
250 USB_MASS_TRANSPORT *Transport;
251 EFI_STATUS Status;
252 UINT32 CmdResult;
253
254 Transport = UsbMass->Transport;
255 Status = Transport->ExecCommand (
256 UsbMass->Context,
257 Cmd,
258 CmdLen,
259 DataDir,
260 Data,
261 DataLen,
262 Timeout,
263 &CmdResult
264 );
265 //
266 // ExecCommand return success and get the right CmdResult means
267 // the commnad transfer is OK.
268 //
269 if ((CmdResult == USB_MASS_CMD_SUCCESS) && !EFI_ERROR(Status)) {
270 return EFI_SUCCESS;
271 }
272
273 return UsbBootRequestSense (UsbMass);
274 }
275
276
277 /**
278 Execute the USB mass storage bootability commands. If execution
279 failed, retrieve the error by REQUEST_SENSE then update the device's
280 status, such as ReadyOnly.
281
282 @param UsbMass The device to issue commands to
283 @param Cmd The command to execute
284 @param CmdLen The length of the command
285 @param DataDir The direction of data transfer
286 @param Data The buffer to hold the data
287 @param DataLen The length of expected data
288
289 @retval EFI_SUCCESS The command is excuted OK
290 @retval EFI_DEVICE_ERROR Failed to request sense
291 @retval EFI_INVALID_PARAMETER The command has some invalid parameters
292 @retval EFI_WRITE_PROTECTED The device is write protected
293 @retval EFI_MEDIA_CHANGED The device media has been changed
294
295 **/
296 STATIC
297 EFI_STATUS
298 UsbBootExecCmdWithRetry (
299 IN USB_MASS_DEVICE *UsbMass,
300 IN VOID *Cmd,
301 IN UINT8 CmdLen,
302 IN EFI_USB_DATA_DIRECTION DataDir,
303 IN VOID *Data,
304 IN UINT32 DataLen,
305 IN UINT32 Timeout
306 )
307 {
308 EFI_STATUS Status;
309 INT16 Index;
310
311 //
312 // If the device isn't ready, wait some time. If the device is ready,
313 // retry the command again.
314 //
315 Status = EFI_SUCCESS;
316
317 for (Index = 0; Index < USB_BOOT_COMMAND_RETRY; Index++) {
318 //
319 // Execute the command with an increasingly larger timeout value.
320 //
321 Status = UsbBootExecCmd (
322 UsbMass,
323 Cmd,
324 CmdLen,
325 DataDir,
326 Data,
327 DataLen,
328 Timeout * (Index + 1)
329 );
330 if (Status == EFI_SUCCESS ||
331 Status == EFI_MEDIA_CHANGED) {
332 break;
333 }
334 //
335 // Need retry once more, so reset index
336 //
337 if (Status == EFI_NOT_READY) {
338 Index = 0;
339 }
340 }
341
342 return Status;
343 }
344
345
346
347 /**
348 Use the TEST UNIT READY command to check whether it is ready.
349 If it is ready, update the parameters.
350
351 @param UsbMass The device to test
352
353 @retval EFI_SUCCESS The device is ready and parameters are updated.
354 @retval Others Device not ready.
355
356 **/
357 EFI_STATUS
358 UsbBootIsUnitReady (
359 IN USB_MASS_DEVICE *UsbMass
360 )
361 {
362 USB_BOOT_TEST_UNIT_READY_CMD TestCmd;
363
364 ZeroMem (&TestCmd, sizeof (USB_BOOT_TEST_UNIT_READY_CMD));
365
366 TestCmd.OpCode = USB_BOOT_TEST_UNIT_READY_OPCODE;
367 TestCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
368
369 return UsbBootExecCmdWithRetry (
370 UsbMass,
371 &TestCmd,
372 sizeof (USB_BOOT_TEST_UNIT_READY_CMD),
373 EfiUsbNoData,
374 NULL,
375 0,
376 USB_BOOT_GENERAL_CMD_TIMEOUT
377 );
378 }
379
380
381 /**
382 Inquiry Command requests that information regrarding parameters of
383 the Device be sent to the Host.
384
385 @param UsbMass The device to inquiry.
386
387 @retval EFI_SUCCESS The device is ready and parameters are updated.
388 @retval Others Device not ready.
389
390 **/
391 EFI_STATUS
392 UsbBootInquiry (
393 IN USB_MASS_DEVICE *UsbMass
394 )
395 {
396 USB_BOOT_INQUIRY_CMD InquiryCmd;
397 USB_BOOT_INQUIRY_DATA InquiryData;
398 EFI_BLOCK_IO_MEDIA *Media;
399 EFI_STATUS Status;
400
401 Media = &(UsbMass->BlockIoMedia);
402
403 //
404 // Use the Inquiry command to get the RemovableMedia setting.
405 //
406 ZeroMem (&InquiryCmd, sizeof (USB_BOOT_INQUIRY_CMD));
407 ZeroMem (&InquiryData, sizeof (USB_BOOT_INQUIRY_DATA));
408
409 InquiryCmd.OpCode = USB_BOOT_INQUIRY_OPCODE;
410 InquiryCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
411 InquiryCmd.AllocLen = sizeof (InquiryData);
412
413 Status = UsbBootExecCmdWithRetry (
414 UsbMass,
415 &InquiryCmd,
416 sizeof (USB_BOOT_INQUIRY_CMD),
417 EfiUsbDataIn,
418 &InquiryData,
419 sizeof (USB_BOOT_INQUIRY_DATA),
420 USB_BOOT_INQUIRY_CMD_TIMEOUT
421 );
422 if (EFI_ERROR (Status)) {
423 return Status;
424 }
425
426 UsbMass->Pdt = USB_BOOT_PDT (InquiryData.Pdt);
427 Media->RemovableMedia = USB_BOOT_REMOVABLE (InquiryData.Removable);
428 //
429 // Default value 512 Bytes, in case no media present at first time
430 //
431 Media->BlockSize = 0x0200;
432
433 return Status;
434 }
435
436
437 /**
438 Get the capacity of the USB mass storage media, including
439 the presentation, block size, and last block number. This
440 function is used to get the disk parameters at the start if
441 it is a non-removable media or to detect the media if it is
442 removable.
443
444 @param UsbMass The device to retireve disk gemotric.
445
446 @retval EFI_SUCCESS The disk gemotric is successfully retrieved.
447 @retval EFI_DEVICE_ERROR Something is inconsistent with the disk gemotric.
448
449 **/
450 EFI_STATUS
451 UsbBootReadCapacity (
452 IN USB_MASS_DEVICE *UsbMass
453 )
454 {
455 USB_BOOT_READ_CAPACITY_CMD CapacityCmd;
456 USB_BOOT_READ_CAPACITY_DATA CapacityData;
457 EFI_BLOCK_IO_MEDIA *Media;
458 EFI_STATUS Status;
459
460 Media = &UsbMass->BlockIoMedia;
461
462 //
463 // Use the READ CAPACITY command to get the block length and last blockno
464 //
465 ZeroMem (&CapacityCmd, sizeof (USB_BOOT_READ_CAPACITY_CMD));
466 ZeroMem (&CapacityData, sizeof (USB_BOOT_READ_CAPACITY_DATA));
467
468 CapacityCmd.OpCode = USB_BOOT_READ_CAPACITY_OPCODE;
469 CapacityCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
470
471 Status = UsbBootExecCmdWithRetry (
472 UsbMass,
473 &CapacityCmd,
474 sizeof (USB_BOOT_READ_CAPACITY_CMD),
475 EfiUsbDataIn,
476 &CapacityData,
477 sizeof (USB_BOOT_READ_CAPACITY_DATA),
478 USB_BOOT_GENERAL_CMD_TIMEOUT
479 );
480 if (EFI_ERROR (Status)) {
481 return Status;
482 }
483
484 Media->MediaPresent = TRUE;
485 Media->LastBlock = UsbBootGetUint32 (CapacityData.LastLba);
486 Media->BlockSize = UsbBootGetUint32 (CapacityData.BlockLen);
487
488 DEBUG ((mUsbMscInfo, "UsbBootReadCapacity Success LBA=%d BlockSize=%d\n",
489 Media->LastBlock, Media->BlockSize));
490
491 return EFI_SUCCESS;
492 }
493
494
495 /**
496 Retrieves mode sense information via sending Mode Sense
497 Packet Command.
498
499 @param UsbMass The USB_FLOPPY_DEV instance.
500
501 @retval EFI_DEVICE_ERROR Hardware error
502 @retval EFI_SUCCESS Success
503
504 **/
505 EFI_STATUS
506 UsbBootModeSense (
507 IN USB_MASS_DEVICE *UsbMass
508 )
509 {
510 EFI_STATUS Status;
511 USB_BOOT_MODE_SENSE_CMD ModeSenseCmd;
512 USB_BOOT_MODE_PARA_HEADER ModeParaHeader;
513 UINT8 CommandSet;
514
515 ZeroMem (&ModeSenseCmd, sizeof (USB_BOOT_MODE_SENSE_CMD));
516 ZeroMem (&ModeParaHeader, sizeof (USB_BOOT_MODE_PARA_HEADER));
517
518 //
519 // overuse Context Pointer, the first field of Bot or Cbi is EFI_USB_INTERFACE_DESCRIPTOR
520 //
521 CommandSet = ((EFI_USB_INTERFACE_DESCRIPTOR *) (UsbMass->Context))->InterfaceSubClass;
522
523 if (CommandSet == USB_MASS_STORE_SCSI) {
524 //
525 // Not UFI Command Set, no ModeSense Command
526 //
527 return EFI_SUCCESS;
528 }
529
530 ModeSenseCmd.OpCode = USB_BOOT_MODE_SENSE10_OPCODE;
531 ModeSenseCmd.PageCode = 0x3f;
532 ModeSenseCmd.ParaListLenLsb = (UINT8) sizeof (USB_BOOT_MODE_PARA_HEADER);
533
534 Status = UsbBootExecCmdWithRetry (
535 UsbMass,
536 &ModeSenseCmd,
537 sizeof (USB_BOOT_MODE_SENSE_CMD),
538 EfiUsbDataIn,
539 &ModeParaHeader,
540 sizeof (USB_BOOT_MODE_PARA_HEADER),
541 USB_BOOT_GENERAL_CMD_TIMEOUT
542 );
543 //
544 // Did nothing with the Header here
545 // But probably should
546 //
547
548 return Status;
549 }
550
551
552 /**
553 Get the parameters for the USB mass storage media, including
554 the RemovableMedia, block size, and last block number. This
555 function is used both to initialize the media during the
556 DriverBindingStart and to re-initialize it when the media is
557 changed. Althought the RemoveableMedia is unlikely to change,
558 I include it here.
559
560 @param UsbMass The device to retireve disk gemotric.
561
562 @retval EFI_SUCCESS The disk gemotric is successfully retrieved.
563 @retval EFI_DEVICE_ERROR Something is inconsistent with the disk gemotric.
564
565 **/
566 EFI_STATUS
567 UsbBootGetParams (
568 IN USB_MASS_DEVICE *UsbMass
569 )
570 {
571 EFI_BLOCK_IO_MEDIA *Media;
572 EFI_STATUS Status;
573
574 Status = UsbBootInquiry (UsbMass);
575 if (EFI_ERROR (Status)) {
576 DEBUG ((mUsbMscError, "UsbBootGetParams: UsbBootInquiry (%r)\n", Status));
577 return Status;
578 }
579
580 Media = &(UsbMass->BlockIoMedia);
581 //
582 // Don't use the Removable bit in inquirydata to test whether the media
583 // is removable because many flash disks wrongly set this bit.
584 //
585 if ((UsbMass->Pdt == USB_PDT_CDROM) || (UsbMass->Pdt == USB_PDT_OPTICAL)) {
586 //
587 // CD-Rom or Optical device
588 //
589 UsbMass->OpticalStorage = TRUE;
590 //
591 // Default value 2048 Bytes, in case no media present at first time
592 //
593 Media->BlockSize = 0x0800;
594 } else {
595 //
596 // Non CD-Rom device need ModeSenseCmd between InquiryCmd and ReadCapacityCmd
597 //
598 Status = UsbBootModeSense (UsbMass);
599 if (EFI_ERROR (Status)) {
600 DEBUG ((mUsbMscError, "UsbBootGetParams: UsbBootModeSense (%r)\n", Status));
601 return Status;
602 }
603 }
604
605 return UsbBootReadCapacity (UsbMass);
606 }
607
608
609 /**
610 Detect whether the removable media is present and whether it has changed.
611 The Non-removable media doesn't need it.
612
613 @param UsbMass The device to retireve disk gemotric.
614
615 @retval EFI_SUCCESS The disk gemotric is successfully retrieved.
616 @retval EFI_DEVICE_ERROR Something is inconsistent with the disk gemotric.
617
618 **/
619 EFI_STATUS
620 UsbBootDetectMedia (
621 IN USB_MASS_DEVICE *UsbMass
622 )
623 {
624 EFI_BLOCK_IO_MEDIA OldMedia;
625 EFI_BLOCK_IO_MEDIA *Media;
626 EFI_STATUS Status;
627
628 Media = &UsbMass->BlockIoMedia;
629
630 CopyMem (
631 &OldMedia,
632 &(UsbMass->BlockIoMedia),
633 sizeof (EFI_BLOCK_IO_MEDIA)
634 );
635
636 //
637 // First test whether the device is ready and get status
638 // If media changed or ready, need read the device's capacity
639 //
640 Status = UsbBootIsUnitReady (UsbMass);
641 if ((Status == EFI_SUCCESS && Media->MediaPresent) ||
642 (Status == EFI_MEDIA_CHANGED)) {
643 if ((UsbMass->Pdt != USB_PDT_CDROM) &&
644 (UsbMass->Pdt != USB_PDT_OPTICAL)) {
645 //
646 // Non CD-Rom device need ModeSenseCmd between InquiryCmd and ReadCapacityCmd
647 //
648 UsbBootModeSense (UsbMass);
649 }
650 DEBUG ((mUsbMscInfo, "UsbBootDetectMedia: Need Read Capacity\n"));
651 Status = UsbBootReadCapacity (UsbMass);
652 }
653 if (EFI_ERROR (Status)) {
654 return Status;
655 }
656
657 //
658 // Detect whether it is necessary to reinstall the BlockIO
659 //
660 if ((Media->MediaId != OldMedia.MediaId) ||
661 (Media->MediaPresent != OldMedia.MediaPresent) ||
662 (Media->ReadOnly != OldMedia.ReadOnly) ||
663 (Media->BlockSize != OldMedia.BlockSize) ||
664 (Media->LastBlock != OldMedia.LastBlock)) {
665 DEBUG ((mUsbMscInfo, "UsbBootDetectMedia: Need reinstall BlockIoProtocol\n"));
666 Media->MediaId++;
667 gBS->ReinstallProtocolInterface (
668 UsbMass->Controller,
669 &gEfiBlockIoProtocolGuid,
670 &UsbMass->BlockIo,
671 &UsbMass->BlockIo
672 );
673 //
674 // Check whether media present or media changed or write protected
675 //
676 if (Media->MediaPresent == FALSE) {
677 Status = EFI_NO_MEDIA;
678 }
679 if (Media->MediaId != OldMedia.MediaId) {
680 Status = EFI_MEDIA_CHANGED;
681 }
682 if (Media->ReadOnly != OldMedia.ReadOnly) {
683 Status = EFI_WRITE_PROTECTED;
684 }
685 }
686
687 return Status;
688 }
689
690
691 /**
692 Read some blocks from the device.
693
694 @param UsbMass The USB mass storage device to read from
695 @param Lba The start block number
696 @param TotalBlock Total block number to read
697 @param Buffer The buffer to read to
698
699 @retval EFI_SUCCESS Data are read into the buffer
700 @retval Others Failed to read all the data
701
702 **/
703 EFI_STATUS
704 UsbBootReadBlocks (
705 IN USB_MASS_DEVICE *UsbMass,
706 IN UINT32 Lba,
707 IN UINTN TotalBlock,
708 OUT UINT8 *Buffer
709 )
710 {
711 USB_BOOT_READ10_CMD ReadCmd;
712 EFI_STATUS Status;
713 UINT16 Count;
714 UINT32 BlockSize;
715 UINT32 ByteSize;
716 UINT32 Timeout;
717
718 BlockSize = UsbMass->BlockIoMedia.BlockSize;
719 Status = EFI_SUCCESS;
720
721 while (TotalBlock > 0) {
722 //
723 // Split the total blocks into smaller pieces to ease the pressure
724 // on the device. We must split the total block because the READ10
725 // command only has 16 bit transfer length (in the unit of block).
726 //
727 Count = (UINT16)((TotalBlock < USB_BOOT_IO_BLOCKS) ? TotalBlock : USB_BOOT_IO_BLOCKS);
728 ByteSize = (UINT32)Count * BlockSize;
729
730 //
731 // Optical device need longer timeout than other device
732 //
733 if (UsbMass->OpticalStorage == TRUE) {
734 Timeout = (UINT32)Count * USB_BOOT_OPTICAL_BLOCK_TIMEOUT;
735 } else {
736 Timeout = (UINT32)Count * USB_BOOT_GENERAL_BLOCK_TIMEOUT;
737 }
738
739 //
740 // Fill in the command then execute
741 //
742 ZeroMem (&ReadCmd, sizeof (USB_BOOT_READ10_CMD));
743
744 ReadCmd.OpCode = USB_BOOT_READ10_OPCODE;
745 ReadCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
746 UsbBootPutUint32 (ReadCmd.Lba, Lba);
747 UsbBootPutUint16 (ReadCmd.TransferLen, Count);
748
749 Status = UsbBootExecCmdWithRetry (
750 UsbMass,
751 &ReadCmd,
752 sizeof (USB_BOOT_READ10_CMD),
753 EfiUsbDataIn,
754 Buffer,
755 ByteSize,
756 Timeout
757 );
758 if (EFI_ERROR (Status)) {
759 return Status;
760 }
761
762 Lba += Count;
763 Buffer += Count * BlockSize;
764 TotalBlock -= Count;
765 }
766
767 return Status;
768 }
769
770
771 /**
772 Write some blocks to the device.
773
774 @param UsbMass The USB mass storage device to write to
775 @param Lba The start block number
776 @param TotalBlock Total block number to write
777 @param Buffer The buffer to write to
778
779 @retval EFI_SUCCESS Data are written into the buffer
780 @retval Others Failed to write all the data
781
782 **/
783 EFI_STATUS
784 UsbBootWriteBlocks (
785 IN USB_MASS_DEVICE *UsbMass,
786 IN UINT32 Lba,
787 IN UINTN TotalBlock,
788 OUT UINT8 *Buffer
789 )
790 {
791 USB_BOOT_WRITE10_CMD WriteCmd;
792 EFI_STATUS Status;
793 UINT16 Count;
794 UINT32 BlockSize;
795 UINT32 ByteSize;
796 UINT32 Timeout;
797
798 BlockSize = UsbMass->BlockIoMedia.BlockSize;
799 Status = EFI_SUCCESS;
800
801 while (TotalBlock > 0) {
802 //
803 // Split the total blocks into smaller pieces to ease the pressure
804 // on the device. We must split the total block because the WRITE10
805 // command only has 16 bit transfer length (in the unit of block).
806 //
807 Count = (UINT16)((TotalBlock < USB_BOOT_IO_BLOCKS) ? TotalBlock : USB_BOOT_IO_BLOCKS);
808 ByteSize = (UINT32)Count * BlockSize;
809
810 //
811 // Optical device need longer timeout than other device
812 //
813 if (UsbMass->OpticalStorage == TRUE) {
814 Timeout = (UINT32)Count * USB_BOOT_OPTICAL_BLOCK_TIMEOUT;
815 } else {
816 Timeout = (UINT32)Count * USB_BOOT_GENERAL_BLOCK_TIMEOUT;
817 }
818
819 //
820 // Fill in the write10 command block
821 //
822 ZeroMem (&WriteCmd, sizeof (USB_BOOT_WRITE10_CMD));
823
824 WriteCmd.OpCode = USB_BOOT_WRITE10_OPCODE;
825 WriteCmd.Lun = USB_BOOT_LUN (UsbMass->Lun);
826 UsbBootPutUint32 (WriteCmd.Lba, Lba);
827 UsbBootPutUint16 (WriteCmd.TransferLen, Count);
828
829 Status = UsbBootExecCmdWithRetry (
830 UsbMass,
831 &WriteCmd,
832 sizeof (USB_BOOT_WRITE10_CMD),
833 EfiUsbDataOut,
834 Buffer,
835 ByteSize,
836 Timeout
837 );
838 if (EFI_ERROR (Status)) {
839 return Status;
840 }
841
842 Lba += Count;
843 Buffer += Count * BlockSize;
844 TotalBlock -= Count;
845 }
846
847 return Status;
848 }
849
850
851 /**
852 Use the USB clear feature control transfer to clear the endpoint
853 stall condition.
854
855 @param UsbIo The USB IO protocol to use
856 @param EndpointAddr The endpoint to clear stall for
857
858 @retval EFI_SUCCESS The endpoint stall condtion is clear
859 @retval Others Failed to clear the endpoint stall condtion
860
861 **/
862 EFI_STATUS
863 UsbClearEndpointStall (
864 IN EFI_USB_IO_PROTOCOL *UsbIo,
865 IN UINT8 EndpointAddr
866 )
867 {
868 EFI_USB_DEVICE_REQUEST Request;
869 EFI_STATUS Status;
870 UINT32 CmdResult;
871 UINT32 Timeout;
872
873 Request.RequestType = 0x02;
874 Request.Request = USB_REQ_CLEAR_FEATURE;
875 Request.Value = USB_FEATURE_ENDPOINT_HALT;
876 Request.Index = EndpointAddr;
877 Request.Length = 0;
878 Timeout = USB_BOOT_GENERAL_CMD_TIMEOUT / USB_MASS_STALL_1_MS;
879
880 Status = UsbIo->UsbControlTransfer (
881 UsbIo,
882 &Request,
883 EfiUsbNoData,
884 Timeout,
885 NULL,
886 0,
887 &CmdResult
888 );
889
890 return Status;
891 }
EFI Development Kit II mirror for PVE