]> git.proxmox.com Git - mirror_edk2.git/blob - MdeModulePkg/Library/PiDxeS3BootScriptLib/BootScriptExecute.c
projects / mirror_edk2.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
MdeModulePkg: Add PiDxeS3BootScriptLib
[mirror_edk2.git] / MdeModulePkg / Library / PiDxeS3BootScriptLib / BootScriptExecute.c
1 /** @file
2 Interpret and execute the S3 data in S3 boot script.
3
4 Copyright (c) 2006 - 2010, Intel Corporation. All rights reserved.<BR>
5
6 This program and the accompanying materials
7 are licensed and made available under the terms and conditions
8 of the BSD License which accompanies this distribution. The
9 full text of the license may be found at
10 http://opensource.org/licenses/bsd-license.php
11
12 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
13 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
14
15 **/
16 #include "InternalBootScriptLib.h"
17
18 /**
19 Checks the parameter of SmbusExecute().
20
21 This function checks the input parameters of SmbusExecute(). If the input parameters are valid
22 for certain SMBus bus protocol, it will return EFI_SUCCESS; otherwise, it will return certain
23 error code based on the input SMBus bus protocol.
24
25 @param SmBusAddress Address that encodes the SMBUS Slave Address, SMBUS Command, SMBUS Data Length,
26 and PEC.
27 @param Operation Signifies which particular SMBus hardware protocol instance that
28 it will use to execute the SMBus transactions. This SMBus
29 hardware protocol is defined by the SMBus Specification and is
30 not related to EFI.
31 @param Length Signifies the number of bytes that this operation will do. The
32 maximum number of bytes can be revision specific and operation
33 specific. This field will contain the actual number of bytes that
34 are executed for this operation. Not all operations require this
35 argument.
36 @param Buffer Contains the value of data to execute to the SMBus slave device.
37 Not all operations require this argument. The length of this
38 buffer is identified by Length.
39
40 @retval EFI_SUCCESS All the parameters are valid for the corresponding SMBus bus
41 protocol.
42 @retval EFI_INVALID_PARAMETER Operation is not defined in EFI_SMBUS_OPERATION.
43 @retval EFI_INVALID_PARAMETER Length/Buffer is NULL for operations except for EfiSmbusQuickRead
44 and EfiSmbusQuickWrite. Length is outside the range of valid
45 values.
46 @retval EFI_UNSUPPORTED The SMBus operation or PEC is not supported.
47 @retval EFI_BUFFER_TOO_SMALL Buffer is not sufficient for this operation.
48
49 **/
50 EFI_STATUS
51 CheckParameters (
52 IN UINTN SmBusAddress,
53 IN EFI_SMBUS_OPERATION Operation,
54 IN OUT UINTN *Length,
55 IN OUT VOID *Buffer
56 )
57 {
58 EFI_STATUS Status;
59 UINTN RequiredLen;
60 EFI_SMBUS_DEVICE_COMMAND Command;
61 BOOLEAN PecCheck;
62
63 Command = SMBUS_LIB_COMMAND (SmBusAddress);
64 PecCheck = SMBUS_LIB_PEC (SmBusAddress);
65 //
66 // Set default value to be 2:
67 // for SmbusReadWord, SmbusWriteWord and SmbusProcessCall.
68 //
69 RequiredLen = 2;
70 Status = EFI_SUCCESS;
71 switch (Operation) {
72 case EfiSmbusQuickRead:
73 case EfiSmbusQuickWrite:
74 if (PecCheck || Command != 0) {
75 return EFI_UNSUPPORTED;
76 }
77 break;
78 case EfiSmbusReceiveByte:
79 case EfiSmbusSendByte:
80 if (Command != 0) {
81 return EFI_UNSUPPORTED;
82 }
83 //
84 // Cascade to check length parameter.
85 //
86 case EfiSmbusReadByte:
87 case EfiSmbusWriteByte:
88 RequiredLen = 1;
89 //
90 // Cascade to check length parameter.
91 //
92 case EfiSmbusReadWord:
93 case EfiSmbusWriteWord:
94 case EfiSmbusProcessCall:
95 if (Buffer == NULL || Length == NULL) {
96 return EFI_INVALID_PARAMETER;
97 } else if (*Length < RequiredLen) {
98 Status = EFI_BUFFER_TOO_SMALL;
99 }
100 *Length = RequiredLen;
101 break;
102 case EfiSmbusReadBlock:
103 case EfiSmbusWriteBlock:
104 if ((Buffer == NULL) ||
105 (Length == NULL) ||
106 (*Length < MIN_SMBUS_BLOCK_LEN) ||
107 (*Length > MAX_SMBUS_BLOCK_LEN)) {
108 return EFI_INVALID_PARAMETER;
109 }
110 break;
111 case EfiSmbusBWBRProcessCall:
112 return EFI_UNSUPPORTED;
113 default:
114 return EFI_INVALID_PARAMETER;
115 }
116 return Status;
117 }
118
119 /**
120 Executes an SMBus operation to an SMBus controller. Returns when either the command has been
121 executed or an error is encountered in doing the operation.
122
123 The SmbusExecute() function provides a standard way to execute an operation as defined in the System
124 Management Bus (SMBus) Specification. The resulting transaction will be either that the SMBus
125 slave devices accept this transaction or that this function returns with error.
126
127 @param SmbusAddress Address that encodes the SMBUS Slave Address, SMBUS Command, SMBUS Data Length,
128 and PEC.
129 @param Operation Signifies which particular SMBus hardware protocol instance that
130 it will use to execute the SMBus transactions. This SMBus
131 hardware protocol is defined by the SMBus Specification and is
132 not related to EFI.
133 @param Length Signifies the number of bytes that this operation will do. The
134 maximum number of bytes can be revision specific and operation
135 specific. This field will contain the actual number of bytes that
136 are executed for this operation. Not all operations require this
137 argument.
138 @param Buffer Contains the value of data to execute to the SMBus slave device.
139 Not all operations require this argument. The length of this
140 buffer is identified by Length.
141
142 @retval EFI_SUCCESS The last data that was returned from the access matched the poll
143 exit criteria.
144 @retval EFI_CRC_ERROR Checksum is not correct (PEC is incorrect).
145 @retval EFI_TIMEOUT Timeout expired before the operation was completed. Timeout is
146 determined by the SMBus host controller device.
147 @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.
148 @retval EFI_DEVICE_ERROR The request was not completed because a failure that was
149 reflected in the Host Status Register bit. Device errors are a
150 result of a transaction collision, illegal command field,
151 unclaimed cycle (host initiated), or bus errors (collisions).
152 @retval EFI_INVALID_PARAMETER Operation is not defined in EFI_SMBUS_OPERATION.
153 @retval EFI_INVALID_PARAMETER Length/Buffer is NULL for operations except for EfiSmbusQuickRead
154 and EfiSmbusQuickWrite. Length is outside the range of valid
155 values.
156 @retval EFI_UNSUPPORTED The SMBus operation or PEC is not supported.
157 @retval EFI_BUFFER_TOO_SMALL Buffer is not sufficient for this operation.
158
159 **/
160 EFI_STATUS
161 SmbusExecute (
162 IN UINTN SmbusAddress,
163 IN EFI_SMBUS_OPERATION Operation,
164 IN OUT UINTN *Length,
165 IN OUT VOID *Buffer
166 )
167 {
168 EFI_STATUS Status;
169 UINTN WorkBufferLen;
170 UINT8 WorkBuffer[MAX_SMBUS_BLOCK_LEN];
171
172 Status = CheckParameters (SmbusAddress, Operation, Length, Buffer);
173 if (EFI_ERROR (Status)) {
174 return Status;
175 }
176
177 switch (Operation) {
178 case EfiSmbusQuickRead:
179 DEBUG ((EFI_D_INFO, "EfiSmbusQuickRead - 0x%08x\n", SmbusAddress));
180 SmBusQuickRead (SmbusAddress, &Status);
181 break;
182 case EfiSmbusQuickWrite:
183 DEBUG ((EFI_D_INFO, "EfiSmbusQuickWrite - 0x%08x\n", SmbusAddress));
184 SmBusQuickWrite (SmbusAddress, &Status);
185 break;
186 case EfiSmbusReceiveByte:
187 DEBUG ((EFI_D_INFO, "EfiSmbusReceiveByte - 0x%08x\n", SmbusAddress));
188 *(UINT8 *) Buffer = SmBusReceiveByte (SmbusAddress, &Status);
189 break;
190 case EfiSmbusSendByte:
191 DEBUG ((EFI_D_INFO, "EfiSmbusReceiveByte - 0x%08x (0x%02x)\n", SmbusAddress, (UINTN)*(UINT8 *) Buffer));
192 SmBusSendByte (SmbusAddress, *(UINT8 *) Buffer, &Status);
193 break;
194 case EfiSmbusReadByte:
195 DEBUG ((EFI_D_INFO, "EfiSmbusReadByte - 0x%08x\n", SmbusAddress));
196 *(UINT8 *) Buffer = SmBusReadDataByte (SmbusAddress, &Status);
197 break;
198 case EfiSmbusWriteByte:
199 DEBUG ((EFI_D_INFO, "EfiSmbusWriteByte - 0x%08x (0x%02x)\n", SmbusAddress, (UINTN)*(UINT8 *) Buffer));
200 SmBusWriteDataByte (SmbusAddress, *(UINT8 *) Buffer, &Status);
201 break;
202 case EfiSmbusReadWord:
203 DEBUG ((EFI_D_INFO, "EfiSmbusReadWord - 0x%08x\n", SmbusAddress));
204 *(UINT16 *) Buffer = SmBusReadDataWord (SmbusAddress, &Status);
205 break;
206 case EfiSmbusWriteWord:
207 DEBUG ((EFI_D_INFO, "EfiSmbusWriteByte - 0x%08x (0x%04x)\n", SmbusAddress, (UINTN)*(UINT16 *) Buffer));
208 SmBusWriteDataWord (SmbusAddress, *(UINT16 *) Buffer, &Status);
209 break;
210 case EfiSmbusProcessCall:
211 DEBUG ((EFI_D_INFO, "EfiSmbusProcessCall - 0x%08x (0x%04x)\n", SmbusAddress, (UINTN)*(UINT16 *) Buffer));
212 *(UINT16 *) Buffer = SmBusProcessCall (SmbusAddress, *(UINT16 *) Buffer, &Status);
213 break;
214 case EfiSmbusReadBlock:
215 DEBUG ((EFI_D_INFO, "EfiSmbusReadBlock - 0x%08x\n", SmbusAddress));
216 WorkBufferLen = SmBusReadBlock (SmbusAddress, WorkBuffer, &Status);
217 if (!EFI_ERROR (Status)) {
218 //
219 // Read block transaction is complete successfully, and then
220 // check whether the output buffer is large enough.
221 //
222 if (*Length >= WorkBufferLen) {
223 CopyMem (Buffer, WorkBuffer, WorkBufferLen);
224 } else {
225 Status = EFI_BUFFER_TOO_SMALL;
226 }
227 *Length = WorkBufferLen;
228 }
229 break;
230 case EfiSmbusWriteBlock:
231 DEBUG ((EFI_D_INFO, "EfiSmbusWriteBlock - 0x%08x (0x%04x)\n", SmbusAddress, (UINTN)*(UINT16 *) Buffer));
232 SmBusWriteBlock ((SmbusAddress + SMBUS_LIB_ADDRESS (0, 0, (*Length), FALSE)) , Buffer, &Status);
233 break;
234 case EfiSmbusBWBRProcessCall:
235 //
236 // BUGBUG: Should this case be handled?
237 //
238 break;
239 }
240
241 return Status;
242 }
243
244 /**
245 Translates boot script width and address stride to MDE library interface.
246
247
248 @param Width Width of the operation.
249 @param Address Address of the operation.
250 @param AddressStride Instride for stepping input buffer.
251 @param BufferStride Outstride for stepping output buffer.
252
253 @retval EFI_SUCCESS Successful translation.
254 @retval EFI_INVALID_PARAMETER Width or Address is invalid.
255 **/
256 EFI_STATUS
257 BuildLoopData (
258 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
259 IN UINT64 Address,
260 OUT UINTN *AddressStride,
261 OUT UINTN *BufferStride
262 )
263 {
264 UINTN AlignMask;
265
266 if (Width >= S3BootScriptWidthMaximum) {
267 return EFI_INVALID_PARAMETER;
268 }
269
270 *AddressStride = (UINT32)(1 << (Width & 0x03));
271 *BufferStride = *AddressStride;
272
273 AlignMask = *AddressStride - 1;
274 if ((Address & AlignMask) != 0) {
275 return EFI_INVALID_PARAMETER;
276 }
277
278 if (Width >= S3BootScriptWidthFifoUint8 && Width <= S3BootScriptWidthFifoUint64) {
279 *AddressStride = 0;
280 }
281
282 if (Width >= S3BootScriptWidthFillUint8 && Width <= S3BootScriptWidthFillUint64) {
283 *BufferStride = 0;
284 }
285
286 return EFI_SUCCESS;
287 }
288
289 /**
290 Translates boot script to MDE library interface.
291
292 @param[in] Width Width of the operation.
293 @param[in] Address Address of the operation.
294 @param[in] Count Count of the number of accesses to perform.
295 @param[out] Buffer Pointer to the buffer to read from I/O space.
296
297 @retval EFI_SUCCESS The data was written to the EFI System.
298 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
299 Buffer is NULL.
300 The Buffer is not aligned for the given Width.
301 Address is outside the legal range of I/O ports.
302
303 **/
304 EFI_STATUS
305 ScriptIoRead (
306 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
307 IN UINT64 Address,
308 IN UINTN Count,
309 OUT VOID *Buffer
310 )
311 {
312 EFI_STATUS Status;
313 UINTN AddressStride;
314 UINTN BufferStride;
315 PTR Out;
316
317 Out.Buf = (UINT8 *) Buffer;
318
319 if (Address > MAX_IO_ADDRESS) {
320 return EFI_INVALID_PARAMETER;
321 }
322
323 Status = BuildLoopData (Width, Address, &AddressStride, &BufferStride);
324 if (EFI_ERROR (Status)) {
325 return Status;
326 }
327 //
328 // Loop for each iteration and move the data
329 //
330 for (; Count > 0; Count--, Address += AddressStride, Out.Buf += BufferStride) {
331 switch (Width) {
332
333 case S3BootScriptWidthUint8:
334 case S3BootScriptWidthFifoUint8:
335 case S3BootScriptWidthFillUint8:
336 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8Read - 0x%08x\n", Address));
337 *Out.Uint8 = IoRead8 ((UINTN) Address);
338 break;
339
340 case S3BootScriptWidthUint16:
341 case S3BootScriptWidthFifoUint16:
342 case S3BootScriptWidthFillUint16:
343 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16Read - 0x%08x\n", Address));
344 *Out.Uint16 = IoRead16 ((UINTN) Address);
345 break;
346
347 case S3BootScriptWidthUint32:
348 case S3BootScriptWidthFifoUint32:
349 case S3BootScriptWidthFillUint32:
350 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32Read - 0x%08x\n", Address));
351 *Out.Uint32 = IoRead32 ((UINTN) Address);
352 break;
353
354 default:
355 return EFI_INVALID_PARAMETER;
356 }
357 }
358
359 return EFI_SUCCESS;
360 }
361
362 /**
363 Perform a write operation
364
365 @param[in] Width Width of the operation.
366 @param[in] Address Address of the operation.
367 @param[in] Count Count of the number of accesses to perform.
368 @param[in] Buffer Pointer to the buffer to write to I/O space.
369
370 @retval EFI_SUCCESS The data was written to the EFI System.
371 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
372 Buffer is NULL.
373 The Buffer is not aligned for the given Width.
374 Address is outside the legal range of I/O ports.
375
376 **/
377 EFI_STATUS
378 ScriptIoWrite (
379 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
380 IN UINT64 Address,
381 IN UINTN Count,
382 IN VOID *Buffer
383 )
384 {
385 EFI_STATUS Status;
386 UINTN AddressStride;
387 UINTN BufferStride;
388 UINT64 OriginalAddress;
389 PTR In;
390 PTR OriginalIn;
391
392 In.Buf = (UINT8 *) Buffer;
393
394 if (Address > MAX_IO_ADDRESS) {
395 return EFI_INVALID_PARAMETER;
396 }
397
398 Status = BuildLoopData (Width, Address, &AddressStride, &BufferStride);
399 if (EFI_ERROR (Status)) {
400 return Status;
401 }
402 //
403 // Loop for each iteration and move the data
404 //
405 OriginalAddress = Address;
406 OriginalIn.Buf = In.Buf;
407 for (; Count > 0; Count--, Address += AddressStride, In.Buf += BufferStride) {
408 switch (Width) {
409 case S3BootScriptWidthUint8:
410 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8 - 0x%08x (0x%02x)\n", (UINTN)Address, (UINTN)*In.Uint8));
411 IoWrite8 ((UINTN) Address, *In.Uint8);
412 break;
413 case S3BootScriptWidthFifoUint8:
414 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint8 - 0x%08x (0x%02x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint8));
415 IoWrite8 ((UINTN) OriginalAddress, *In.Uint8);
416 break;
417 case S3BootScriptWidthFillUint8:
418 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint8 - 0x%08x (0x%02x)\n", (UINTN)Address, (UINTN)*In.Uint8));
419 IoWrite8 ((UINTN) Address, *OriginalIn.Uint8);
420 break;
421 case S3BootScriptWidthUint16:
422 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16 - 0x%08x (0x%04x)\n", (UINTN)Address, (UINTN)*In.Uint16));
423 IoWrite16 ((UINTN) Address, *In.Uint16);
424 break;
425 case S3BootScriptWidthFifoUint16:
426 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint16 - 0x%08x (0x%04x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint16));
427 IoWrite16 ((UINTN) OriginalAddress, *In.Uint16);
428 break;
429 case S3BootScriptWidthFillUint16:
430 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint16 - 0x%08x (0x%04x)\n", (UINTN)Address, (UINTN)*In.Uint16));
431 IoWrite16 ((UINTN) Address, *OriginalIn.Uint16);
432 break;
433 case S3BootScriptWidthUint32:
434 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32 - 0x%08x (0x%08x)\n", (UINTN)Address, (UINTN)*In.Uint32));
435 IoWrite32 ((UINTN) Address, *In.Uint32);
436 break;
437 case S3BootScriptWidthFifoUint32:
438 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint32 - 0x%08x (0x%08x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint32));
439 IoWrite32 ((UINTN) OriginalAddress, *In.Uint32);
440 break;
441 case S3BootScriptWidthFillUint32:
442 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint32 - 0x%08x (0x%08x)\n", (UINTN)Address, (UINTN)*In.Uint32));
443 IoWrite32 ((UINTN) Address, *OriginalIn.Uint32);
444 break;
445 case S3BootScriptWidthUint64:
446 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint64 - 0x%08x (0x%016lx)\n", (UINTN)Address, *In.Uint64));
447 IoWrite64 ((UINTN) Address, *In.Uint64);
448 break;
449 case S3BootScriptWidthFifoUint64:
450 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint64 - 0x%08x (0x%016lx)\n", (UINTN)Address, *In.Uint64));
451 IoWrite64 ((UINTN) OriginalAddress, *In.Uint64);
452 break;
453 case S3BootScriptWidthFillUint64:
454 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint64 - 0x%08x (0x%016lx)\n", (UINTN)Address, *In.Uint64));
455 IoWrite64 ((UINTN) Address, *OriginalIn.Uint64);
456 break;
457 default:
458 return EFI_INVALID_PARAMETER;
459 }
460 }
461
462
463 return EFI_SUCCESS;
464 }
465 /**
466 Interprete the IO write entry in S3 boot script and perform the write operation
467
468 @param Script Pointer to the node which is to be interpreted.
469
470 @retval EFI_SUCCESS The data was written to the EFI System.
471 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
472 Buffer is NULL.
473 The Buffer is not aligned for the given Width.
474 Address is outside the legal range of I/O ports.
475
476 **/
477 EFI_STATUS
478 BootScriptExecuteIoWrite (
479 IN UINT8 *Script
480 )
481 {
482 S3_BOOT_SCRIPT_LIB_WIDTH Width;
483 UINT64 Address;
484 UINTN Count;
485 VOID *Buffer;
486 EFI_BOOT_SCRIPT_IO_WRITE IoWrite;
487
488 CopyMem ((VOID*)&IoWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_IO_WRITE));
489 Width = (S3_BOOT_SCRIPT_LIB_WIDTH) IoWrite.Width;
490 Address = IoWrite.Address;
491 Count = IoWrite.Count;
492 Buffer = Script + sizeof (EFI_BOOT_SCRIPT_IO_WRITE);
493
494 return ScriptIoWrite(Width, Address, Count, Buffer);
495 }
496 /**
497 Perform memory read operation
498
499 @param Width Width of the operation.
500 @param Address Address of the operation.
501 @param Count Count of the number of accesses to perform.
502 @param Buffer Pointer to the buffer read from memory.
503
504 @retval EFI_SUCCESS The data was written to the EFI System.
505 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
506 Buffer is NULL.
507 The Buffer is not aligned for the given Width.
508 @retval EFI_UNSUPPORTED The address range specified by Address, Width, and Count
509 is not valid for this EFI System.
510
511 **/
512 EFI_STATUS
513 ScriptMemoryRead (
514 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
515 IN UINT64 Address,
516 IN UINTN Count,
517 IN OUT VOID *Buffer
518 )
519 {
520 EFI_STATUS Status;
521 UINTN AddressStride;
522 UINTN BufferStride;
523 PTR Out;
524
525 Out.Buf = Buffer;
526
527 Status = BuildLoopData (Width, Address, &AddressStride, &BufferStride);
528 if (EFI_ERROR (Status)) {
529 return Status;
530 }
531 //
532 // Loop for each iteration and move the data
533 //
534 for (; Count > 0; Count--, Address += AddressStride, Out.Buf += BufferStride) {
535 switch (Width) {
536 case S3BootScriptWidthUint8:
537 case S3BootScriptWidthFifoUint8:
538 case S3BootScriptWidthFillUint8:
539 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8 - 0x%08x\n", (UINTN)Address));
540 *Out.Uint8 = MmioRead8 ((UINTN) Address);
541 break;
542
543 case S3BootScriptWidthUint16:
544 case S3BootScriptWidthFifoUint16:
545 case S3BootScriptWidthFillUint16:
546 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16 - 0x%08x\n", (UINTN)Address));
547 *Out.Uint16 = MmioRead16 ((UINTN) Address);
548 break;
549
550 case S3BootScriptWidthUint32:
551 case S3BootScriptWidthFifoUint32:
552 case S3BootScriptWidthFillUint32:
553 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32 - 0x%08x\n", (UINTN)Address));
554 *Out.Uint32 = MmioRead32 ((UINTN) Address);
555 break;
556
557 case S3BootScriptWidthUint64:
558 case S3BootScriptWidthFifoUint64:
559 case S3BootScriptWidthFillUint64:
560 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint64 - 0x%08x\n", (UINTN)Address));
561 *Out.Uint64 = MmioRead64 ((UINTN) Address);
562 break;
563
564 default:
565 return EFI_UNSUPPORTED;
566 }
567 }
568
569 return EFI_SUCCESS;
570 }
571 /**
572 Translates boot script to MDE library interface.
573
574 @param Width Width of the operation.
575 @param Address Address of the operation.
576 @param Count Count of the number of accesses to perform.
577 @param Buffer Pointer to the buffer write to memory.
578
579 @retval EFI_SUCCESS The data was written to the EFI System.
580 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
581 Buffer is NULL.
582 The Buffer is not aligned for the given Width.
583 @retval EFI_UNSUPPORTED The address range specified by Address, Width, and Count
584 is not valid for this EFI System.
585
586 **/
587 EFI_STATUS
588 ScriptMemoryWrite (
589 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
590 IN UINT64 Address,
591 IN UINTN Count,
592 IN OUT VOID *Buffer
593 )
594 {
595 EFI_STATUS Status;
596 UINTN AddressStride;
597 UINT64 OriginalAddress;
598 UINTN BufferStride;
599 PTR In;
600 PTR OriginalIn;
601
602 In.Buf = Buffer;
603
604 Status = BuildLoopData (Width, Address, &AddressStride, &BufferStride);
605 if (EFI_ERROR (Status)) {
606 return Status;
607 }
608 //
609 // Loop for each iteration and move the data
610 //
611 OriginalAddress = Address;
612 OriginalIn.Buf = In.Buf;
613 for (; Count > 0; Count--, Address += AddressStride, In.Buf += BufferStride) {
614 switch (Width) {
615 case S3BootScriptWidthUint8:
616 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8 - 0x%08x (0x%02x)\n", (UINTN)Address, (UINTN)*In.Uint8));
617 MmioWrite8 ((UINTN) Address, *In.Uint8);
618 break;
619 case S3BootScriptWidthFifoUint8:
620 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint8 - 0x%08x (0x%02x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint8));
621 MmioWrite8 ((UINTN) OriginalAddress, *In.Uint8);
622 break;
623 case S3BootScriptWidthFillUint8:
624 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint8 - 0x%08x (0x%02x)\n", (UINTN)Address, (UINTN)*In.Uint8));
625 MmioWrite8 ((UINTN) Address, *OriginalIn.Uint8);
626 break;
627 case S3BootScriptWidthUint16:
628 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16 - 0x%08x (0x%04x)\n", (UINTN)Address, (UINTN)*In.Uint16));
629 MmioWrite16 ((UINTN) Address, *In.Uint16);
630 break;
631 case S3BootScriptWidthFifoUint16:
632 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint16 - 0x%08x (0x%04x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint16));
633 MmioWrite16 ((UINTN) OriginalAddress, *In.Uint16);
634 break;
635 case S3BootScriptWidthFillUint16:
636 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint16 - 0x%08x (0x%04x)\n", (UINTN)Address, (UINTN)*In.Uint16));
637 MmioWrite16 ((UINTN) Address, *OriginalIn.Uint16);
638 break;
639 case S3BootScriptWidthUint32:
640 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32 - 0x%08x (0x%08x)\n", (UINTN)Address, (UINTN)*In.Uint32));
641 MmioWrite32 ((UINTN) Address, *In.Uint32);
642 break;
643 case S3BootScriptWidthFifoUint32:
644 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint32 - 0x%08x (0x%08x)\n", (UINTN)OriginalAddress, (UINTN)*In.Uint32));
645 MmioWrite32 ((UINTN) OriginalAddress, *In.Uint32);
646 break;
647 case S3BootScriptWidthFillUint32:
648 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint32 - 0x%08x (0x%08x)\n", (UINTN)Address, (UINTN)*In.Uint32));
649 MmioWrite32 ((UINTN) Address, *OriginalIn.Uint32);
650 break;
651 case S3BootScriptWidthUint64:
652 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint64 - 0x%08x (0x%016lx)\n", (UINTN)Address, *In.Uint64));
653 MmioWrite64 ((UINTN) Address, *In.Uint64);
654 break;
655 case S3BootScriptWidthFifoUint64:
656 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFifoUint64 - 0x%08x (0x%016lx)\n", (UINTN)OriginalAddress, *In.Uint64));
657 MmioWrite64 ((UINTN) OriginalAddress, *In.Uint64);
658 break;
659 case S3BootScriptWidthFillUint64:
660 DEBUG ((EFI_D_INFO, "S3BootScriptWidthFillUint64 - 0x%08x (0x%016lx)\n", (UINTN)Address, *In.Uint64));
661 MmioWrite64 ((UINTN) Address, *OriginalIn.Uint64);
662 break;
663 default:
664 return EFI_UNSUPPORTED;
665 }
666 }
667 return EFI_SUCCESS;
668 }
669 /**
670 Interprete the boot script node with EFI_BOOT_SCRIPT_MEM_WRITE OP code.
671
672 @param[in] Script Pointer to the node which is to be interpreted.
673
674 @retval EFI_SUCCESS The data was written to the EFI System.
675 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
676 Buffer is NULL.
677 The Buffer is not aligned for the given Width.
678 @retval EFI_UNSUPPORTED The address range specified by Address, Width, and Count
679 is not valid for this EFI System.
680
681 **/
682 EFI_STATUS
683 BootScriptExecuteMemoryWrite (
684 IN UINT8 *Script
685 )
686 {
687 VOID *Buffer;
688 S3_BOOT_SCRIPT_LIB_WIDTH Width;
689 UINT64 Address;
690 UINTN Count;
691 EFI_BOOT_SCRIPT_MEM_WRITE MemWrite;
692
693 CopyMem((VOID*)&MemWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_MEM_WRITE));
694 Width = (S3_BOOT_SCRIPT_LIB_WIDTH)MemWrite.Width;
695 Address = MemWrite.Address;
696 Count = MemWrite.Count;
697 Buffer = Script + sizeof(EFI_BOOT_SCRIPT_MEM_WRITE);
698
699 DEBUG ((EFI_D_INFO, "BootScriptExecuteMemoryWrite - 0x%08x, 0x%08x, 0x%08x\n", (UINTN)Address, (UINTN)Count, (UINTN)Width));
700 return ScriptMemoryWrite (Width,Address, Count, Buffer);
701
702 }
703 /**
704 Translates boot script to MDE library interface for PCI configuration read operation
705
706 @param Width Width of the operation.
707 @param Address Address of the operation.
708 @param Buffer Pointer to the buffer reaf from PCI config space
709
710 @retval EFI_SUCCESS The read succeed.
711 @retval EFI_INVALID_PARAMETER if Width is not defined
712
713 **/
714 EFI_STATUS
715 ScriptPciCfgRead (
716 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
717 IN UINT64 Address,
718 OUT VOID *Buffer
719 )
720 {
721 switch (Width) {
722 case S3BootScriptWidthUint8:
723 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8 - 0x%016lx\n", Address));
724 * (UINT8 *) Buffer = PciRead8 (PCI_ADDRESS_ENCODE(Address));
725 break;
726
727 case S3BootScriptWidthUint16:
728 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16 - 0x%016lx\n", Address));
729 * (UINT16 *) Buffer = PciRead16 (PCI_ADDRESS_ENCODE(Address));
730 break;
731
732 case S3BootScriptWidthUint32:
733 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32 - 0x%016lx\n", Address));
734 * (UINT32 *) Buffer = PciRead32 (PCI_ADDRESS_ENCODE(Address));
735 break;
736
737 default:
738 return EFI_INVALID_PARAMETER;
739 }
740 return EFI_SUCCESS;
741 }
742
743 /**
744 Translates boot script to MDE library interface for PCI configuration write operation
745
746 @param Width Width of the operation.
747 @param Address Address of the operation.
748 @param Buffer Pointer to the buffer reaf from PCI config space
749
750 @retval EFI_SUCCESS The write succeed.
751 @retval EFI_INVALID_PARAMETER if Width is not defined
752
753 **/
754 EFI_STATUS
755 ScriptPciCfgWrite (
756 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
757 IN UINT64 Address,
758 OUT VOID *Buffer
759 )
760 {
761 switch (Width) {
762 case S3BootScriptWidthUint8:
763 case S3BootScriptWidthFifoUint8:
764 case S3BootScriptWidthFillUint8:
765 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint8 - 0x%016lx (0x%02x)\n", Address, (UINTN)*(UINT8 *) Buffer));
766 PciWrite8 (PCI_ADDRESS_ENCODE(Address), *(UINT8 *) Buffer);
767 break;
768 case S3BootScriptWidthUint16:
769 case S3BootScriptWidthFifoUint16:
770 case S3BootScriptWidthFillUint16:
771 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint16 - 0x%016lx (0x%04x)\n", Address, (UINTN)*(UINT16 *) Buffer));
772 PciWrite16 (PCI_ADDRESS_ENCODE(Address), *(UINT16 *) Buffer);
773 break;
774 case S3BootScriptWidthUint32:
775 case S3BootScriptWidthFifoUint32:
776 case S3BootScriptWidthFillUint32:
777 DEBUG ((EFI_D_INFO, "S3BootScriptWidthUint32 - 0x%016lx (0x%08x)\n", Address, (UINTN)*(UINT32 *) Buffer));
778 PciWrite32 (PCI_ADDRESS_ENCODE(Address), *(UINT32 *) Buffer);
779 break;
780 default:
781 return EFI_INVALID_PARAMETER;
782 }
783 return EFI_SUCCESS;
784 }
785 /**
786 Perform pci configure 2 read operation.
787
788 @param Width Width of the operation.
789 @param Segment Pci segment number
790 @param Address Address of the operation.
791 @param Buffer Pointer to the buffer to write to I/O space.
792
793 @retval EFI_SUCCESS The data was written to the EFI System.
794 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
795 Buffer is NULL.
796 The Buffer is not aligned for the given Width.
797 Address is outside the legal range of I/O ports.
798 @note A known Limitations in the implementation which is the 'Segment' parameter is assumed as
799 Zero, or else, assert.
800 **/
801 EFI_STATUS
802 ScriptPciCfg2Read (
803 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
804 IN UINT16 Segment,
805 IN UINT64 Address,
806 OUT VOID *Buffer
807 )
808 {
809 ASSERT (Segment==0);
810
811 return ScriptPciCfgRead (Width, Address, Buffer);
812 }
813 /**
814 Perform pci configure write operation.
815
816 @param Width Width of the operation.
817 @param Segment Pci segment number
818 @param Address Address of the operation.
819 @param Buffer Pointer to the buffer to write to I/O space.
820
821 @retval EFI_SUCCESS The data was written to the EFI System.
822 @retval EFI_INVALID_PARAMETER Width is invalid for this EFI System.
823 Buffer is NULL.
824 The Buffer is not aligned for the given Width.
825 Address is outside the legal range of I/O ports.
826 @note A known Limitations in the implementation which is the 'Segment' parameter is assumed as
827 Zero, or else, assert.
828
829 **/
830 EFI_STATUS
831 EFIAPI
832 ScriptPciCfg2Write (
833 IN S3_BOOT_SCRIPT_LIB_WIDTH Width,
834 IN UINT16 Segment,
835 IN UINT64 Address,
836 OUT VOID *Buffer
837 )
838 {
839 ASSERT (Segment==0);
840 return ScriptPciCfgWrite (Width, Address, Buffer);
841 }
842 /**
843 Perform Pci configuration Write operation.
844
845 @param Script The pointer of typed node in boot script table
846
847 @retval EFI_SUCCESS The operation was executed successfully
848 **/
849 EFI_STATUS
850 BootScriptExecutePciCfgWrite (
851 IN UINT8 *Script
852 )
853 {
854 EFI_STATUS Status;
855 UINT8 *Buffer;
856 UINTN DataWidth;
857 UINTN Index;
858 UINT64 PciAddress;
859 UINT8 Reg;
860 EFI_BOOT_SCRIPT_PCI_CONFIG_WRITE PciConfigWrite;
861
862 CopyMem ((VOID*)&PciConfigWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG_WRITE));
863 Status = EFI_SUCCESS;
864
865 PciAddress = PciConfigWrite.Address;
866 DataWidth = (UINT32)(0x01 << (PciConfigWrite.Width));
867 Buffer = Script + sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG_WRITE);
868
869 DEBUG ((EFI_D_INFO, "BootScriptExecutePciCfgWrite - 0x%08x, 0x%08x, 0x%08x\n", (UINTN)PciAddress, (UINTN)PciConfigWrite.Count, (UINTN)DataWidth));
870
871 for (Index = 0; Index < PciConfigWrite.Count; Index++) {
872 Status = ScriptPciCfgWrite (
873 (S3_BOOT_SCRIPT_LIB_WIDTH) PciConfigWrite.Width,
874 PciAddress,
875 Buffer
876 );
877
878 if ( S3BootScriptWidthFillUint8 != PciConfigWrite.Width ||
879 S3BootScriptWidthFillUint16 != PciConfigWrite.Width ||
880 S3BootScriptWidthFillUint32 != PciConfigWrite.Width ||
881 S3BootScriptWidthFillUint64 != PciConfigWrite.Width){
882 Reg = (UINT8) ((UINT8) PciAddress + DataWidth);
883 PciAddress = (PciAddress & 0xFFFFFFFFFFFFFF00ULL) + Reg;
884 }
885
886 if (S3BootScriptWidthFifoUint8 != PciConfigWrite.Width ||
887 S3BootScriptWidthFifoUint16 != PciConfigWrite.Width ||
888 S3BootScriptWidthFifoUint32 != PciConfigWrite.Width ||
889 S3BootScriptWidthFifoUint64 != PciConfigWrite.Width) {
890 Buffer += DataWidth;
891 }
892 }
893
894 return Status;
895 }
896 /**
897 Excute the script to perform IO modification operation.
898
899 @param Script The pointer of typed node in boot script table
900 @param AndMask Mask value for 'and' operation
901 @param OrMask Mask value for 'or' operation
902
903 @retval EFI_SUCCESS The operation was executed successfully
904 **/
905 EFI_STATUS
906 BootScriptExecuteIoReadWrite (
907 IN UINT8 *Script,
908 IN UINT64 AndMask,
909 IN UINT64 OrMask
910 )
911
912 {
913 EFI_STATUS Status;
914 UINT64 Data;
915 EFI_BOOT_SCRIPT_IO_READ_WRITE IoReadWrite;
916
917 Data = 0;
918
919 CopyMem((VOID*)&IoReadWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_IO_READ_WRITE));
920
921 DEBUG ((EFI_D_INFO, "BootScriptExecuteIoReadWrite - 0x%08x, 0x%016lx, 0x%016lx\n", (UINTN)IoReadWrite.Address, (UINT64)AndMask, (UINT64)OrMask));
922
923 Status = ScriptIoRead (
924 (S3_BOOT_SCRIPT_LIB_WIDTH) IoReadWrite.Width,
925 IoReadWrite.Address,
926 1,
927 &Data
928 );
929 if (!EFI_ERROR (Status)) {
930 Data = (Data & AndMask) | OrMask;
931 Status = ScriptIoWrite (
932 (S3_BOOT_SCRIPT_LIB_WIDTH) IoReadWrite.Width,
933 IoReadWrite.Address,
934 1,
935 &Data
936 );
937 }
938 return Status;
939 }
940 /**
941 Excute the script to perform memory modification operation.
942
943 @param Script The pointer of typed node in boot script table
944 @param AndMask Mask value for 'and' operation
945 @param OrMask Mask value for 'or' operation
946
947 @retval EFI_SUCCESS The operation was executed successfully
948 **/
949 EFI_STATUS
950 BootScriptExecuteMemoryReadWrite (
951 IN UINT8 *Script,
952 IN UINT64 AndMask,
953 IN UINT64 OrMask
954 )
955
956 {
957 EFI_STATUS Status;
958 UINT64 Data;
959 EFI_BOOT_SCRIPT_MEM_READ_WRITE MemReadWrite;
960
961 Data = 0;
962
963 CopyMem((VOID*)&MemReadWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_MEM_READ_WRITE));
964
965 DEBUG ((EFI_D_INFO, "BootScriptExecuteMemoryReadWrite - 0x%08x, 0x%016lx, 0x%016lx\n", (UINTN)MemReadWrite.Address, (UINT64)AndMask, (UINT64)OrMask));
966
967 Status = ScriptMemoryRead (
968 (S3_BOOT_SCRIPT_LIB_WIDTH) MemReadWrite.Width,
969 MemReadWrite.Address,
970 1,
971 &Data
972 );
973 if (!EFI_ERROR (Status)) {
974 Data = (Data & AndMask) | OrMask;
975 Status = ScriptMemoryWrite (
976 (S3_BOOT_SCRIPT_LIB_WIDTH) MemReadWrite.Width,
977 MemReadWrite.Address,
978 1,
979 &Data
980 );
981 }
982 return Status;
983 }
984 /**
985 Excute the script to perform PCI IO modification operation.
986
987 @param Script The pointer of typed node in boot script table
988 @param AndMask Mask value for 'and' operation
989 @param OrMask Mask value for 'or' operation
990
991 @retval EFI_SUCCESS The operation was executed successfully
992 **/
993 EFI_STATUS
994 BootScriptExecutePciCfgReadWrite (
995 IN UINT8 *Script,
996 IN UINT64 AndMask,
997 IN UINT64 OrMask
998 )
999
1000 {
1001 EFI_STATUS Status;
1002 UINT64 Data;
1003 EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE PciCfgReadWrite;
1004
1005 CopyMem((VOID*)&PciCfgReadWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE));
1006
1007 DEBUG ((EFI_D_INFO, "BootScriptExecutePciCfgReadWrite - 0x%08x, 0x%016lx, 0x%016lx\n", (UINTN)PciCfgReadWrite.Address, (UINT64)AndMask, (UINT64)OrMask));
1008
1009 Status = ScriptPciCfgRead (
1010 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfgReadWrite.Width,
1011 PciCfgReadWrite.Address,
1012 &Data
1013 );
1014 if (EFI_ERROR (Status)) {
1015 return Status;
1016 }
1017
1018 Data = (Data & AndMask) | OrMask;
1019
1020 Status = ScriptPciCfgWrite (
1021 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfgReadWrite.Width,
1022 PciCfgReadWrite.Address,
1023 &Data
1024 );
1025
1026 return Status;
1027 }
1028 /**
1029 To Execute SMBUS command.
1030
1031 @param Script The pointer of typed node in boot script table
1032
1033 @retval EFI_SUCCESS The operation was executed successfully
1034 @retval EFI_UNSUPPORTED Cannot locate smbus ppi or occur error of script execution
1035 @retval Others Result of script execution
1036 **/
1037 EFI_STATUS
1038 BootScriptExecuteSmbusExecute (
1039 IN UINT8 *Script
1040 )
1041 {
1042 UINTN SmBusAddress;
1043 UINTN DataSize;
1044 EFI_BOOT_SCRIPT_SMBUS_EXECUTE SmbusExecuteEntry;
1045
1046 CopyMem ((VOID*)&SmbusExecuteEntry, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_SMBUS_EXECUTE ));
1047
1048 DEBUG ((EFI_D_INFO, "BootScriptExecuteSmbusExecute - 0x%08x, 0x%08x\n", (UINTN)SmbusExecuteEntry.SmBusAddress, (UINTN)SmbusExecuteEntry.Operation));
1049
1050 SmBusAddress = (UINTN)SmbusExecuteEntry.SmBusAddress;
1051 DataSize = (UINTN) SmbusExecuteEntry.DataSize;
1052 return SmbusExecute (
1053 SmBusAddress,
1054 (EFI_SMBUS_OPERATION) SmbusExecuteEntry.Operation,
1055 &DataSize,
1056 Script + sizeof (EFI_BOOT_SCRIPT_SMBUS_EXECUTE)
1057 );
1058 }
1059 /**
1060 Execute stall operation in boot script table.
1061
1062 @param Script The pointer of typed node in boot script table
1063
1064 @retval EFI_SUCCESS The operation was executed successfully
1065 **/
1066 EFI_STATUS
1067 BootScriptExecuteStall (
1068 IN UINT8 *Script
1069 )
1070 {
1071 EFI_BOOT_SCRIPT_STALL Stall;
1072
1073 CopyMem ((VOID*)&Stall, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_STALL));
1074
1075 DEBUG ((EFI_D_INFO, "BootScriptExecuteStall - 0x%08x\n", (UINTN)Stall.Duration));
1076
1077 MicroSecondDelay ((UINTN) Stall.Duration);
1078 return EFI_SUCCESS;
1079 }
1080 /**
1081 To execute assigned function.
1082
1083 @param Script The pointer of typed node in boot script table
1084 @retval EFI_SUCCESS The operation was executed successfully
1085 **/
1086 EFI_STATUS
1087 BootScriptExecuteDispatch (
1088 IN UINT8 *Script
1089 )
1090 {
1091 EFI_STATUS Status;
1092 DISPATCH_ENTRYPOINT_FUNC EntryFunc;
1093 EFI_BOOT_SCRIPT_DISPATCH ScriptDispatch;
1094
1095 CopyMem ((VOID*)&ScriptDispatch, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_DISPATCH));
1096 EntryFunc = (DISPATCH_ENTRYPOINT_FUNC) (UINTN) (ScriptDispatch.EntryPoint);
1097
1098 DEBUG ((EFI_D_INFO, "BootScriptExecuteDispatch - 0x%08x\n", (UINTN)ScriptDispatch.EntryPoint));
1099
1100 Status = EntryFunc (NULL, NULL);
1101
1102 return Status;
1103 }
1104 /**
1105 Execute dispach2 opertion code which is to invoke a spcified function with one parameter.
1106
1107 @param Script The pointer of typed node in boot script table
1108 @retval EFI_SUCCESS The operation was executed successfully
1109 **/
1110 EFI_STATUS
1111 BootScriptExecuteDispatch2 (
1112 IN UINT8 *Script
1113 )
1114 {
1115 EFI_STATUS Status;
1116 DISPATCH_ENTRYPOINT_FUNC EntryFunc;
1117 EFI_BOOT_SCRIPT_DISPATCH_2 ScriptDispatch2;
1118
1119 CopyMem ((VOID*)&ScriptDispatch2, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_DISPATCH_2));
1120
1121 DEBUG ((EFI_D_INFO, "BootScriptExecuteDispatch2 - 0x%08x(0x%08x)\n", (UINTN)ScriptDispatch2.EntryPoint, (UINTN)ScriptDispatch2.Context));
1122
1123 EntryFunc = (DISPATCH_ENTRYPOINT_FUNC) (UINTN) (ScriptDispatch2.EntryPoint);
1124
1125 Status = EntryFunc (NULL, (VOID *) (UINTN) ScriptDispatch2.Context);
1126
1127 return Status;
1128 }
1129 /**
1130 Excute the script to poll memory.
1131
1132 @param Script The pointer of typed node in boot script table
1133 @param AndMask Mask value for 'and' operation
1134 @param OrMask Mask value for 'or' operation
1135
1136 @retval EFI_DEVICE_ERROR Data polled from memory does not equal to
1137 the epecting data within the Loop Times.
1138 @retval EFI_SUCCESS The operation was executed successfully
1139 **/
1140 EFI_STATUS
1141 BootScriptExecuteMemPoll (
1142 IN UINT8 *Script,
1143 IN UINT64 AndMask,
1144 IN UINT64 OrMask
1145 )
1146 {
1147
1148 UINT64 Data;
1149 UINT64 LoopTimes;
1150 EFI_STATUS Status;
1151 EFI_BOOT_SCRIPT_MEM_POLL MemPoll;
1152
1153 CopyMem ((VOID*)&MemPoll, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_MEM_POLL));
1154
1155 DEBUG ((EFI_D_INFO, "BootScriptExecuteMemPoll - 0x%08x\n", (UINTN)MemPoll.Address));
1156
1157 Data = 0;
1158 Status = ScriptMemoryRead (
1159 (S3_BOOT_SCRIPT_LIB_WIDTH) MemPoll.Width,
1160 MemPoll.Address,
1161 1,
1162 &Data
1163 );
1164 if ((!EFI_ERROR (Status)) && (Data & AndMask) == OrMask) {
1165 return EFI_SUCCESS;
1166 }
1167
1168 for (LoopTimes = 0; LoopTimes < MemPoll.LoopTimes; LoopTimes++) {
1169 NanoSecondDelay ((UINTN)MemPoll.Duration);
1170
1171 Data = 0;
1172 Status = ScriptMemoryRead (
1173 (S3_BOOT_SCRIPT_LIB_WIDTH) MemPoll.Width,
1174 MemPoll.Address,
1175 1,
1176 &Data
1177 );
1178 if ((!EFI_ERROR (Status)) && (Data & AndMask) == OrMask) {
1179 return EFI_SUCCESS;
1180 }
1181 }
1182
1183 if (LoopTimes < MemPoll.LoopTimes) {
1184 return EFI_SUCCESS;
1185 } else {
1186 return EFI_DEVICE_ERROR;
1187 }
1188 }
1189 /**
1190 Execute the boot script to interpret the Store arbitrary information.
1191 This opcode is a no-op on dispatch and is only used for debugging script issues.
1192
1193 @param Script The pointer of node in boot script table
1194
1195 **/
1196 VOID
1197 BootScriptExecuteInformation (
1198 IN UINT8 *Script
1199 )
1200
1201 {
1202 UINT8 Index;
1203 for (Index = 0; Index < 10; Index++);
1204 }
1205 /**
1206 calculate the mask value for 'and' and 'or' operation
1207 @param ScriptHeader The pointer of header of node in boot script table
1208 @param AndMask The Mask value for 'and' operation
1209 @param OrMask The Mask value for 'or' operation
1210 @param Script Pointer to the entry.
1211
1212 **/
1213 VOID
1214 CheckAndOrMask (
1215 IN EFI_BOOT_SCRIPT_COMMON_HEADER *ScriptHeader,
1216 OUT UINT64 *AndMask,
1217 OUT UINT64 *OrMask,
1218 IN UINT8 *Script
1219 )
1220 {
1221 UINT8 *DataPtr;
1222 UINTN Size;
1223
1224 switch (ScriptHeader->OpCode) {
1225 case EFI_BOOT_SCRIPT_IO_READ_WRITE_OPCODE:
1226 Size = sizeof (EFI_BOOT_SCRIPT_IO_READ_WRITE);
1227 break;
1228
1229 case EFI_BOOT_SCRIPT_MEM_READ_WRITE_OPCODE:
1230 Size = sizeof (EFI_BOOT_SCRIPT_MEM_READ_WRITE);
1231 break;
1232
1233 case EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE_OPCODE:
1234 Size = sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE);
1235 break;
1236 case EFI_BOOT_SCRIPT_MEM_POLL_OPCODE:
1237 Size = sizeof (EFI_BOOT_SCRIPT_MEM_POLL);
1238 break;
1239
1240 case EFI_BOOT_SCRIPT_IO_POLL_OPCODE:
1241 Size = sizeof (EFI_BOOT_SCRIPT_IO_POLL);
1242 break;
1243
1244 case EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE_OPCODE:
1245 Size = sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE);
1246 break;
1247
1248 case EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL_OPCODE:
1249 Size = sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL);
1250 break;
1251
1252 case EFI_BOOT_SCRIPT_PCI_CONFIG_POLL_OPCODE:
1253 Size = sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG_POLL);
1254 break;
1255
1256 default:
1257 return;
1258 }
1259
1260 DataPtr = Script + Size;
1261
1262 switch (ScriptHeader->Width) {
1263 case S3BootScriptWidthUint8:
1264 *AndMask = (UINT64) *(DataPtr + 1);
1265 *OrMask = (UINT64) (*DataPtr);
1266 break;
1267
1268 case S3BootScriptWidthUint16:
1269 *AndMask = (UINT64) (*(UINT16 *) (DataPtr + 2));
1270 *OrMask = (UINT64) (*(UINT16 *) DataPtr);
1271 break;
1272
1273 case S3BootScriptWidthUint32:
1274 *AndMask = (UINT64) (*(UINT32 *) (DataPtr + 4));
1275 *OrMask = (UINT64) (*(UINT32 *) DataPtr);
1276 break;
1277
1278 case S3BootScriptWidthUint64:
1279 *AndMask = (UINT64) (*(UINT64 *) (DataPtr + 8));
1280 *OrMask = (UINT64) (*(UINT64 *) DataPtr);
1281 break;
1282
1283 default:
1284 break;
1285 }
1286
1287 return;
1288 }
1289 /**
1290 Excute the script to poll Io port for some time
1291
1292 @param Script The pointer of typed node in boot script table
1293 @param AndMask Mask value for 'and' operation
1294 @param OrMask Mask value for 'or' operation
1295
1296 @retval EFI_DEVICE_ERROR Data polled from memory does not equal to
1297 the epecting data within the Loop Times.
1298 @retval EFI_SUCCESS The operation was executed successfully
1299 **/
1300 EFI_STATUS
1301 BootScriptExecuteIoPoll (
1302 IN UINT8 *Script,
1303 IN UINT64 AndMask,
1304 IN UINT64 OrMask
1305 )
1306 {
1307 EFI_STATUS Status;
1308 UINT64 Data;
1309 UINT64 LoopTimes;
1310 EFI_BOOT_SCRIPT_IO_POLL IoPoll;
1311
1312 CopyMem ((VOID*)&IoPoll, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_IO_POLL));
1313
1314 DEBUG ((EFI_D_INFO, "BootScriptExecuteIoPoll - 0x%08x\n", (UINTN)IoPoll.Address));
1315
1316 Data = 0;
1317 Status = ScriptIoRead (
1318 (S3_BOOT_SCRIPT_LIB_WIDTH) IoPoll.Width,
1319 IoPoll.Address,
1320 1,
1321 &Data
1322 );
1323 if ((!EFI_ERROR (Status)) && (Data & AndMask) == OrMask) {
1324 return EFI_SUCCESS;
1325 }
1326 for (LoopTimes = 0; LoopTimes < IoPoll.Delay; LoopTimes++) {
1327 NanoSecondDelay (100);
1328 Data = 0;
1329 Status = ScriptIoRead (
1330 (S3_BOOT_SCRIPT_LIB_WIDTH) IoPoll.Width,
1331 IoPoll.Address,
1332 1,
1333 &Data
1334 );
1335 if ((!EFI_ERROR (Status)) &&(Data & AndMask) == OrMask) {
1336 return EFI_SUCCESS;
1337 }
1338 }
1339
1340 if (LoopTimes < IoPoll.Delay) {
1341 return EFI_SUCCESS;
1342 } else {
1343 return EFI_DEVICE_ERROR;
1344 }
1345 }
1346 /**
1347 Perform Pci configuration Write operation.
1348
1349 @param Script The pointer of S3 boot script
1350
1351 @retval EFI_SUCCESS The operation was executed successfully
1352
1353 **/
1354 EFI_STATUS
1355 BootScriptExecutePciCfg2Write (
1356 IN UINT8 *Script
1357 )
1358 {
1359 UINT8 Reg;
1360 UINT8 *Buffer;
1361 UINTN DataWidth;
1362 UINTN Index;
1363 UINT16 Segment;
1364 UINT64 PciAddress;
1365 EFI_STATUS Status;
1366 EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE PciCfg2Write;
1367
1368 CopyMem ((VOID*)&PciCfg2Write, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE));
1369 Status = EFI_SUCCESS;
1370 Segment = PciCfg2Write.Segment;
1371 PciAddress = PciCfg2Write.Address;
1372 DataWidth = (UINT32)(0x01 << (PciCfg2Write.Width));
1373 Buffer = Script + sizeof (EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE);
1374
1375 DEBUG ((EFI_D_INFO, "BootScriptExecutePciCfg2Write - 0x%08x\n", (UINTN)PciAddress));
1376
1377 for (Index = 0; Index < PciCfg2Write.Count; Index++) {
1378 Status = ScriptPciCfg2Write (
1379 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfg2Write.Width,
1380 Segment,
1381 PciAddress,
1382 Buffer
1383 );
1384 if (S3BootScriptWidthFillUint8 != PciCfg2Write.Width ||
1385 S3BootScriptWidthFillUint16 != PciCfg2Write.Width ||
1386 S3BootScriptWidthFillUint32 != PciCfg2Write.Width ||
1387 S3BootScriptWidthFillUint64 != PciCfg2Write.Width){
1388 Reg = (UINT8) ((UINT8) PciAddress + DataWidth);
1389 PciAddress = (PciAddress & 0xFFFFFFFFFFFFFF00ULL) + Reg;
1390 }
1391
1392 if (S3BootScriptWidthFifoUint8 != PciCfg2Write.Width ||
1393 S3BootScriptWidthFifoUint16 != PciCfg2Write.Width ||
1394 S3BootScriptWidthFifoUint32 != PciCfg2Write.Width ||
1395 S3BootScriptWidthFifoUint64 != PciCfg2Write.Width) {
1396 Buffer += DataWidth;
1397 }
1398 }
1399 return Status;
1400 }
1401
1402
1403 /**
1404 Perform pci configuration read & Write operation.
1405
1406 @param Script The pointer of S3 boot script
1407 @param AndMask Mask value for 'and' operation
1408 @param OrMask Mask value for 'or' operation
1409
1410 @retval EFI_SUCCESS The operation was executed successfully
1411
1412 **/
1413 EFI_STATUS
1414 BootScriptExecutePciCfg2ReadWrite (
1415 IN UINT8 *Script,
1416 IN UINT64 AndMask,
1417 IN UINT64 OrMask
1418 )
1419 {
1420 UINT64 Data;
1421 EFI_STATUS Status;
1422 EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE PciCfg2ReadWrite;
1423 CopyMem ((VOID*)&PciCfg2ReadWrite, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE));
1424
1425 DEBUG ((EFI_D_INFO, "BootScriptExecutePciCfg2ReadWrite - 0x%08x\n", (UINTN)PciCfg2ReadWrite.Address));
1426
1427 Status = ScriptPciCfg2Read (
1428 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfg2ReadWrite.Width,
1429 PciCfg2ReadWrite.Segment,
1430 PciCfg2ReadWrite.Address,
1431 &Data
1432 );
1433 if (EFI_ERROR (Status)) {
1434 return Status;
1435 }
1436
1437 Data = (Data & AndMask) | OrMask;
1438 Status = ScriptPciCfg2Write (
1439 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfg2ReadWrite.Width,
1440 PciCfg2ReadWrite.Segment,
1441 PciCfg2ReadWrite.Address,
1442 &Data
1443 );
1444 return Status;
1445 }
1446 /**
1447 To perform poll pci configure operation.
1448
1449 @param Script The pointer of S3 boot script
1450 @param AndMask Mask value for 'and' operation
1451 @param OrMask Mask value for 'or' operation
1452
1453 @retval EFI_SUCCESS The operation was executed successfully
1454 @retval EFI_DEVICE_ERROR Data polled from Pci configuration space does not equal to
1455 epecting data within the Loop Times.
1456 **/
1457 EFI_STATUS
1458 BootScriptPciCfgPoll (
1459 IN UINT8 *Script,
1460 IN UINT64 AndMask,
1461 IN UINT64 OrMask
1462 )
1463 {
1464 UINT64 Data;
1465 UINT64 LoopTimes;
1466 EFI_STATUS Status;
1467 EFI_BOOT_SCRIPT_PCI_CONFIG_POLL PciCfgPoll;
1468 CopyMem ((VOID*)&PciCfgPoll, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG_POLL));
1469
1470 DEBUG ((EFI_D_INFO, "BootScriptPciCfgPoll - 0x%08x\n", (UINTN)PciCfgPoll.Address));
1471
1472 Data = 0;
1473 Status = ScriptPciCfgRead (
1474 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfgPoll.Width,
1475 PciCfgPoll.Address,
1476 &Data
1477 );
1478 if ((!EFI_ERROR (Status)) &&(Data & AndMask) == OrMask) {
1479 return EFI_SUCCESS;
1480 }
1481
1482 for (LoopTimes = 0; LoopTimes < PciCfgPoll.Delay; LoopTimes++) {
1483 NanoSecondDelay (100);
1484 Data = 0;
1485 Status = ScriptPciCfgRead (
1486 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfgPoll.Width,
1487 PciCfgPoll.Address,
1488 &Data
1489 );
1490 if ((!EFI_ERROR (Status)) &&
1491 (Data & AndMask) == OrMask) {
1492 return EFI_SUCCESS;
1493 }
1494 }
1495
1496 if (LoopTimes < PciCfgPoll.Delay) {
1497 return EFI_SUCCESS;
1498 } else {
1499 return EFI_DEVICE_ERROR;
1500 }
1501 }
1502
1503 /**
1504 To perform poll pci configure operation.
1505
1506 @param Script The pointer of S3 Boot Script
1507 @param AndMask Mask value for 'and' operation
1508 @param OrMask Mask value for 'or' operation
1509
1510 @retval EFI_SUCCESS The operation was executed successfully
1511 @retval EFI_DEVICE_ERROR Data polled from Pci configuration space does not equal to
1512 epecting data within the Loop Times.
1513
1514 **/
1515 EFI_STATUS
1516 BootScriptPciCfg2Poll (
1517 IN UINT8 *Script,
1518 IN UINT64 AndMask,
1519 IN UINT64 OrMask
1520 )
1521 {
1522 EFI_STATUS Status;
1523 UINT64 Data;
1524 UINT64 LoopTimes;
1525 EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL PciCfg2Poll;
1526
1527 Data = 0;
1528 CopyMem ((VOID*)&PciCfg2Poll, (VOID*)Script, sizeof(EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL));
1529
1530 DEBUG ((EFI_D_INFO, "BootScriptPciCfg2Poll - 0x%08x\n", (UINTN)PciCfg2Poll.Address));
1531
1532 Status = ScriptPciCfg2Read (
1533 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfg2Poll.Width,
1534 PciCfg2Poll.Segment,
1535 PciCfg2Poll.Address,
1536 &Data
1537 );
1538 if ((!EFI_ERROR (Status)) && (Data & AndMask) == OrMask) {
1539 return EFI_SUCCESS;
1540 }
1541
1542 for (LoopTimes = 0; LoopTimes < PciCfg2Poll.Delay; LoopTimes++) {
1543 NanoSecondDelay (100);
1544
1545 Data = 0;
1546 Status = ScriptPciCfg2Read (
1547 (S3_BOOT_SCRIPT_LIB_WIDTH) PciCfg2Poll.Width,
1548 PciCfg2Poll.Segment,
1549 PciCfg2Poll.Address,
1550 &Data
1551 );
1552 if ((!EFI_ERROR (Status)) && (Data & AndMask) == OrMask) {
1553 return EFI_SUCCESS;
1554 }
1555 }
1556
1557 if (LoopTimes < PciCfg2Poll.Delay) {
1558 return EFI_SUCCESS;
1559 } else {
1560 return EFI_DEVICE_ERROR;
1561 }
1562
1563 }
1564
1565 /**
1566 Executes the S3 boot script table.
1567
1568 @retval RETURN_SUCCESS The boot script table was executed successfully.
1569 @retval RETURN_UNSUPPORTED Invalid script table or opcode.
1570
1571 @note A known Limitations in the implementation: When interpreting the opcode EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE_OPCODE
1572 EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE_OPCODE and EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL_OPCODE, the 'Segment' parameter is assumed as
1573 Zero, or else, assert.
1574 **/
1575 RETURN_STATUS
1576 EFIAPI
1577 S3BootScriptExecute (
1578 VOID
1579 )
1580 {
1581 EFI_STATUS Status;
1582 UINT8* Script;
1583 UINTN StartAddress;
1584 UINT32 TableLength;
1585 UINT64 AndMask;
1586 UINT64 OrMask;
1587 EFI_BOOT_SCRIPT_COMMON_HEADER ScriptHeader;
1588 EFI_BOOT_SCRIPT_TABLE_HEADER TableHeader;
1589 Script = mS3BootScriptTablePtr->TableBase;
1590 if (Script != 0) {
1591 CopyMem ((VOID*)&TableHeader, Script, sizeof(EFI_BOOT_SCRIPT_TABLE_HEADER));
1592 } else {
1593 return EFI_INVALID_PARAMETER;
1594 }
1595
1596 DEBUG ((EFI_D_INFO, "S3BootScriptExecute:\n"));
1597 if (TableHeader.OpCode != S3_BOOT_SCRIPT_LIB_TABLE_OPCODE) {
1598 return EFI_UNSUPPORTED;
1599 }
1600
1601 DEBUG ((EFI_D_INFO, "TableHeader - 0x%08x\n", Script));
1602
1603 StartAddress = (UINTN) Script;
1604 TableLength = TableHeader.TableLength;
1605 Script = Script + TableHeader.Length;
1606 Status = EFI_SUCCESS;
1607 AndMask = 0;
1608 OrMask = 0;
1609
1610 DEBUG ((EFI_D_INFO, "TableHeader.TableLength - 0x%08x\n", (UINTN)TableLength));
1611
1612 while ((UINTN) Script < (UINTN) (StartAddress + TableLength)) {
1613 DEBUG ((EFI_D_INFO, "ExecuteBootScript - %08x\n", (UINTN)Script));
1614
1615 CopyMem ((VOID*)&ScriptHeader, Script, sizeof(EFI_BOOT_SCRIPT_COMMON_HEADER));
1616 switch (ScriptHeader.OpCode) {
1617
1618 case EFI_BOOT_SCRIPT_MEM_WRITE_OPCODE:
1619 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_MEM_WRITE_OPCODE\n"));
1620 Status = BootScriptExecuteMemoryWrite (Script);
1621 break;
1622
1623 case EFI_BOOT_SCRIPT_MEM_READ_WRITE_OPCODE:
1624 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_MEM_READ_WRITE_OPCODE\n"));
1625 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1626 Status = BootScriptExecuteMemoryReadWrite (
1627 Script,
1628 AndMask,
1629 OrMask
1630 );
1631 break;
1632
1633 case EFI_BOOT_SCRIPT_IO_WRITE_OPCODE:
1634 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_IO_WRITE_OPCODE\n"));
1635 Status = BootScriptExecuteIoWrite (Script);
1636 break;
1637
1638 case EFI_BOOT_SCRIPT_PCI_CONFIG_WRITE_OPCODE:
1639 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG_WRITE_OPCODE\n"));
1640 Status = BootScriptExecutePciCfgWrite (Script);
1641 break;
1642
1643 case EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE_OPCODE:
1644 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG_READ_WRITE_OPCODE\n"));
1645 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1646 Status = BootScriptExecutePciCfgReadWrite (
1647 Script,
1648 AndMask,
1649 OrMask
1650 );
1651 break;
1652 case EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE_OPCODE:
1653 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG2_WRITE_OPCODE\n"));
1654 Status = BootScriptExecutePciCfg2Write (Script);
1655 break;
1656
1657 case EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE_OPCODE:
1658 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG2_READ_WRITE_OPCODE\n"));
1659 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1660 Status = BootScriptExecutePciCfg2ReadWrite (
1661 Script,
1662 AndMask,
1663 OrMask
1664 );
1665 break;
1666 case EFI_BOOT_SCRIPT_DISPATCH_OPCODE:
1667 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_DISPATCH_OPCODE\n"));
1668 Status = BootScriptExecuteDispatch (Script);
1669 break;
1670
1671 case EFI_BOOT_SCRIPT_DISPATCH_2_OPCODE:
1672 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_DISPATCH_2_OPCODE\n"));
1673 Status = BootScriptExecuteDispatch2 (Script);
1674 break;
1675
1676 case EFI_BOOT_SCRIPT_INFORMATION_OPCODE:
1677 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_INFORMATION_OPCODE\n"));
1678 BootScriptExecuteInformation (Script);
1679 break;
1680
1681 case S3_BOOT_SCRIPT_LIB_TERMINATE_OPCODE:
1682 DEBUG ((EFI_D_INFO, "S3_BOOT_SCRIPT_LIB_TERMINATE_OPCODE\n"));
1683 return EFI_SUCCESS;
1684
1685 case EFI_BOOT_SCRIPT_IO_READ_WRITE_OPCODE:
1686 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_IO_READ_WRITE_OPCODE\n"));
1687 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1688 Status = BootScriptExecuteIoReadWrite (
1689 Script,
1690 AndMask,
1691 OrMask
1692 );
1693 break;
1694
1695 case EFI_BOOT_SCRIPT_SMBUS_EXECUTE_OPCODE:
1696 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_SMBUS_EXECUTE_OPCODE\n"));
1697 Status = BootScriptExecuteSmbusExecute (Script);
1698 break;
1699
1700 case EFI_BOOT_SCRIPT_STALL_OPCODE:
1701 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_STALL_OPCODE\n"));
1702 Status = BootScriptExecuteStall (Script);
1703 break;
1704
1705 case EFI_BOOT_SCRIPT_MEM_POLL_OPCODE:
1706 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_MEM_POLL_OPCODE\n"));
1707 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1708 Status = BootScriptExecuteMemPoll (Script, AndMask, OrMask);
1709
1710 break;
1711
1712 case EFI_BOOT_SCRIPT_IO_POLL_OPCODE:
1713 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_IO_POLL_OPCODE\n"));
1714 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1715 Status = BootScriptExecuteIoPoll (Script, AndMask, OrMask);
1716 break;
1717
1718 case EFI_BOOT_SCRIPT_PCI_CONFIG_POLL_OPCODE:
1719 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG_POLL_OPCODE\n"));
1720 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1721 Status = BootScriptPciCfgPoll (Script, AndMask, OrMask);
1722 break;
1723
1724 case EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL_OPCODE:
1725 DEBUG ((EFI_D_INFO, "EFI_BOOT_SCRIPT_PCI_CONFIG2_POLL_OPCODE\n"));
1726 CheckAndOrMask (&ScriptHeader, &AndMask, &OrMask, Script);
1727 Status = BootScriptPciCfg2Poll (Script, AndMask, OrMask);
1728 break;
1729
1730 case S3_BOOT_SCRIPT_LIB_LABEL_OPCODE:
1731 //
1732 // For label
1733 //
1734 DEBUG ((EFI_D_INFO, "S3_BOOT_SCRIPT_LIB_LABEL_OPCODE\n"));
1735 break;
1736 default:
1737 DEBUG ((EFI_D_INFO, "S3BootScriptDone - %r\n", EFI_UNSUPPORTED));
1738 return EFI_UNSUPPORTED;
1739 }
1740
1741 if (EFI_ERROR (Status)) {
1742 DEBUG ((EFI_D_INFO, "S3BootScriptDone - %r\n", Status));
1743 return Status;
1744 }
1745
1746 Script = Script + ScriptHeader.Length;
1747 }
1748
1749 DEBUG ((EFI_D_INFO, "S3BootScriptDone - %r\n", Status));
1750
1751 return Status;
1752 }
1753
EFI Development Kit II mirror for PVE